multibodydynamicequations