System and method for integrated surgical table motion
A computer-assisted medical device includes a first articulated arm, the first articulated arm having an end effector, a first joint set, a second joint set and a control unit. The control unit configures one or more joints in the first joint set to a floating mode, detects movement of the first joint set caused by a movement of the surgical table, drives the second joint set based on the movement of the surgical table, receives an instrument motion command to move the end effector while the surgical table is moving, and moves the end effector based on the instrument motion command. In some embodiments, the instrument motion command is relative to an imaging coordinate frame. In some embodiments, the imaging coordinate frame is based on a pose of an imaging device saved prior to the movement of the surgical table.
1. A computer-assisted medical device comprising:
a first articulated arm, the first articulated arm configured to be coupled to an end effector, and the first articulated arm having a first joint set and a second joint set; and
a control unit that, when coupled to the first articulated arm and a surgical table, is configured to:
configure one or more joints in the first joint set to a mode where the one or more joints in the first joint set are able to move in response to an external force applied to the first articulated arm;
detect movement of the first joint set caused by a movement of the surgical table;
receive an instrument motion command to move the end effector while the surgical table is moving;
determine first movement of the second joint set to compensate for movement of the end effector caused by the movement of the first joint set due to the movement of the surgical table;
determine second movement of the second joint set relative to a virtual coordinate frame to perform the instrument motion command, the virtual coordinate frame being of an imaging device capturing images of the end effector, and the virtual coordinate frame being detached from an actual imaging coordinate frame of the imaging device; and
drive the second joint set based on superimposing the first and second movements.
2. The device of claim 1 , wherein the control unit is further configured to transform the instrument motion command from the virtual coordinate frame to a coordinate frame of the end effector.
3. The device of claim 1 , wherein the virtual coordinate frame is based on a pose of the imaging device saved prior to the movement of the surgical table.
4. The device of claim 1 , wherein the control unit is further configured to maintain the virtual coordinate frame in fixed relationship to a table top of the surgical table.
5. The device of claim 1 , wherein the control unit is further configured to drive a third joint set in a second articulated arm based on the movement of the surgical table.
6. The device of claim 1 , wherein to determine the first movement, the control unit is further configured to:
transform the movement of the surgical table in a surgical table coordinate frame into a motion in an end effector coordinate frame.
7. The device of claim 1 , wherein to determine the first movement, the control unit is further configured to:
transform the movement of the surgical table in a surgical table coordinate frame into a motion in a remote center of motion coordinate frame;
separate a rotational part of the motion in the remote center of motion coordinate frame; and
determine the first movement based on the rotational part and not a translational part of the motion in the remote center of motion coordinate frame.
8. The device of claim 5 , wherein to drive the third joint set based on the movement of the surgical table, the control unit is further configured to:
transform the movement of the surgical table in a surgical table coordinate frame into a motion in a second virtual coordinate frame; and
drive the third joint set to move in relation to the motion in the second virtual coordinate frame.
9. The device of claim 5 , wherein to drive the third joint set based on the movement of the surgical table, the control unit is further configured to:
transform the movement of the surgical table in a table coordinate frame into a motion in a second virtual coordinate frame;
separate a rotational part of the motion in the second virtual coordinate frame; and
drive the third joint set to move in relation to the rotational part and not a translational part of the motion in the second virtual coordinate frame.
10. A method of controlling motion in a medical device, the method comprising:
configuring one or more joints in a first joint set of a first articulated arm of the medical device to a mode where the one or more joints in the first joint set are able to move in response to an external force applied to the first articulated arm;
detecting movement of the first joint set caused by movement of a surgical table;
receiving an instrument motion command to move an end effector of the first articulated arm while the surgical table is moving;
determining first movement of a second joint set of the first articulated arm to compensate for movement of the end effector caused by the movement of the first joint set due to the movement of the surgical table;
determining second movement of the second joint set relative to a virtual coordinate frame to perform the instrument motion command, the virtual coordinate frame being of an imaging device capturing images of the end effector, and the virtual coordinate frame being detached from an actual imaging coordinate frame of the imaging device; and
driving the second joint set based on a superposition of the first and second movements.
11. The method of claim 10 , wherein the virtual coordinate frame is based on a pose of an imaging device saved prior to the movement of the surgical table.
12. The method of claim 10 , wherein the method further comprises driving a third joint set in a second articulated arm based on the movement of the surgical table.
13. The method of claim 10 , wherein driving the second joint set comprises:
transforming the movement of the surgical table in a surgical table coordinate frame into a motion in an end effector coordinate frame.
14. The method of claim 10 , wherein driving the second joint set comprises:
transforming the movement of the surgical table in a surgical table coordinate frame into a motion in a remote center of motion coordinate frame;
separating a rotational part of the motion in the remote center of motion coordinate frame; and
determining the first movement based on the rotational part and not a translational part of the motion in the remote center of motion coordinate frame.
15. The method of claim 12 , wherein driving the third joint set based on the movement of the surgical table comprises:
transforming the movement of the surgical table in a surgical table coordinate frame into a motion in a second virtual coordinate frame; and
driving the third joint set to move in relation to the motion in the second virtual coordinate frame.
16. The method of claim 12 , wherein driving the third joint set based on the movement of the surgical table comprises:
transforming the movement of the surgical table in a table coordinate frame into a motion in a second virtual coordinate frame;
separating a rotational part of the motion in the second virtual coordinate frame; and
driving the third joint set to move in relation to the rotational part and not a translational part of the motion in the second virtual coordinate frame.
17. A computer-assisted medical device comprising:
a first articulated arm, the first articulated arm configured to have an end effector; and
a control unit, when coupled to the first articulated arm and a surgical table, configured to:
maintain an orientation and position of the end effector in relation to a table top of the surgical table when the surgical table is moved by:
configuring one or more joints in a first joint set of the first articulated arm of the medical device to a mode where the one or more joints in the first joint set are able to move in response to an external force applied to the first articulated arm;
detecting movement of the first joint set caused by movement of the surgical table;
receiving an instrument motion command to move an end effector of the first articulated arm while the surgical table is moving;
determining first movement of a second joint set of the first articulated arm to compensate for movement of the end effector caused by the movement of the first joint set due to the movement of the surgical table;
determining second movement of the second joint set relative to a virtual coordinate frame to perform the instrument motion command, the virtual coordinate frame being of an imaging device capturing images of the end effector, and the virtual coordinate frame being detached from an actual imaging coordinate frame of the imaging device; and
driving the second joint set based on superimposing the first and second movements.
18. The device of claim 17 , wherein the control unit is further configured to maintain the orientation and position of the virtual coordinate frame in relation to a table top of the surgical table when the surgical table is moved.
19. The device of claim 18 , wherein the control unit is further configured to maintain the orientation and position of an imaging device in relation to a table top of the surgical table when the surgical table is moved.
20. The device of claim 1 , wherein the control unit is further configured to realign the virtual coordinate frame with the actual imaging coordinate frame.
21. The device of claim 1 , wherein the control unit is further configured to reset a position of the virtual coordinate frame to a position of the imaging device.
22. The method of claim 10 , further comprising: realigning the virtual coordinate frame with the actual imaging coordinate frame.