Before adding third state variable
Started to model controls of the pendulum