elevator testing

This commit is contained in:
Michael Mikovsky
2025-02-15 15:42:17 -07:00
parent 7a2126a2de
commit 7335c8e73b
3 changed files with 11 additions and 11 deletions
@@ -87,6 +87,6 @@ public class ReefPositionHelper {
return new Pose2d(new Translation2d(
oldTranslation.getX() + Math.cos(rot + Math.PI/2) * xoffset + Math.cos(rot) * yoffset,
oldTranslation.getY() + Math.sin(rot + Math.PI/2) * xoffset + Math.sin(rot) * yoffset
), oldPose.getRotation());
), oldPose.getRotation().rotateBy(Rotation2d.k180deg));
}
}