SYSTEMS FOR USING THE NULL SPACE TO EMPHASIZE ANIPULATOR JOINT MOTION ANISOTROPICALLY

摘要

Devices, systems, and methods for providing commanded movement of an end effector of a manipulator while providing a desired movement of one or more joints of the manipulator. Methods include calculating weighted joint velocities using a weighting matrix within the joint space to anisotropically emphasize joint movement within a null-space to provide the desired movement of a first set of joints. Methods may include calculating joint velocities that achieve the desired end effector movement using a pseudo-inverse solution and adjusting the calculated joint velocities using a potential function gradient within the joint space corresponding to the desired movement of the first set of joints. Methods may include use of a weighted pseudo-inverse solution and also an augmented Jacobian solution. One or more auxiliary movements may also be provided using joint velocities calculated from the pseudo-inverse solution. Various configurations for systems utilizing such methods are provided herein.