Updated YAGSL to remove misconception of IEEERemainder

This commit is contained in:
thenetworkgrinch
2023-02-27 21:59:12 -06:00
parent ef58f545df
commit 9b78c6363f
117 changed files with 137 additions and 161 deletions

View File

@@ -41,7 +41,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void factoryDefault()
{
yawOffset = Math.IEEEremainder(gyro.getAngle(), 360);
yawOffset = gyro.getAngle() % 360;
}
/**
@@ -61,7 +61,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(gyro.getAngle(), 360);
yawOffset = (yaw % 360) + (gyro.getAngle() % 360);
}
/**
@@ -72,7 +72,7 @@ public class AnalogGyroSwerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
yprArray[0] = Math.IEEEremainder(gyro.getAngle(), 360) - yawOffset;
yprArray[0] = (gyro.getAngle() % 360) - yawOffset;
yprArray[1] = 0;
yprArray[2] = 0;
}