Team2890/YAGSL
4
0
Fork 0
mirror of https://github.com/BroncBotz3481/YAGSL synced 2026-06-19 06:21:40 +00:00
Code Issues Packages Projects Releases Wiki Activity

Updated YAGSL to remove misconception of IEEERemainder

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files

10
swervelib/imu/ADIS16448Swerve.java
View File

@@ -34,7 +34,7 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void factoryDefault()
{
yawOffset = Math.IEEEremainder(imu.getAngle(), 360);
yawOffset = (imu.getAngle() % 360);
}
/**
@@ -54,7 +54,7 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void setYaw(double yaw)
{
yawOffset = Math.IEEEremainder(yaw, 360) + Math.IEEEremainder(imu.getAngle(), 360);
yawOffset = (yaw % 360) + (imu.getAngle() % 360);
}
/**
@@ -65,9 +65,9 @@ public class ADIS16448Swerve extends SwerveIMU
@Override
public void getYawPitchRoll(double[] yprArray)
{
yprArray[0] = Math.IEEEremainder(imu.getAngle(), 360) - yawOffset;
yprArray[1] = Math.IEEEremainder(imu.getXComplementaryAngle(), 360);
yprArray[2] = Math.IEEEremainder(imu.getYComplementaryAngle(), 360);
yprArray[0] = (imu.getAngle() % 360) - yawOffset;
yprArray[1] = imu.getXComplementaryAngle() % 360;
yprArray[2] = imu.getYComplementaryAngle() % 360;
}
/**