Inverted pendulum: swing-up