Screw Theory and its Application to Spatial Robot Manipulators