Chap06_Manipulator dynamics