Update to PID gains and tracking controller