Inverted pendulum simulation