Inverted Pendulum System (matlab ODE45)