Regulating joint space velocity of a surgical robotic arm

1. A method for regulating joint space velocity of a surgical robotic arm, the method comprising:

a) computing a longest principal axis of a velocity ellipsoid for a surgical robotic arm configuration;

b) receiving a task space velocity, applying a norm of the task space velocity along the longest principal axis to compute a potential joint space velocity using inverse kinematics;

d) computing a ratio of i) the potential joint space velocity and ii) a joint space velocity limit for the surgical robotic arm; and

e) applying the ratio to an initial joint space velocity, to produce a regulated joint space velocity.

2. The method of claim 1 wherein the joint space velocity limit is less than the potential joint space velocity, and the regulated joint space velocity is less than the joint space velocity limit.

3. The method of claim 2 further comprising:

receiving a new task space velocity;

transforming the new task space velocity to a new joint space velocity;

computing a new ratio based on comparing the new task space velocity to a previous task space velocity; and

applying the new ratio to the new joint space velocity to produce a new regulated joint space velocity.

4. The method of claim 3 further comprising

applying the new regulated joint space velocity to update a plurality of motor control commands that control a plurality of motorized joints of the surgical robotic arm.

5. The method of claim 1 further comprising

in response to detecting a changed configuration of the surgical robotic arm, computing a new longest principal axis of a velocity ellipsoid for the changed configuration,

receiving a new task space velocity and producing a new vector having a norm of the new task space velocity and an orientation of the new longest principal axis, and on based on the new vector computing an updated potential joint space velocity,

computing an updated ratio of i) the updated potential joint space velocity and the joint space velocity limit for the surgical robotic arm, and

applying the updated ratio to a transformation of the new task space velocity to produce an updated regulated joint space velocity.

6. The method of claim 5 further comprising

applying the updated regulated joint space velocity to update a plurality of motor control commands that control a plurality of motorized joints of the surgical robotic arm so that an end effector on the arm is driven to a new task space position in accordance with a new UID position indicated by a UID tracking sequence.

7. The method of claim 1 further comprising

computing the velocity ellipsoid using an inverse Jacobian for the arm.

8. A surgical robotic system comprising:

a surgical robotic arm;

a processor; and

memory having stored therein instructions that when executed by the processor

a) compute a longest principal axis of a velocity ellipsoid for a first configuration of the surgical robotic arm,

b) apply a task space velocity to the longest principal axis to produce a new vector, and compute a potential joint space velocity based on the new vector,

c) compute a ratio of i) the potential joint space velocity and a joint space velocity limit of the surgical robotic arm, and

d) produce a regulated joint space velocity using the ratio.

9. The surgical robotic system of claim 8 wherein the memory has stored therein further instructions that when executed by the processor:

determine a second configuration of the surgical robotic arm, in response to an end effector on the surgical robotic arm being guided to a new task space position; and

repeat operations a)-d) for the second configuration, thereby producing a regulated joint space velocity for the second configuration.

10. The surgical robotic system of claim 8 wherein the memory has stored therein the first configuration which comprises

current joint space position data for a plurality of joints of the surgical robotic arm.

11. The surgical robotic system of claim 10 wherein the first configuration further comprises

joint space velocity limit data for a plurality of motorized joints of the surgical robotic arm.

12. The surgical robotic system of claim 8 wherein the joint space velocity limit is less than the potential joint space velocity, and the regulated joint space velocity is less than the potential joint space velocity.

13. The surgical robotic system of claim 12 wherein the memory has further instructions that when executed by the processor:

compute a new task space velocity in accordance with a UID tracking sequence;

transform the new task space velocity to a new joint space velocity without re-computing the longest principle axis;

compute a new ratio as in b) and c) using the new joint space velocity and the joint space velocity limit; and

apply the new ratio to the new joint space velocity to produce a new regulated joint space velocity.

14. The surgical robotic system of claim 13 wherein the memory has further instructions that when executed by the processor

apply the new regulated joint space velocity to update a plurality of motor control commands that control a plurality of motorized joints of the surgical robotic arm.

15. The surgical robotic system of claim 8 wherein the memory has further instructions that when executed by the processor compute the ratio by:

for each of a plurality of active joints in the surgical robotic arm, computing a potential joint velocity along the longest principle axis of the velocity ellipsoid based on the task space velocity; and

when the potential joint velocity exceeds a joint velocity limit of a respective joint, computing the ratio as between i) the joint velocity limit and the potential joint velocity, of the respective joint.

16. A method for regulating velocity of a surgical robotic arm, the method comprising:

a) determining a velocity ellipsoid of an end effector for a robotic arm configuration of a robotic arm, the robotic arm having a plurality of active joints, the end effector being positioned at a distal end of the robotic arm;

b) for each of the plurality of active joints, computing a respective potential joint velocity by applying a task space velocity along a longest principle axis of the velocity ellipsoid;

c) when the respective potential joint velocity exceeds a joint velocity limit of a respective joint, computing a ratio between i) the joint velocity limit and the respective potential joint velocity; and

d) generating a respective regulated joint velocity for each of the plurality of active joints based on the ratio.

17. The method of claim 16 wherein the respective potential joint velocity comprises a linear velocity or an angular velocity.

18. The method of claim 16 further comprising

transforming the task space velocity to an initial joint space velocity wherein generating a respective regulated joint velocity comprises multiplying the initial joint space velocity by the computed ratio.

19. The method of claim 16 further comprising

when there are two or more joints, in the plurality of active joints, for which the respective potential joint velocity exceeds a joint velocity limit of the respective joint, computing a plurality of said ratios for the two or more joints, respectively; and

selecting the smallest of the plurality of said ratios for use in generating the respective regulated joint velocity for each of the plurality of active joints.

20. The method of claim 16 further comprising:

receiving another task space velocity of the end effector;

for each of the plurality of active joints, computing another respective potential joint velocity by applying said another task space velocity along the longest principle axis of the velocity ellipsoid; and

if said another respective potential joint velocity does not exceed the joint velocity limit of the respective joint, then leaving said another respective potential joint velocity unchanged, else if said another respective potential joint velocity does exceed the joint velocity limit of the respective joint, then computing a new ratio using said another respective potential velocity and the joint velocity limit.