diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/localization/localizers/PinpointLocalizer.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/localization/localizers/PinpointLocalizer.java index 58c4746..e35875f 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/localization/localizers/PinpointLocalizer.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/localization/localizers/PinpointLocalizer.java @@ -152,8 +152,8 @@ public class PinpointLocalizer extends Localizer { @Override public void update() { odo.update(); - totalHeading += MathFunctions.getSmallestAngleDifference(odo.getHeading(), previousHeading); - previousHeading = odo.getHeading(); + totalHeading += MathFunctions.getSmallestAngleDifference(MathFunctions.normalizeAngle(odo.getHeading()), previousHeading); + previousHeading = MathFunctions.normalizeAngle(odo.getHeading()); } /**