Master-slave manipulator
A master-slave manipulator includes a remote manipulation device, a slave manipulator, and a control unit. The remote manipulation device as a master gives an operating command corresponding to a plurality of degrees of freedom. The slave manipulator includes a plurality of joints corresponding to the degrees of freedom. The slave manipulator includes a redundant joint among the joints. The control unit controls operations of the joints in accordance with the operating command. The control unit calculates an orientation change of the remote manipulation device from the operating command at predetermined time intervals and selects and drives one of the joints in redundancy relationship among the joints in accordance with the orientation change.
1. A master-slave manipulator comprising:
a remote manipulation device as a master which gives an operating command corresponding to a plurality of degrees of freedom;
a slave manipulator which includes a plurality of joints corresponding to the degrees of freedom and includes a redundant joint among the joints; and
a control unit which controls operations of the joints in accordance with the operating command, wherein
the control unit calculates an orientation change of the remote manipulation device from the operating command at predetermined time intervals and selects and drives one of the joints in redundancy relationship among the joints in accordance with the orientation change, and
the control unit selects and drives one of the joints in redundancy relationship among the joints based on an angle formed by an axis representing the orientation change and a predetermined axis of the remote manipulation device.
2. The master-slave manipulator according to claim 1 , wherein the axis representing the orientation change corresponds to a rotation axis in a case where the orientation change is a rotation from before the orientation change to after the orientation change.
3. The master-slave manipulator according to claim 2 , wherein a joint having a rotation axis orthogonal to the axes of the joints in redundancy relationship exists between the joints.
4. The master-slave manipulator according to claim 2 , wherein the joints in redundancy relationship are disposed adjacent to each other.
5. The master-slave manipulator according to claim 2 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
6. The master-slave manipulator according to claim 3 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
7. The master-slave manipulator according to claim 4 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
8. The master-slave manipulator according to claim 1 , wherein a joint having a rotation axis orthogonal to the axes of the joints in redundancy relationship exists between the joints.
9. The master-slave manipulator according to claim 8 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
10. The master-slave manipulator according to claim 1 , wherein the joints in redundancy relationship are disposed adjacent to each other.
11. The master-slave manipulator according to claim 10 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
12. The master-slave manipulator according to claim 1 , wherein the control unit selects and drives the joint closest to a leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device is equal to or below a predetermined value, and selects and drives the joint most distant from the leading end of the slave manipulator among the joints in redundancy relationship in a case where the angle formed by the axis representing the orientation change and the predetermined axis of the remote manipulation device exceeds the predetermined value.
13. The master-slave manipulator according to claim 1 , wherein the control unit sets, as a fixed joint, the joint which is not selected from the joints in redundancy relationship among the joints and calculates driving amounts of the remaining joints by an inverse kinematic calculation.