robot dynamics based on screw thoery