Simplify rear wheel controller anti-windup scheme.

Update integrator in the rear wheel PI controller only when control
torque is not saturated.
Fix static lean calculation.

Static lean calculation now uses accelerometer y instead of accelerometer x as
the imu signals are now given in the bicycle lean frame.
Merge remote-tracking branch 'oliverlee/setpoint' into imu_calibration