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.