调整OBB检测
This commit is contained in:
17146
Light_Quanta
parent
d42138bb9d
commit
1e56aad393
2 changed files with 71 additions and 199 deletions
|
|
@ -36,8 +36,8 @@ import net.minecraft.world.phys.Vec3;
|
||||||
import net.neoforged.neoforge.event.EventHooks;
|
import net.neoforged.neoforge.event.EventHooks;
|
||||||
import org.jetbrains.annotations.NotNull;
|
import org.jetbrains.annotations.NotNull;
|
||||||
import org.jetbrains.annotations.Nullable;
|
import org.jetbrains.annotations.Nullable;
|
||||||
import org.joml.*;
|
|
||||||
import org.joml.Math;
|
import org.joml.Math;
|
||||||
|
import org.joml.*;
|
||||||
import software.bernie.geckolib.animatable.GeoEntity;
|
import software.bernie.geckolib.animatable.GeoEntity;
|
||||||
import software.bernie.geckolib.animatable.instance.AnimatableInstanceCache;
|
import software.bernie.geckolib.animatable.instance.AnimatableInstanceCache;
|
||||||
import software.bernie.geckolib.animation.AnimatableManager;
|
import software.bernie.geckolib.animation.AnimatableManager;
|
||||||
|
|
@ -52,18 +52,17 @@ public class Type63Entity extends ContainerMobileVehicleEntity implements GeoEnt
|
||||||
public static final EntityDataAccessor<Float> YAW = SynchedEntityData.defineId(Type63Entity.class, EntityDataSerializers.FLOAT);
|
public static final EntityDataAccessor<Float> YAW = SynchedEntityData.defineId(Type63Entity.class, EntityDataSerializers.FLOAT);
|
||||||
public static final EntityDataAccessor<List<Integer>> LOADED_AMMO = SynchedEntityData.defineId(Type63Entity.class, ModSerializers.INT_LIST_SERIALIZER.get());
|
public static final EntityDataAccessor<List<Integer>> LOADED_AMMO = SynchedEntityData.defineId(Type63Entity.class, ModSerializers.INT_LIST_SERIALIZER.get());
|
||||||
private final AnimatableInstanceCache cache = GeckoLibUtil.createInstanceCache(this);
|
private final AnimatableInstanceCache cache = GeckoLibUtil.createInstanceCache(this);
|
||||||
|
|
||||||
public OBB[] barrel = new OBB[12];
|
public OBB[] barrel = new OBB[12];
|
||||||
public OBB pitchController;
|
public OBB pitchController;
|
||||||
public OBB yawController;
|
public OBB yawController;
|
||||||
public OBB hoe1;
|
public OBB hoe1;
|
||||||
public OBB hoe2;
|
public OBB hoe2;
|
||||||
|
|
||||||
public OBB wheel1;
|
public OBB wheel1;
|
||||||
public OBB wheel2;
|
public OBB wheel2;
|
||||||
public OBB body1;
|
public OBB body1;
|
||||||
public OBB body2;
|
public OBB body2;
|
||||||
|
|
||||||
|
|
||||||
public double interactionTick;
|
public double interactionTick;
|
||||||
|
|
||||||
public Type63Entity(EntityType<Type63Entity> type, Level world) {
|
public Type63Entity(EntityType<Type63Entity> type, Level world) {
|
||||||
|
|
|
||||||
|
|
@ -6,12 +6,9 @@ import net.minecraft.world.entity.player.Player;
|
||||||
import net.minecraft.world.phys.AABB;
|
import net.minecraft.world.phys.AABB;
|
||||||
import net.minecraft.world.phys.Vec3;
|
import net.minecraft.world.phys.Vec3;
|
||||||
import org.jetbrains.annotations.Nullable;
|
import org.jetbrains.annotations.Nullable;
|
||||||
import org.joml.Intersectionf;
|
|
||||||
import org.joml.Math;
|
import org.joml.Math;
|
||||||
import org.joml.Quaternionf;
|
import org.joml.*;
|
||||||
import org.joml.Vector3f;
|
|
||||||
|
|
||||||
import java.util.List;
|
|
||||||
import java.util.Optional;
|
import java.util.Optional;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
@ -258,226 +255,102 @@ public record OBB(Vector3f center, Vector3f extents, Quaternionf rotation, Part
|
||||||
projZ <= extents.z;
|
projZ <= extents.z;
|
||||||
}
|
}
|
||||||
|
|
||||||
// 获取最近面的全局法向量
|
|
||||||
public Vector3f getClosestFaceNormal(Vec3 vec3) {
|
|
||||||
// 转换玩家位置到Vector3f
|
|
||||||
Vector3f pos = new Vector3f((float) vec3.x, (float) vec3.y, (float) vec3.z);
|
|
||||||
|
|
||||||
// 1. 转换到局部坐标系
|
|
||||||
Vector3f localPos = new Vector3f(pos).sub(center); // 减去中心
|
|
||||||
Quaternionf invRotation = new Quaternionf(rotation).invert(); // 旋转的逆
|
|
||||||
invRotation.transform(localPos); // 应用逆旋转
|
|
||||||
|
|
||||||
// 2. 计算到六个面的距离
|
|
||||||
float[] distances = new float[6];
|
|
||||||
distances[0] = Math.abs(localPos.x - extents.x); // +X 面
|
|
||||||
distances[1] = Math.abs(localPos.x + extents.x); // -X 面
|
|
||||||
distances[2] = Math.abs(localPos.y - extents.y); // +Y 面
|
|
||||||
distances[3] = Math.abs(localPos.y + extents.y); // -Y 面
|
|
||||||
distances[4] = Math.abs(localPos.z - extents.z); // +Z 面
|
|
||||||
distances[5] = Math.abs(localPos.z + extents.z); // -Z 面
|
|
||||||
|
|
||||||
// 3. 找到最近面的索引
|
|
||||||
int minIndex = 0;
|
|
||||||
for (int i = 1; i < distances.length; i++) {
|
|
||||||
if (distances[i] < distances[minIndex]) {
|
|
||||||
minIndex = i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// 4. 获取局部法向量并转换到全局坐标系
|
|
||||||
Vector3f localNormal = getLocalNormalByIndex(minIndex);
|
|
||||||
Vector3f globalNormal = new Vector3f(localNormal);
|
|
||||||
rotation.transform(globalNormal);
|
|
||||||
globalNormal.normalize(); // 确保单位长度
|
|
||||||
|
|
||||||
return globalNormal;
|
|
||||||
}
|
|
||||||
|
|
||||||
// 根据索引返回局部法向量
|
|
||||||
private Vector3f getLocalNormalByIndex(int index) {
|
|
||||||
return switch (index) {
|
|
||||||
case 0 -> new Vector3f(1, 0, 0); // +X
|
|
||||||
case 1 -> new Vector3f(-1, 0, 0); // -X
|
|
||||||
case 2 -> new Vector3f(0, 1, 0); // +Y
|
|
||||||
case 3 -> new Vector3f(0, -1, 0); // -Y
|
|
||||||
case 4 -> new Vector3f(0, 0, 1); // +Z
|
|
||||||
case 5 -> new Vector3f(0, 0, -1); // -Z
|
|
||||||
default -> throw new IllegalArgumentException("Invalid face index");
|
|
||||||
};
|
|
||||||
}
|
|
||||||
|
|
||||||
// 计算OBB的包围球（中心点相同，半径为对角线长度）
|
|
||||||
public float getBoundingSphereRadius() {
|
|
||||||
return extents.length();
|
|
||||||
}
|
|
||||||
|
|
||||||
// 获取面的信息（全局中心点和法向量）
|
|
||||||
public FaceInfo getFaceInfo(int faceIndex) {
|
|
||||||
// 局部坐标系的面法向量
|
|
||||||
Vector3f localNormal = getLocalNormalByIndex(faceIndex);
|
|
||||||
|
|
||||||
// 局部中心点：从OBB中心指向该面中心
|
|
||||||
Vector3f localCenter = new Vector3f(localNormal).mul(extents);
|
|
||||||
|
|
||||||
// 转换到全局坐标系
|
|
||||||
Vector3f globalCenter = new Vector3f(localCenter);
|
|
||||||
rotation.transform(globalCenter);
|
|
||||||
globalCenter.add(center);
|
|
||||||
|
|
||||||
Vector3f globalNormal = new Vector3f(localNormal);
|
|
||||||
rotation.transform(globalNormal);
|
|
||||||
globalNormal.normalize(); // 确保单位向量
|
|
||||||
|
|
||||||
return new FaceInfo(globalCenter, globalNormal);
|
|
||||||
}
|
|
||||||
|
|
||||||
// 计算玩家位置到指定面的距离
|
|
||||||
public float distanceToFace(int faceIndex, Vector3f playerPos) {
|
|
||||||
FaceInfo faceInfo = getFaceInfo(faceIndex);
|
|
||||||
Vector3f diff = new Vector3f(playerPos).sub(faceInfo.center());
|
|
||||||
return Math.abs(diff.dot(faceInfo.normal()));
|
|
||||||
}
|
|
||||||
|
|
||||||
// 存储面信息
|
|
||||||
public record FaceInfo(Vector3f center, Vector3f normal) {
|
|
||||||
}
|
|
||||||
|
|
||||||
// 计算点到OBB的距离（平方）
|
|
||||||
public float distanceSquaredToPoint(Vector3f point) {
|
|
||||||
Vector3f localPoint = new Vector3f(point).sub(center);
|
|
||||||
Quaternionf invRotation = new Quaternionf(rotation).invert();
|
|
||||||
invRotation.transform(localPoint);
|
|
||||||
|
|
||||||
Vector3f closestPoint = new Vector3f();
|
|
||||||
|
|
||||||
closestPoint.x = Math.max(-extents.x, Math.min(localPoint.x, extents.x));
|
|
||||||
closestPoint.y = Math.max(-extents.y, Math.min(localPoint.y, extents.y));
|
|
||||||
closestPoint.z = Math.max(-extents.z, Math.min(localPoint.z, extents.z));
|
|
||||||
|
|
||||||
return localPoint.distanceSquared(closestPoint);
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* 寻找距离某一个位置最近的OBB
|
* 获取玩家看向的某个OBB
|
||||||
*/
|
*/
|
||||||
@Nullable
|
@Nullable
|
||||||
public static OBB findClosestOBB(List<OBB> obbList, Vec3 vec3) {
|
|
||||||
if (obbList == null || obbList.isEmpty()) {
|
|
||||||
return null;
|
|
||||||
}
|
|
||||||
|
|
||||||
Vector3f pos = vec3.toVector3f();
|
|
||||||
OBB closestOBB = null;
|
|
||||||
float minDistanceSq = Float.MAX_VALUE;
|
|
||||||
|
|
||||||
for (OBB obb : obbList) {
|
|
||||||
float distToCenterSq = pos.distanceSquared(obb.center());
|
|
||||||
float boundingRadiusSq = obb.getBoundingSphereRadius() * obb.getBoundingSphereRadius();
|
|
||||||
|
|
||||||
if (distToCenterSq - boundingRadiusSq > minDistanceSq) {
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
float distSq = obb.distanceSquaredToPoint(pos);
|
|
||||||
|
|
||||||
if (distSq < minDistanceSq) {
|
|
||||||
minDistanceSq = distSq;
|
|
||||||
closestOBB = obb;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return closestOBB;
|
|
||||||
}
|
|
||||||
|
|
||||||
// 查找最近的面
|
|
||||||
@Nullable
|
|
||||||
public static ClosestFaceResult findClosestFace(List<OBB> obbList, Vec3 playerPos) {
|
|
||||||
if (obbList == null || obbList.isEmpty()) {
|
|
||||||
return null;
|
|
||||||
}
|
|
||||||
|
|
||||||
Vector3f pos = playerPos.toVector3f();
|
|
||||||
OBB closestOBB = null;
|
|
||||||
int closestFaceIndex = -1;
|
|
||||||
float minDistance = Float.MAX_VALUE;
|
|
||||||
Vector3f closestFaceNormal = null;
|
|
||||||
Vector3f closestFaceCenter = null;
|
|
||||||
|
|
||||||
// 第一阶段：使用包围球快速筛选候选OBB
|
|
||||||
for (OBB obb : obbList) {
|
|
||||||
// 计算玩家到OBB中心的距离
|
|
||||||
float distToCenter = pos.distance(obb.center());
|
|
||||||
|
|
||||||
// 如果距离大于包围球半径，不可能比当前最小值更近
|
|
||||||
if (distToCenter > obb.getBoundingSphereRadius()) {
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
// 第二阶段：检查该OBB的所有面
|
|
||||||
for (int faceIndex = 0; faceIndex < 6; faceIndex++) {
|
|
||||||
float dist = obb.distanceToFace(faceIndex, pos);
|
|
||||||
|
|
||||||
// 更新最小距离
|
|
||||||
if (dist < minDistance) {
|
|
||||||
minDistance = dist;
|
|
||||||
closestOBB = obb;
|
|
||||||
closestFaceIndex = faceIndex;
|
|
||||||
OBB.FaceInfo faceInfo = obb.getFaceInfo(faceIndex);
|
|
||||||
closestFaceNormal = faceInfo.normal();
|
|
||||||
closestFaceCenter = faceInfo.center();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (closestOBB == null) {
|
|
||||||
return null;
|
|
||||||
}
|
|
||||||
|
|
||||||
return new ClosestFaceResult(closestOBB, closestFaceIndex, minDistance,
|
|
||||||
closestFaceCenter, closestFaceNormal);
|
|
||||||
}
|
|
||||||
|
|
||||||
// 存储最近面结果
|
|
||||||
public record ClosestFaceResult(OBB obb, int faceIndex, float distance, Vector3f faceCenter, Vector3f faceNormal) {
|
|
||||||
}
|
|
||||||
|
|
||||||
//获取玩家看向的某个OBB
|
|
||||||
|
|
||||||
public static OBB getLookingObb(Player player, double range) {
|
public static OBB getLookingObb(Player player, double range) {
|
||||||
Entity lookingEntity = TraceTool.findLookingEntity(player, range);
|
Entity lookingEntity = TraceTool.findLookingEntity(player, range);
|
||||||
if (lookingEntity instanceof OBBEntity obbEntity) {
|
if (!(lookingEntity instanceof OBBEntity obbEntity)) {
|
||||||
var obbList = obbEntity.getOBBs();
|
|
||||||
for (OBB obb : obbList) {
|
|
||||||
Vec3 hitPos = TraceTool.playerFindLookingPos(player, lookingEntity, range);
|
|
||||||
if (hitPos != null && obb.contains(hitPos.add(player.getViewVector(1).scale(0.05)))) {
|
|
||||||
// player.displayClientMessage(Component.literal(String.valueOf(obb)), true);
|
|
||||||
// 测试粒子
|
|
||||||
// if (player.level() instanceof ServerLevel serverLevel) {
|
|
||||||
// sendParticle(serverLevel, ModParticleTypes.FIRE_STAR.get(), hitPos.x, hitPos.y, hitPos.z, 1, 0, 0, 0, 0.01, false);
|
|
||||||
// }
|
|
||||||
return obb;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return null;
|
return null;
|
||||||
}
|
}
|
||||||
|
|
||||||
public static Optional<OBB> getNearestOBB(Vec3 vec3, List<OBB> obbs) {
|
// 获取玩家视线信息
|
||||||
if (obbs.isEmpty()) return Optional.empty();
|
Vec3 eyePos = player.getEyePosition(1.0f);
|
||||||
|
Vec3 viewVec = player.getViewVector(1.0f);
|
||||||
|
Vec3 lookEnd = eyePos.add(viewVec.scale(range));
|
||||||
|
|
||||||
OBB nearest = null;
|
OBB closestOBB = null;
|
||||||
double minDistanceSq = Double.MAX_VALUE;
|
double minDistanceSq = Double.MAX_VALUE;
|
||||||
|
|
||||||
for (OBB obb : obbs) {
|
for (OBB obb : obbEntity.getOBBs()) {
|
||||||
double distanceSq = obb.center.distanceSquared((float) vec3.x, (float) vec3.y, (float) vec3.z);
|
// 使用精确的射线相交检测
|
||||||
|
Vec3 hitPos = rayIntersect(obb, eyePos, lookEnd);
|
||||||
|
|
||||||
|
if (hitPos != null) {
|
||||||
|
// 计算交点到眼睛的平方距离
|
||||||
|
double distanceSq = eyePos.distanceToSqr(hitPos);
|
||||||
|
|
||||||
if (distanceSq < minDistanceSq) {
|
if (distanceSq < minDistanceSq) {
|
||||||
minDistanceSq = distanceSq;
|
minDistanceSq = distanceSq;
|
||||||
nearest = obb;
|
closestOBB = obb;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
return Optional.ofNullable(nearest);
|
return closestOBB;
|
||||||
|
}
|
||||||
|
|
||||||
|
@Nullable
|
||||||
|
public static Vec3 rayIntersect(OBB obb, Vec3 start, Vec3 end) {
|
||||||
|
// 获取 OBB 信息
|
||||||
|
Vec3 center = new Vec3(obb.center());
|
||||||
|
Vec3 extents = new Vec3(obb.extents());
|
||||||
|
Quaternionf rotation = obb.rotation();
|
||||||
|
|
||||||
|
// 计算逆旋转
|
||||||
|
Quaternionf inverse = new Quaternionf(rotation).conjugate();
|
||||||
|
|
||||||
|
// 转换起点和终点到局部坐标系
|
||||||
|
Vector3f localStart = toLocal(obb, start);
|
||||||
|
Vector3f localEnd = toLocal(obb, end);
|
||||||
|
|
||||||
|
// 定义 OBB 的 AABB（在局部坐标系中）
|
||||||
|
float minX = (float) -extents.x, minY = (float) -extents.y, minZ = (float) -extents.z;
|
||||||
|
float maxX = (float) extents.x, maxY = (float) extents.y, maxZ = (float) extents.z;
|
||||||
|
|
||||||
|
// 使用 JOML 的相交检测
|
||||||
|
Vector2f result = new Vector2f();
|
||||||
|
boolean intersects = Intersectionf.intersectRayAab(
|
||||||
|
localStart.x, localStart.y, localStart.z,
|
||||||
|
localEnd.x - localStart.x, localEnd.y - localStart.y, localEnd.z - localStart.z,
|
||||||
|
minX, minY, minZ,
|
||||||
|
maxX, maxY, maxZ,
|
||||||
|
result
|
||||||
|
);
|
||||||
|
|
||||||
|
if (intersects) {
|
||||||
|
float t = result.x; // 交点参数
|
||||||
|
Vector3f localHit = new Vector3f(
|
||||||
|
localStart.x + t * (localEnd.x - localStart.x),
|
||||||
|
localStart.y + t * (localEnd.y - localStart.y),
|
||||||
|
localStart.z + t * (localEnd.z - localStart.z)
|
||||||
|
);
|
||||||
|
|
||||||
|
// 转换回世界坐标系
|
||||||
|
rotation.transform(localHit);
|
||||||
|
return new Vec3(localHit.x + center.x, localHit.y + center.y, localHit.z + center.z);
|
||||||
|
}
|
||||||
|
return null;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 将世界坐标点转换到 OBB 局部坐标系
|
||||||
|
private static Vector3f toLocal(OBB obb, Vec3 worldPoint) {
|
||||||
|
// 获取 OBB 信息
|
||||||
|
Vec3 center = new Vec3(obb.center());
|
||||||
|
Quaternionf rotation = obb.rotation();
|
||||||
|
Quaternionf inverse = new Quaternionf(rotation).conjugate();
|
||||||
|
|
||||||
|
// 计算相对于中心的向量
|
||||||
|
Vector3f relative = new Vector3f(
|
||||||
|
(float) (worldPoint.x - center.x),
|
||||||
|
(float) (worldPoint.y - center.y),
|
||||||
|
(float) (worldPoint.z - center.z)
|
||||||
|
);
|
||||||
|
|
||||||
|
// 应用逆旋转（世界坐标 -> 局部坐标）
|
||||||
|
inverse.transform(relative);
|
||||||
|
return relative;
|
||||||
}
|
}
|
||||||
|
|
||||||
public enum Part {
|
public enum Part {
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue