Feedback gains: Tilt = Tilt rate = Position = Velocity =
Tmax = dt= All estimated. Height of accelerometer above the axle =
You can change the position target, phitarget =