System and method for maintaining a tool pose
A system and method of maintaining a tool pose for a computer-assisted medical device with an articulated arm including one or more first joints and one or more second joints, a tool distal to the first joints and the second joints, and a control unit coupled to the first joints and the second joints. The control unit maintains a pose of the tool during movement of the first joints using the second joints by determining a reference coordinate frame for the tool, determining a reference transform of the tool in the reference coordinate frame prior to the movement of the first joints, determining an actual transform of the tool in the reference coordinate frame while the first joints are being moved, determining differences between the reference transform and the actual transform, and maintaining the pose of the tool by driving the second joints based on the differences.
1. A computer-assisted medical device, the device comprising:
an articulated arm comprising one or more first joints and one or more second joints;
a tool distal to the one or more first joints and the one or more second joints; and
a control unit coupled to the one or more first joints and the one or more second joints;
wherein, during movement of the one or more first joints, the control unit:
determines a reference coordinate frame for the tool;
determines a reference transform of an initial position and orientation of the tool in the reference coordinate frame prior to the movement of the one or more first joints;
determines an actual transform of a current position and orientation of the tool in the reference coordinate frame while the one or more first joints are being moved;
determines differences between the reference transform and the actual transform; and
maintains a position and orientation of the tool at the initial position and orientation in the reference coordinate frame by driving the one or more second joints based on the differences.
2. The device of claim 1 , wherein the control unit further maintains the position and orientation of the tool at the initial position and orientation in the reference coordinate frame by converting the differences to a second coordinate frame local to the one or more second joints.
3. The device of claim 1 , wherein the control unit further maintains the position and orientation of the tool at the initial position and orientation in the reference coordinate frame by determining commands for the one or more second joints based on an inverse Jacobian for the one or more second joints.
4. The device of claim 1 , wherein the control unit further maintains the position and orientation of the tool at the initial position and orientation in the reference coordinate frame by determining the reference transform and the actual transform based on positions of the one or more first joints, positions of the one or more second joints, and one or more kinematic models of the computer-assisted medical device.
5. The device of claim 4 , wherein the control unit further maintains the position and orientation of the tool at the initial position and orientation in the reference coordinate frame by determining the positions of the one or more first joints and the positions of the one or more second joints based on readings from one or more sensors monitoring the one or more first joints and the one or moresecond joints.
6. The device of claim 1 , wherein the one or more second joints are configured to control a roll, a pitch, and a yaw of the tool relative to the reference coordinate frame.
7. The device of claim 1 , wherein the reference coordinate frame is associated with a remote center of the articulated arm.
8. The device of claim 1 , wherein the reference coordinate frame is fixed relative to a world coordinate system for the computer-assisted medical device.
9. The device of claim 1 , wherein the reference coordinate frame is associated with a top of a surgical table on which a patient is positioned.
10. The device of claim 1 , wherein the tool is a virtual tool.
11. The device of claim 1 , wherein the control unit further maintains the position and orientation of the tool at the initial position and orientation in the reference coordinate frame by determining the reference coordinate frame for the tool based on a cause of the movement of the one or more first joints.
12. The device of claim 11 , wherein when the movement of the one or more first joints is due to movement of a patient, the reference coordinate frame is associated with a remote center of the articulated arm.
13. The device of claim 12 , wherein the remote center of the articulated arm is located at a port where the articulated arm is docked to the patient.
14. The device of claim 12 , wherein the movement of the patient is due to movement of a surgical table.
15. The device of claim 11 , wherein when the movement of the one or more first joints is due to controlled motion of the articulated arm, manual repositioning of the articulated arm, motion induced by a collision of the articulated arm, or release of one or more brakes or locks of the one or more first joints, the reference coordinate frame is fixed relative to a world coordinate frame of the computer-assisted medical device.
16. The device of claim 1 , wherein each of the one or more second joints is associated with a manipulator mounted to the articulated arm.
17. The device of claim 1 , wherein each of the one or more second joints is distal to each of the one or more first joints.
18. The device of claim 1 , wherein the control unit determines the differences between the reference transform and the actual transform by composing an inverse of the reference transform with the actual transform.