ALL FIXED!
inverted pendulum test