mirror of
https://github.com/BroncBotz3481/YAGSL
synced 2026-06-19 06:21:40 +00:00
Updated YAGSL to remove misconception of IEEERemainder
This commit is contained in:
@@ -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;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user