Medical manipulator system
The technology disclosed herein is directed to a medical manipulator system having a medical device. The medical device such as endoscope or other surgical instrument includes an elongated insertion portion. A holder assembly includes an articulated arm carrying the medical device that is attached thereto and is actuated following movement of the medical device and holds the medical device in a stationary state at a desired position. A position/attitude detection unit detects positions and attitudes of the elongated insertion portion in plurality states into which the medical device is caused to swing about a constraint point. A constraint point estimation unit estimates a position of the constraint point based on the positions and attitudes of the insertion portion as detected by the position/attitude detection unit.
1. A medical manipulator system comprising:
a medical device having an elongated insertion portion;
a holder assembly having an articulated arm carrying the medical device attached thereto and being actuated following movement of the medical device and holds the medical device in a stationary state at a desired position;
a sensor configured to detect positions and attitudes of the elongated insertion portion in plurality states into which the medical device being caused to swing about a constraint point; and
a first controller configured to estimate a position of the constraint point based on the positions and attitudes of the elongated insertion portion as detected by the sensor;
wherein the medical device includes a bending joint at a tip of the elongated insertion portion; and
the first controller is configured to control the bending joint in a state that the bending joint can pass through the insertion hole if a distance between the constraint point estimated by the first controller and the bending joint is equal to or smaller than a first threshold.
2. The medical manipulator system of claim 1 , wherein the sensor comprises an angle sensor positioned at a joint of the arm.
3. The medical manipulator system of claim 1 , wherein the constraint point is set at an insertion hole that extends through the body wall of a patient so as to be inserted the elongated insertion portion.
4. The medical manipulator system of claim 1 , wherein the first controller is further configured to control the bending joint so that, if the distance is greater than the first threshold, a movable range of the bending joint becomes smaller as the distance decreases.
5. The medical manipulator system of claim 1 , wherein the first controller is configured:
to calculate a distance between
(i) position coordinates of a predetermined point on the medical device as calculated on the basis of the positions and attitudes of the elongated insertion portion as detected by the sensor and
(ii) position coordinates of the predetermined point calculated on the basis of temporary position coordinates of the constraint point; and
to output, as estimated values, the temporary position coordinates of the constraint point when the distance converged to a second threshold or smaller.
6. The medical manipulator system of claim 1 , wherein the first controller is configured to output an error signal if the distance fails converge to a third threshold or smaller.
7. The medical manipulator system of claim 6 , wherein the first controller is configured to control the bending joint in the state that the bending joint can pass through the insertion hole if the distance is greater than the third threshold.
8. The medical manipulator system of 6 , wherein the first controller is configured to:
register position coordinates of a target point for the medical device, and
renew the position coordinates of the registered target point on the basis of position coordinates of the constraint points before and after the output of the error signal.
9. The medical manipulator system of claim 1 , wherein the medical device is an endoscope.
10. A medical manipulator system comprising:
a medical device having an elongated insertion portion;
a holder assembly having an articulated arm carrying the medical device attached thereto and being actuated following movement of the medical device and holds the medical device in a stationary state at a desired position;
a sensor configured to detect positions and attitudes of the elongated insertion portion in plurality states into which the medical device being caused to swing about a constraint point; and
a first controller configured to estimate a position of the constraint point based on the positions and attitudes of the elongated insertion portion as detected by the sensor;
wherein the first controller is configured to:
calculate a distance between:
(i) position coordinates of a predetermined point on the medical device as calculated on the basis of the positions and attitudes of the elongated insertion portion as detected by the sensor and
(ii) position coordinates of the predetermined point calculated on the basis of temporary position coordinates of the constraint point; and
output, as estimated values, the temporary position coordinates of the constraint point when the distance converged to a second threshold or smaller.