Problems with the implementation of pathplanner to swerve

Hi, good morning.
Our team recebtly switched to swerve drive (mk4i from swerve specialities) and we managed to program the chassi to make it field oriented) but since then, we have been trying to implement pathplanner to our code. This is the pathplanner route:

And this is our code:

When we connect to our robot with this code, the teleoperated mode works just fine. The problem comes when we try to start the autonomous mode (when autonomous enables, the robot doesn´t move at all).
We are not shure what might be the problem and that´s why I would like to recieve feedback.
Thanks in advance.

This topic was automatically closed 365 days after the last reply. New replies are no longer allowed.