Feedback gains: Tilt =
Tilt rate =
Wheel turns =
Wheel speed =
Tmax =
dt=
The drive is limited in magnitude to 1.
You can change the position target, phitarget =
0