small fix to PinpointLocalizer

This commit is contained in:
Anyi Lin
2024-10-17 21:56:08 -04:00
parent 1b27bab64b
commit c5f33af419

View File

@ -143,7 +143,7 @@ public class PinpointLocalizer extends Localizer {
public void setPose(Pose setPose) {
resetPinpoint();
Pose setPinpointPose = MathFunctions.subtractPoses(setPose, startPose);
odo.setPosition(new Pose2D(DistanceUnit.INCH, setPinpointPose.getY(), setPinpointPose.getX(), AngleUnit.RADIANS, setPinpointPose.getHeading()));
odo.setPosition(new Pose2D(DistanceUnit.INCH, setPinpointPose.getX(), setPinpointPose.getY(), AngleUnit.RADIANS, setPinpointPose.getHeading()));
}
/**