Correcting a robotic surgery user interface device tracking input
A sequence of input samples that are measures of position or orientation of an input device being held by a user are received. A current output sample of a state of linear quadratic estimator, LQE, is computed that is an estimate of the position or orientation of the input device. The current output sample is computed based on i) a previously computed output sample, and ii) a velocity term. An updated output sample of the state of the LQE is computed, based on i) a previously computed output sample, and ii) a new input sample. Other embodiments are also described and claimed.
1. A method comprising:
receiving an input sequence of input samples that track position or orientation of an input device of a robotic surgery system,
while a new input sample in the input sequence has not been received, computing a current output sample, wherein the current output sample is computed based on i) a previously computed output sample, and ii) a velocity term, and
when the new input sample is received, computing a new output sample, based on i) a previously computed output sample, and ii) the new input sample; and
producing an output sequence that includes the current output sample and the new output sample.
2. The method of claim 1 wherein computing the current output sample is based on a tuning parameter that adjusts a sample-to-sample time interval used in a system model of the input device.
3. The method of claim 2 wherein the sample-to-sample time interval comprises a sum of i) the tuning parameter and ii) a nominal sampling period of the output sequence.
4. The method of claim 2 wherein the input sequence has a sampling rate that is lower than that of the output sequence.
5. The method of claim 1 wherein when the new input sample is received, the new output sample is computed by computing a Kalman filter gain.
6. The method of claim 1 wherein the input sequence comprises a sequence of orientation vectors, and the output sequence comprises an estimate of orientation of the input device.
7. The method of claim 1 wherein while the new input sample has not been received, the current output sample is computed from a window of a plurality of previously computed output samples, by a) fitting a line to the previously computed output samples in the window, and b) taking a derivative of the line to be the velocity term.
8. The method of claim 7 further comprising
wherein while the new input sample has not been received, computing a next output sample based on i) another previously computed output sample, and ii) another velocity term, by
moving the window forward so that another plurality of previously computed output samples are within the window, and
repeating a) and b) using said another plurality of previously computed output samples to compute said another velocity term.
9. The method of claim 7 wherein when the new input sample is received the new output sample is computed using the previously computed output sample, the new input sample, and not a velocity term.
10. The method of claim 1 wherein when the new input sample is received the new output sample is computed using the previously computed output sample, the new input sample, and not a velocity term.
11. An article of manufacture comprising:
a machine-readable medium having stored therein instructions that when executed by a processor of a robotic surgery system
receive an input sequence of input samples that are measures of position or orientation of an input device,
while a new input sample in the input sequence has not been received, compute a current output sample, wherein the current output sample is computed based on a tuning parameter that adjusts a sample-to-sample time interval used in a system model of the input device,
when the new input sample is received, compute a new output sample, based on i) a previously computed output sample, and ii) the new input sample, and
producing an output sequence that includes the current output sample and the new output sample.
12. The article of manufacture of claim 11 wherein the sample-to-sample time interval, used in the system model of the input device, comprises a sum of i) the tuning parameter and ii) a nominal sampling period of the output sequence.
13. The article of manufacture of claim 12 wherein when the new input sample is received, the new output sample is computed by computing a Kalman filter gain.
14. The article of manufacture of claim 13 wherein the input sequence has a sampling rate that is lower than that of the output sequence.
15. The article of manufacture of claim 11 wherein the input sequence comprises a sequence of orientation vectors, and the output sequence comprises an estimate of the orientation of the input device.
16. The article of manufacture of claim 11 wherein when the new input sample is received, the new output sample is computed by computing a Kalman filter gain.
17. The article of manufacture of claim 16 wherein the input sequence has a sampling rate that is lower than that of the output sequence.
18. The article of manufacture of claim 11 wherein the medium has stored therein instructions that when executed by the processor,
while the new input sample in the input sequence has not been received, compute the current output sample based on i) a previously computed output sample, and ii) a velocity term.
19. The article of manufacture of claim 18 wherein
the current output sample is computed from a window of a plurality of previously computed output samples, by a) fitting a line to the previously computed output samples in the window, and b) taking a slope of the line to be the velocity term.
20. The article of manufacture of claim 11 wherein the input sequence has a sampling rate that is lower than that of the output sequence.