diff --git a/Main/src/main/java/com/chameleonvision/vision/camera/CameraValues.java b/Main/src/main/java/com/chameleonvision/vision/camera/CameraValues.java index d9b0dc0e0..0ea7e8873 100644 --- a/Main/src/main/java/com/chameleonvision/vision/camera/CameraValues.java +++ b/Main/src/main/java/com/chameleonvision/vision/camera/CameraValues.java @@ -41,10 +41,10 @@ public class CameraValues { VerticalFocalLength = ImageHeight / (2 * FastMath.tan(VerticalView /2)); } public double CalculatePitch(double PixelY, double centerY){ - double pitch = (FastMath.toDegrees((FastMath.atan(PixelY - centerY) / VerticalFocalLength))); + double pitch = FastMath.toDegrees(FastMath.atan((PixelY - centerY) / VerticalFocalLength)); return (pitch * -1); } public double CalculateYaw(double PixelX, double centerX){ - return FastMath.toDegrees(FastMath.atan(PixelX - centerX) / HorizontalFocalLength); + return FastMath.toDegrees(FastMath.atan((PixelX - centerX) / HorizontalFocalLength)); } }