2 dof spring mass system matlab ode45