We are trying to use pathplanner this year but our paths keep acting weirdly. I’ve checked the way we initialize it multiple times and at this point in not sure where the problem even is. It has worked when we moved it straight for 1meter, and and another path where we moved it straight for 2 meters while rotating 180 degrees. However, some paths, (that all usually have strafing in them), the auto keeps acting weirdly, like turning at the start even when the robot does not rotate in the actual path. Running the auto after it already ran moves it differently than how it ran before.
Here is our code for this season: GitHub - RingOfFireOrg/2024Robot: Robot for the 2024 Crescendo Season
Any help would be greatly appreciated