Solving Equation Of Motion In Matlab