Phantom degrees of freedom in joint estimation and control
Methods, apparatus, and systems for operating a surgical system. In accordance with a method, a position of a surgical instrument is measured, the surgical instrument being included in a mechanical assembly having a plurality of joints and a first number of degrees of freedom, the position of the surgical instrument being measured for each of a second number of degrees of freedom of the surgical instrument. The method further includes estimating a position of each of the joints, where estimating the position of each joint includes applying the position measurements to at least one kinematic model of the mechanical assembly, the kinematic model having a third number of degrees of freedom greater than the first number of degrees of freedom. The method further includes controlling the mechanical assembly based on the estimated position of the joints.
1. A method of controlling movement of a mechanical body, the method comprising:
estimating a difference between a desired position of a portion of the mechanical body and an actual position of the portion of the mechanical body, the mechanical body having a first set of degrees of freedom corresponding to a plurality of joints included in the mechanical body;
determining control variables corresponding to a second set of degrees of freedom for the mechanical body by applying a kinematic model to the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body, the second set of degrees of freedom including the first set of degrees of freedom and one or more missing degrees of freedom for the portion of the mechanical body, each of the one or more missing degrees of freedom corresponding to a kinematic motion that is missing for the portion of the mechanical body; and
using the control variables corresponding to the first set of degrees of freedom to control movement of the plurality of joints of the mechanical body in accordance with the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body.
2. The method of claim 1 , wherein the mechanical body includes an instrument and a mechanical assembly, the instrument corresponding to the portion of the mechanical body, and a configuration of the mechanical assembly being determined by joint values of the plurality of joints.
3. The method of claim 1 , wherein estimating the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body includes:
estimating the desired position of the portion of the mechanical body from an input device, the desired position being characterized by one or more translational or rotational values for the portion of the mechanical body.
4. The method of claim 1 , wherein estimating the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body includes:
estimating the actual position of the portion of the mechanical body from outputs of a measurement device, the actual position being characterized by one or more translational or rotational values for the portion of the mechanical body.
5. The method of claim 1 , wherein the portion of the mechanical body corresponds to an instrument that is included in the mechanical body, and the one or more missing degrees of freedom include at least one rotational degree of freedom of the instrument.
6. The method of claim 1 , wherein
the portion of the mechanical body corresponds to an instrument that is included in the mechanical body;
the one or more missing degrees of freedom include a roll rotation about a symmetrical axis of the instrument; and
the control variables corresponding to the first set of degrees of freedom include pitch-yaw control variables that are used to simulate the roll rotation by controlling a pitch rotation and a yaw rotation of the instrument.
7. The method of claim 1 , wherein the control variables corresponding to the first set of degrees of freedom are used to simulate control of the one or more missing degrees of freedom.
8. The method of claim 1 , wherein the control variables corresponding to the first set of degrees of freedom are used to decrease a value for the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body.
9. A system comprising:
a mechanical body having a first set of degrees of freedom corresponding to a plurality of joints included in the mechanical body;
a controller including at least one processor configured to perform operations including:
estimating a difference between a desired position of a portion of the mechanical body and an actual position of the portion of the mechanical body;
determining control variables corresponding to a second set of degrees of freedom for the mechanical body by applying a kinematic model to the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body, the second set of degrees of freedom including the first set of degrees of freedom and one or more missing degrees of freedom for the portion of the mechanical body, each of the one or more missing degrees of freedom corresponding to a kinematic motion that is missing for the portion of the mechanical body; and
using the control variables corresponding to the first set of degrees of freedom to control movement of the plurality of joints of the mechanical body in accordance with the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body.
10. The system of claim 9 , wherein the mechanical body includes an instrument and a mechanical assembly, the instrument corresponding to the portion of the mechanical body, and a configuration of the mechanical assembly being determined by joint values of the plurality of joints.
11. The system of claim 9 , wherein estimating the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body includes:
estimating the desired position of the portion of the mechanical body from an input device, the desired position being characterized by one or more translational or rotational values for the portion of the mechanical body.
12. The system of claim 9 , wherein estimating the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body includes:
estimating the actual position of the portion of the mechanical body from outputs of a measurement device, the actual position being characterized by one or more translational or rotational values for the portion of the mechanical body.
13. The system of claim 9 , wherein the portion of the mechanical body corresponds to an instrument that is included in the mechanical body, and the one or more missing degrees of freedom include at least one rotational degree of freedom of the instrument.
14. The system of claim 9 , wherein
the portion of the mechanical body corresponds to an instrument that is included in the mechanical body;
the one or more missing degrees of freedom include a roll rotation about a symmetrical axis of the instrument; and
the control variables corresponding to the first set of degrees of freedom include pitch-yaw control variables that are used to simulate the roll rotation by controlling a pitch rotation and a yaw rotation of the instrument.
15. The system of claim 9 , wherein the portion of the mechanical body corresponds to an instrument that is included in the mechanical body, and the one or more missing degrees of freedom include a pitch rotation and a yaw rotation of the instrument.
16. The system of claim 9 , wherein the portion of the mechanical body corresponds to an instrument that is included in the mechanical body, and the second set of degrees of freedom provides six kinematic degrees of freedom for the instrument including three translational degrees of freedom and three rotational degrees of freedom.
17. The system of claim 9 , wherein the control variables corresponding to the first set of degrees of freedom are used to simulate control of the one or more missing degrees of freedom.
18. The system of claim 9 , wherein the kinematic model is applied in a forward-kinematic simulation for at least one time step.
19. The system of claim 9 , wherein the control variables corresponding to the first set of degrees of freedom are used to decrease a value for the difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body.
20. A computer-readable hardware storage device that stores a computer program for controlling movement of a mechanical body, the computer program including instructions that, when executed by a computer, cause the computer to perform operations comprising:
estimating a difference between a desired position of a portion of the mechanical body and an actual position of the portion of the mechanical body, the mechanical body having a first set of degrees of freedom corresponding to a plurality of joints included in the mechanical body;
determining control variables corresponding to a second set of degrees of freedom for the mechanical body by applying a kinematic model to the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body, the second set of degrees of freedom including the first set of degrees of freedom and one or more missing degrees of freedom for the portion of the mechanical body, each of the one or more missing degrees of freedom corresponding to a kinematic motion that is missing for the portion of the mechanical body; and
using the control variables corresponding to the first set of degrees of freedom to control movement of the plurality of joints of the mechanical body in accordance with the estimated difference between the desired position of the portion of the mechanical body and the actual position of the portion of the mechanical body.