Self balancing robot

A (slow) PID loop controlling the desired balance angle, fed from the position error, should be
providing the setpoint for the balance control loop. Well in theory.