SCDS/FTCRoadRunnerRobotics
7
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

small fix to PinpointLocalizer

Browse Source
This commit is contained in:
Anyi Lin
2024-10-17 21:56:08 -04:00
parent 1b27bab64b
commit c5f33af419
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/localization/localizers/PinpointLocalizer.java
View File

@ -143,7 +143,7 @@ public class PinpointLocalizer extends Localizer {
public void setPose(Pose setPose) { public void setPose(Pose setPose) {
resetPinpoint(); resetPinpoint();
Pose setPinpointPose = MathFunctions.subtractPoses(setPose, startPose); 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()));
} }
/** /**