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

Start position heading fix on TwoWheelPinpointIMU

Browse Source
This commit is contained in:
junkjunk123
2024-12-05 18:08:59 -08:00
committed by GitHub
parent 58fd8d4a56
commit 6b601b9dd4
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/TwoWheelPinpointIMULocalizer.java
View File

@ -113,7 +113,7 @@ public class TwoWheelPinpointIMULocalizer extends Localizer {
*/ */
@Override @Override
public Pose getPose() { public Pose getPose() {
return MathFunctions.addPoses(startPose, displacementPose); return new Pose(startPose.getX()+displacementPose.getX(), startPose.getY()+displacementPose.getY(),displacementPose.getHeading());
} }
/** /**