Simple pendulum planning now implemented