6 Dof Equations Of Motion