Master-slave manipulator and medical master-slave manipulator
A master-slave manipulator includes a slave manipulator, a master operation input device, and a control unit. The slave manipulator includes joints having multiple degrees of freedom. The master operation input device allows an operator to uniquely input a position and an orientation. The device includes a first operation unit configured to output the position and orientation, and a second operation unit including at least a joint configured to output value of the joint independently with the output of the first operation unit. The control unit calculates a driving amount of each joint of the slave manipulator using the position and orientation of the second operation unit and controls the slave manipulator in accordance with a joint driving command value.
1. A master-slave manipulator comprising:
a slave manipulator comprising joints including multiple degrees of freedom;
a master operation input device configured to allow an operator to uniquely input a position and an orientation, the master operation input device comprising:
a first operation unit configured to output the position and orientation, and
a second operation unit coupled to the first operation unit, the second operation unit comprising:
an end effector operation unit; and
a joint located between the first operation unit and the end effector operation unit,
wherein the second operation unit is configured to output a value of the joint independently of the output of the first operation unit; and
a control unit configured to:
when the slave manipulator includes no redundant joint,
calculate a first driving amount of each joint of the slave manipulator by using the position and orientation of the first operation unit and the value of the joint of the second operation unit as a position/orientation input command value for the end of the slave manipulator,
generate a first joint driving command value based on the first driving amount, and
control the slave manipulator in accordance with the first joint driving command value, and
when the slave manipulator includes at least a redundant joint,
calculate a second driving amount of each joint of the slave manipulator by hypothetically using the position and orientation from the first operation unit as a position/orientation input command value for the end of the slave manipulator including no redundant joint on the assumption that the distal end of the redundant joint is a fixed joint,
generate a second joint driving command value including a driving amount of the joint of the second operation unit and the second driving amount, and
control the slave manipulator in accordance with the second joint driving command value,
wherein:
the slave manipulator further comprises an interchangeable end effector, and
the control unit determines whether the slave manipulator includes the redundant joint in accordance with the interchange of the end effector, and generates the first or second joint driving command value in accordance with the determination.
2. The master-slave manipulator according to claim 1 , wherein the second operation unit and the redundant joint have the same structure.
3. The master-slave manipulator according to claim 1 , wherein the second operation unit comprises:
operable joints adapted to the multiple degrees of freedom of the slave manipulator and configured to be independently operable, and
a lock unit configured to lock the operable joints that are not adapted to the redundant joint of the slave manipulator to keep these operable joints inoperable.
4. The master-slave manipulator according to claim 1 , wherein the second operation unit is configured to be replaceable with a joint having the same structure as the redundant joint of the slave manipulator.
5. The master-slave manipulator according to claim 1 , wherein the control unit determines whether the slave manipulator includes the redundant joint.
6. The master-slave manipulator according to claim 1 , wherein the interchangeable end effector comprises a surgical instrument.