We managed to find an incredible model which allowed us to run at the max fps at all resolutions. I truly have no idea how it is this good so if anyone has an idea I’d love to know.
After that you drive robot oriented at tx angle with a PID controller on ty for the speed and a PID controller on tx for the rotation.