Added simple pendulum model and controller