MANIPULATOR SYSTEM
Provided is a manipulator system including: a manipulator that has a treatment tool, an insertion portion having a plurality of channels, and treatment-tool driving parts that move the treatment tool forward/backward and/or rotate the treatment tool in the corresponding channel; an operation input unit to which an operation instruction is input; a channel-in-use detecting part that detects the channel into which the treatment tool has been inserted; a compensation-value setting unit that sets a compensation value on the basis of the channel detected by the channel-in-use detecting part; and a control unit that generates a control signal according to the operation instruction, compensates the generated control signal by using the compensation value, and sends the compensated control signal to the treatment-tool driving part.
1 . A manipulator system comprising:
a manipulator that includes an elongated insertion portion having a plurality of channels formed therethrough in the longitudinal direction, a treatment tool to be inserted into one of the channels of the insertion portion, and a treatment-tool driving part that allows the treatment tool to perform at least one of a forward/backward movement and a rotary movement in the channel;
an operation input unit to which an operator inputs an operation instruction for the treatment tool;
a control unit that generates a control signal for driving the treatment-tool driving part, according to the operation instruction input to the operation input unit;
a channel-in-use detecting part that detects, among the plurality of channels, the channel into which the treatment tool has been inserted; and
a compensation-value setting unit that sets a compensation value for the control signal on the basis of the channel detected by the channel-in-use detecting part,
wherein the control unit compensates the control signal by using the compensation value set by the compensation-value setting unit and sends the compensated control signal to the treatment-tool driving part.
2 . The manipulator system according to claim 1 , further comprising a treatment-tool identifying part that identifies the treatment tool that has been inserted into the channel,
wherein the compensation-value setting unit sets the compensation value additionally on the basis of a dynamic property of the treatment tool identified by the treatment-tool identifying part.
3 . The manipulator system according to claim 1 ,
wherein the insertion portion includes an elongated flexible section that has flexibility and a bendable bending section that is provided at a distal end of the flexible section;
the manipulator system further comprises a bending-section-shape detecting part that detects a bending shape of the bending section; and
the compensation-value setting unit sets the compensation value additionally on the basis of the bending shape of the bending section detected by the bending-section-shape detecting part.
4 . The manipulator system according to claim 1 ,
wherein the insertion portion includes an elongated flexible section that has flexibility and a bendable bending section that is provided at a distal end of the flexible section;
the manipulator system further comprises a flexible-section-shape detecting part that detects a bending shape of the flexible section; and
the compensation-value setting unit sets the compensation value additionally on the basis of the bending shape of the flexible section detected by the flexible-section-shape detecting part.
5 . The manipulator system according to claim 1 , further comprising an external-section-shape detecting part that detects a bending shape of a base-end portion of the treatment tool, the base-end portion being pulled out from the insertion portion to the outside,
wherein the compensation-value setting unit sets the compensation value additionally on the basis of the bending shape of the base-end portion of the treatment tool detected by the external-section-shape detecting part.
6 . The manipulator system according to claim 1 ,
wherein the channels are made of tubes that are disposed in the insertion portion along the longitudinal direction; and
the tubes are fixed in position, in radial position, in the insertion portion.
7 . The manipulator system according to claim 1 ,
wherein the control unit performs feedforward control for the treatment-tool driving part; and
the compensation-value setting unit sets, as the compensation value, a gain that is used for the feedforward control by the control unit.
8 . The manipulator system according to claim 1 ,
wherein the control unit performs feedback control for the treatment-tool driving part; and
the compensation-value setting unit sets, as the compensation value, a gain that is used for the feedback control by the control unit.
9 . The manipulator system according to claim 1 ,
wherein the control unit sends, as the control signal, a control signal on which an offset signal is superimposed, to the treatment-tool driving part; and
the compensation-value setting unit sets, as the compensation value, the offset signal, whose sign is reversed when the direction of movement of the treatment tool is switched to the reverse direction.