SYSTEMS AND METHODS FOR UTILIZING AUGMENTED JACOBIAN TO CONTROL MANIPULATOR JOINT MOVEMENT

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 augmenting a Jacobian so that joint movements calculated from the Jacobian perform one or more auxiliary tasks and/or desired joint movements concurrent with commanded end effector movement, the one or more auxiliary tasks and/or desired joint movements extending into a null-space. The auxiliary tasks and desired joint movements include inhibiting movement of one or more joints, inhibiting collisions between adjacent manipulators or between a manipulator and a patient surface, commanded reconfiguration of one or more joints, or various other tasks or combinations thereof. Such joint movements may be provided using joint velocities calculated from the pseudo-inverse solution of the: augmented Jacobian. Various configurations for systems utilizing such methods are provided herein.