Control system of multi-joint arm robot apparatus

• US 5,307,447 A
• Filed: 07/23/1992
• Issued: 04/26/1994
• Est. Priority Date: 10/29/1982
• Status: Expired due to Fees

• Current Assignee: Kabushiki Kaisha Toshiba (Toshiba Corporation)
• Original Assignee: Kabushiki Kaisha Toshiba (Toshiba Corporation)
• Inventors: Hitomi, Yutaka, Arimura, Yoshiaki, Kondoh, Mitsunori, Asano, Kuniji, Obama, Masao
• Primary Examiner(s): MacDonald, Allen R.
• Assistant Examiner(s): DAVIS, GEORGE B
• Application Number:
  US07/917,399
• Time in Patent Office: 642 Days
• Field of Search: 395/94, 395/90, 395/80, 901/15, 901/9
• US Class Current: 700/255
• CPC Class Codes: B25J 19/023 including video camera means
• CPC Class Codes: B25J 5/02 travelling along a guideway
• CPC Class Codes: B25J 9/06 characterised by multi-articulated arms
• CPC Class Codes: B25J 9/1625 Truss-manipulator for snake-like motion
• CPC Class Codes: H04N 7/185 from a mobile camera, e.g. for remote control

Abstract

A multi-joint arm robot apparatus comprises a multi-joint arm having a plurality of unit arms coupled in tandem with each other through joints, and a movable support for supporting the proximal portion of the multi-joint arm. The multi-joint arm robot apparatus has motors for controlling joint angles of the joints and a motor for moving the movable support. These motors are driven by a control system. The control system controls the motors to obtain proper joint angles, in such a way that the joints of the multi-joint arm are put into a given path when the movable support is moved a given unit distance.

Claims

1. In a control system for a multi-joint arm robot apparatus including a multi-joint arm having a plurality of unit arms coupled in tandem with each other through joints, said multi-joint arm having first motor means for controlling a joint angle of each of said joints, and first detecting means for detecting the joint angle of each of said joints in accordance with the rotation angle of said first motor means;

and a movable support for supporting a proximal portion of said multi-joint arm, said movable support having second motor means for moving said movable support so as to move said multi-joint arm, and second detecting means for detecting the rotation angle of said second motor means;

said control system comprising;

first distance measuring means for measuring the distance to a front obstacle with respect to a leading unit arm of said multi-joint arm, and second distance measuring means for measuring distances to obstacles in a plurality of side directions; and

controlling means responsive to distance data from said first and second distance measuring means, for permitting said multi-joint arm to move to an advancable direction when there is no contact with the obstacle, and for moving said movable support by a unit distance to move a leading end of said multi-joint arm in the advancable direction, and controlling the joint angle of each of said joints.

2. A system according to claim 1, wherein said controlling means has storage means for storing data on the joint angle of a leading joint of said joints, each time said movable support is moved the unit distance, and controls said joints in such a way that the joint angle of each joint is set to the joint angle of the predecessor joint, each time said movable support is moved by the unit distance.