Remote control robot system

Patent metadata

Field	Value
Publication number	US-10932874-B2
Application number	US-201615755141-A
Country	US
Kind code	B2
Filing date	May 27, 2016
Priority date	Aug 25, 2015
Publication date	Mar 2, 2021
Grant date	Mar 2, 2021

Abstract

A remote control robot system includes a master arm, and a slave arm having a plurality of control modes of an automatic mode in which the slave arm operates based on a prestored task program and a manual mode in which the slave arm operates based on manipulation of an operator received by the master arm. The master arm includes one or more motors configured to drive joints of the master arm, and a motor actuator configured to generate a torque instruction value that operates the joints according to an external force applied to the master arm and gives drive current corresponding to the torque instruction value to the motor. The motor actuator generates, when the control mode is the manual mode, the torque instruction value so that the joints operate according to the external force while resisting a frictional force of the motor.

First claim

What is claimed is:

1. A remote control robot system, comprising:
hardware constituted by a general-purpose industrial robot arm including a plurality of links consecutively connected to each other through joints, one or more motors configured to drive the joints, and a motor actuator configured to apply drive current to the one or more motors;
a processor programed to operate the general-purpose industrial robot arm such that the general-purpose industrial robot arm serves as a master arm configured to receive manipulation of an operator; and
a slave arm having a plurality of control modes including an automatic mode in which the slave arm operates based on a prestored task program and a manual mode in which the slave arm operates based on the manipulation of the operator received by the master arm,
wherein, in the manual mode, the motor actuator (i) generates a torque instruction value that operates the joints according to an external force applied to the master arm, (ii) calculates a friction compensation torque correcting value so that the joints operate according to the external force while resisting a frictional force of the one or more motors, and (iii) generates the torque instruction value that is corrected by the friction compensation torque correcting value.

2. The remote control robot system of claim 1 , wherein,
the master arm further includes a switching means configured to switch ON/OFF of the friction compensation, and
the motor actuator generates, in the manual mode, the torque instruction value that is corrected by the friction compensation torque correcting value in response to the switching means being ON.

3. The remote control robot system of claim 1 , wherein,
the plurality of control modes further includes a correctable automatic mode in which the slave arm operates based on the task program, while being corrected sequentially, by the manipulation of the operator received by the master arm, and
in the correctable automatic mode, the motor actuator calculates the friction compensation torque correcting value so that the joints operate according to the external force while resisting the frictional force of the one or more motors, and generates the torque instruction value that is corrected by the friction compensation torque correcting value.

4. The remote control robot system of claim 3 , wherein,
the master arm further includes a switching means configured to switch ON/OFF of the friction compensation, and
the motor actuator generates, in the correctable automatic mode, the torque instruction value that is corrected by the friction compensation torque correcting value in response to the switching means being ON.

5. The remote control robot system of claim 1 , wherein the motor actuator generates an inertia force compensation torque correcting value that compensates an inertia force acting on the master arm, and generates the torque instruction value that is corrected by the inertia force compensation torque correcting value.

6. The remote control robot system of claim 1 , wherein the motor actuator generates a gravity compensation torque correcting value that compensates gravity acting on the master arm, and generates the torque instruction value that is corrected by the gravity compensation torque correcting value.

7. The remote control robot system of claim 1 , wherein the motor actuator calculates the friction compensation torque correcting value based on a prestored frictional-force model of the one or more motors.

Assignees

• Kawasaki Heavy Ind Ltd

Inventors

• Hashimoto Yasuhiko
• Kamon Masayuki

Classifications

• H04N23/611

  where the recognised objects include parts of the human body · CPC title

• A61B34/70

  Manipulators specially adapted for use in surgery · CPC title

• A61B34/37 Primary

  Leader-follower robots (A61B34/35 takes precedence) · CPC title

• A61B34/35

  for telesurgery · CPC title

• B25J9/1689

  Teleoperation · CPC title