Violent Direction Changes with Ramsete command trajectory tracking

I followed: https://www.youtube.com/watch?v=wqJ4tY0u6IQ to set up our tracking while using two falcons instead of sparks (two on each side), however while running a trajectory that is just straight forward a meter our robot starts to seize up and switch directions extremely violently, any Ideas on what would cause this?

Here are our constants if anything looks out of the ordinary.

Looks like an overcompensating for small angle error.

Would I use the pid loop to dampen it? Or is there something else I’m missing?

I would need to see code.
Also, @Oblarg

Other things.txt (1.6 KB)

Drive base code.txt (4.4 KB)

Sorry for the delay, here is the code that is running during autonomous, setting the slaves to follow has been done during robot initialization

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