171 lines
6.3 KiB
Java
171 lines
6.3 KiB
Java
package com.lzxnone.terraria.utils;
|
|
|
|
import net.minecraft.util.Mth;
|
|
import net.minecraft.world.entity.Entity;
|
|
import net.minecraft.world.entity.player.Player;
|
|
import net.minecraft.world.entity.projectile.ProjectileUtil;
|
|
import net.minecraft.world.level.ClipContext;
|
|
import net.minecraft.world.level.Level;
|
|
import net.minecraft.world.phys.*;
|
|
import org.joml.Quaternionf;
|
|
import org.joml.Vector3f;
|
|
|
|
public class MathUtil {
|
|
|
|
|
|
public static Vector3f[] computeCoordinateSystem(Vector3f lookAngle, double yRot) {
|
|
Vector3f dir = lookAngle.normalize();
|
|
Vector3f up = new Vector3f();
|
|
Vector3f right = new Vector3f();
|
|
|
|
if(Math.abs(dir.y) > 0.999f) {
|
|
float yawRad = (float) Math.toRadians(yRot);
|
|
Vector3f facing = new Vector3f(-Mth.sin(yawRad), 0, Mth.cos(yawRad));
|
|
|
|
up.set(dir.y > 0 ? facing.negate() : facing);
|
|
up.cross(dir, right).normalize();
|
|
dir.cross(right, up).normalize();
|
|
|
|
}else {
|
|
Vector3f ref = new Vector3f(0, 1, 0);
|
|
ref.cross(dir, right).normalize();
|
|
dir.cross(right, up).normalize();
|
|
}
|
|
|
|
return new Vector3f[]{dir, up, right};
|
|
}
|
|
|
|
//计算实体的局部坐标系(z轴为视线前方),当抬头时会出错
|
|
public static Vector3f[] computeCoordinateSystem(Entity entity) {
|
|
return computeCoordinateSystem(entity.getLookAngle().toVector3f(), entity.getYRot());
|
|
}
|
|
|
|
//让右轴绕方向轴旋转
|
|
public static Vector3f[] rotateCoordinateSystem(Vector3f dir, Vector3f right, float angle) {
|
|
Quaternionf rotation = new Quaternionf().fromAxisAngleRad(dir, (float) Math.toRadians(angle));
|
|
right = right.rotate(rotation);
|
|
Vector3f up = new Vector3f();
|
|
dir.cross(right, up).normalize();
|
|
return new Vector3f[]{dir.normalize(), up, right.normalize()};
|
|
}
|
|
|
|
public static float[] computeXYRot(Vector3f dir, Vector3f up) {
|
|
if(Math.abs(dir.y) > 0.999) {
|
|
if(dir.y > 0) {
|
|
return new float[]{-90, (float) (Math.atan2(up.x(), -up.z()) * (180.0 / Math.PI))};
|
|
}else {
|
|
return new float[]{90, (float) (Math.atan2(-up.x(), up.z()) * (180.0 / Math.PI))};
|
|
}
|
|
}
|
|
float xzLen = (float) Math.sqrt(dir.x() * dir.x() + dir.z() * dir.z());
|
|
return new float[]{
|
|
(float) (Math.atan2(-dir.y(), xzLen) * (180.0 / Math.PI)),
|
|
(float) (Math.atan2(-dir.x(), dir.z()) * (180.0 / Math.PI))
|
|
};
|
|
}
|
|
|
|
public static float[] computeXYRot(Vector3f dir) {
|
|
float xzLen = (float) Math.sqrt(dir.x() * dir.x() + dir.z() * dir.z());
|
|
float pitch = (float) (Math.atan2(-dir.y(), xzLen) * (180.0 / Math.PI));
|
|
float yaw = (float) (Math.atan2(-dir.x(), dir.z()) * (180.0 / Math.PI));
|
|
return new float[]{pitch, yaw};
|
|
}
|
|
|
|
public static Vec3 getRandomPosForRadius(Vec3 pos, double radius, boolean on) {
|
|
double u = Math.random();
|
|
double v = Math.random();
|
|
double w = Math.random();
|
|
|
|
double r = on ? radius : radius * Math.cbrt(u);
|
|
double cosPhi = 2.0 * v - 1.0;
|
|
double sinPhi = Math.sqrt(1.0 - cosPhi * cosPhi);
|
|
double theta = w * Math.PI * 2.0;
|
|
|
|
double offsetX = r * sinPhi * Math.cos(theta);
|
|
double offsetY = r * cosPhi;
|
|
double offsetZ = r * sinPhi * Math.sin(theta);
|
|
|
|
return new Vec3(pos.x + offsetX, pos.y + offsetY, pos.z + offsetZ);
|
|
}
|
|
|
|
public static Vec3 getRandomPosOnRadius(Vec3 pos, double radius) {
|
|
return getRandomPosForRadius(pos, radius, true);
|
|
}
|
|
|
|
public static Vec3 getRandomPosInRadius(Vec3 pos, double radius) {
|
|
return getRandomPosForRadius(pos, radius, false);
|
|
}
|
|
|
|
|
|
public static Vec3 getSurfaceRandomPosForRadius(Vec3 pos, Vec3 axisX, Vec3 axisY, double radius, boolean on) {
|
|
axisX = axisX.normalize().scale(radius);
|
|
axisY = axisY.normalize().scale(radius);
|
|
if(!on) {
|
|
double s = Math.sqrt(Math.random());
|
|
axisX = axisX.scale(s);
|
|
axisY = axisY.scale(s);
|
|
}
|
|
double rad = Math.PI * 2 * Math.random();
|
|
double cos = Math.cos(rad);
|
|
double sin = Math.sin(rad);
|
|
return new Vec3(
|
|
pos.x + cos * axisX.x + sin * axisY.x,
|
|
pos.y + cos * axisX.y + sin * axisY.y,
|
|
pos.z + cos * axisX.z + sin * axisY.z
|
|
);
|
|
}
|
|
|
|
public static Vec3 getSurfaceRandomPosOnRadius(Vec3 pos, Vec3 axisX, Vec3 axisY, double radius) {
|
|
return getSurfaceRandomPosForRadius(pos, axisX, axisY, radius, true);
|
|
}
|
|
|
|
public static Vec3 getSurfaceRandomPosInRadius(Vec3 pos, Vec3 axisX, Vec3 axisY, double radius) {
|
|
return getSurfaceRandomPosForRadius(pos, axisX, axisY, radius, false);
|
|
}
|
|
public static Vec3 getCrosshairPos(Player player, Level level, double range, boolean checkBlock, boolean checkEntity) {
|
|
Vec3 eyePos = player.getEyePosition(1.0F);
|
|
Vec3 lookVec = player.getLookAngle().normalize();
|
|
Vec3 maxRangeEnd = eyePos.add(lookVec.scale(range));
|
|
Vec3 finalTarget = maxRangeEnd;
|
|
|
|
if(checkBlock) {
|
|
BlockHitResult blockHit = level.clip(new ClipContext(
|
|
eyePos, maxRangeEnd,
|
|
ClipContext.Block.COLLIDER,
|
|
ClipContext.Fluid.NONE,
|
|
player
|
|
));
|
|
|
|
if(blockHit.getType() != HitResult.Type.MISS) {
|
|
finalTarget = blockHit.getLocation();
|
|
}
|
|
}
|
|
|
|
if(checkEntity) {
|
|
AABB searchBox = player.getBoundingBox().expandTowards(lookVec.scale(range)).inflate(1.0D);
|
|
EntityHitResult entityHit = ProjectileUtil.getEntityHitResult(
|
|
level, player, eyePos, finalTarget, searchBox,
|
|
entity -> !entity.isSpectator() && entity.isPickable() && entity != player
|
|
);
|
|
|
|
if(entityHit != null) {
|
|
finalTarget = entityHit.getLocation();
|
|
}
|
|
}
|
|
|
|
return finalTarget;
|
|
}
|
|
|
|
public static Vec3 getCrosshairPos(Player player, Level level, double range) {
|
|
return getCrosshairPos(player, level, range, true, true);
|
|
}
|
|
|
|
public static Vector3f toVector3f(Vec3 vec3) {
|
|
return new Vector3f((float) vec3.x, (float) vec3.y, (float) vec3.z);
|
|
}
|
|
|
|
public static Vec3 toVec3(Vector3f vector3f) {
|
|
return new Vec3(vector3f.x, vector3f.y, vector3f.z);
|
|
}
|
|
}
|