The rotation PID kept on overshooting so we had to edit the angles a little bit.
precipitevolissimevolmentely