Upstream/Minestom
1
0
Fork 0
mirror of https://github.com/Minestom/Minestom.git synced 2024-09-29 23:17:59 +02:00
Code Issues Projects Releases Wiki Activity

Add Vec#rotateFromView

Browse Source
This commit is contained in:
TheMode 2021-07-11 15:09:14 +02:00
parent fe3505a6fd
commit 13768d35cf
1 changed files with 33 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
src/main/java/net/minestom/server/coordinate/Vec.java
View File

@ -347,6 +347,39 @@ public final class Vec implements Point {
return rotateAroundX(angleX).rotateAroundY(angleY).rotateAroundZ(angleZ);
}
@Contract(pure = true)
public @NotNull Vec rotateFromView(float yawDegrees, float pitchDegrees) {
double yaw = Math.toRadians(-1 * (yawDegrees + 90));
double pitch = Math.toRadians(-pitchDegrees);
double cosYaw = Math.cos(yaw);
double cosPitch = Math.cos(pitch);
double sinYaw = Math.sin(yaw);
double sinPitch = Math.sin(pitch);
double initialX, initialY, initialZ;
double x, y, z;
// Z_Axis rotation (Pitch)
initialX = x();
initialY = y();
x = initialX * cosPitch - initialY * sinPitch;
y = initialX * sinPitch + initialY * cosPitch;
// Y_Axis rotation (Yaw)
initialZ = z();
initialX = x;
z = initialZ * cosYaw - initialX * sinYaw;
x = initialZ * sinYaw + initialX * cosYaw;
return new Vec(x, y, z);
}
@Contract(pure = true)
public @NotNull Vec rotateFromView(@NotNull Pos pos) {
return rotateFromView(pos.yaw(), pos.pitch());
}
/**
* Calculates a linear interpolation between this vector with another
* vector.