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

Merge pull request #18 from junkjunk123/master

Browse Source 
Start position heading fix on TwoWheelPinpointIMU
This commit is contained in:
Logan Nash
2024-12-05 21:52:06 -05:00
committed by GitHub
parent 58fd8d4a56 6b601b9dd4
commit b0fc4bb0ad
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());
} }
/** /**