Robot control method, robot apparatus, program, recording medium, and manufacturing method of assembly part

Patent metadata

Field	Value
Publication number	US-2016114483-A1
Application number	US-201514920719-A
Country	US
Kind code	A1
Filing date	Oct 22, 2015
Priority date	Oct 24, 2014
Publication date	Apr 28, 2016
Grant date	—

Abstract

Rotations of respective motors are controlled so that rotational angles of the respective motors become target angles in an operation completion position of a first operation (S 1 : robot operation step). After the robot operation step, a leading edge position of a robot is obtained based on joint angles detected by respective output side encoders (S 5 : leading edge position calculation step). A convergence time until an amplitude at the leading edge of the robot with respect to the operation completion position converges within an allowable range is estimated based on a time change of the calculated leading edge position (S 6 : estimation step). Rotational operations of the respective motors are paused from a time point at which the rotational angles of the respective motors are controlled to be the target angles to a time point at which an elapsed time reaches the estimated convergence time (S 3 and S 7 : pause step).

First claim

What is claimed is:

1 . A robot control method for a multijoint robot including motors for driving respective joints, and joint angle detectors for detecting angles of the respective joints, and for causing the robot to perform a second operation after causing the robot to perform a first operation, by controlling rotations of the respective motors by a control means, the robot control method comprising:
a robot operation step of controlling, by the control means, rotations of the respective motors so that rotational angles of the respective motors become target angles in an operation completion position of the first operation; a leading edge position calculation step of obtaining, by the control means, a position of a leading edge of the robot based on joint angles detected by the respective joint angle detectors, after the robot operation step; an estimation step of estimating, by the control means, a convergence time from when the rotational angles of the respective motors are controlled to be the target angles in the robot operation step to when an amplitude at the leading edge of the robot with respect to the operation completion position converges within an allowable range, based on a time change of the position of the leading edge of the robot that is calculated in the leading edge position calculation step; and a pause step of pausing, by the control means, rotational operations of the respective motors at least from a time point at which the rotational angles of the respective motors are controlled to be the target angles in the robot operation step to a time point at which an elapsed time reaches the convergence time estimated in the estimation step, before causing the robot to perform the second operation.

2 . The robot control method according to claim 1 , wherein in the estimation step, the control means obtains peak values of vibration of the leading edge of the robot based on a time change of the position of the leading edge of the robot that is calculated in the leading edge position calculation step, and estimates the convergence time based on at least two peak values.

3 . The robot control method according to claim 2 , wherein in the estimation step, the control means obtains a log attenuation rate of the at least two peak values, and obtains the convergence time from the log attenuation rate.

4 . The robot control method according to claim 1 ,
wherein in the estimation step, the control means estimates the convergence times in respective axis directions in a world coordinate system, and wherein in the pause step, the control means pauses rotational operations of the respective motors at least from a time point at which the rotational angles of the respective motors are controlled to be the target angles in the robot operation step to a time point at which an elapsed time reaches a longest convergence time among the convergence times.

5 . The robot control method according to claim 1 , further comprising:
a notification determination step of determining, by the control means, whether a chronological change of the convergence time estimated in the estimation step or an actually measured actual convergence time exceeds a preset notification determination value; and a notification step of issuing, by the control means, notification of a warning in a case in which the control means determines that the chronological change exceeds the notification determination value.

6 . The robot control method according to claim 5 , further comprising:
a stop determination step of determining, by the control means, whether a chronological change of the convergence time estimated in the estimation step or an actually measured actual convergence time exceeds a preset stop determination value; and an emergency stop step of stopping, by the control means, an operation of the robot in a case in which the control means determines that the chronological change exceeds the stop determination value.

7 . A computer-readable recording medium storing instructions that, when executed by a computer, cause the computer to perform the method according to claim 1 .

8 . A manufacturing method of an assembly part for manufacturing an assembly part by executing each step of the robot control method according to claim 1 , causing the robot to grip a first part to perform the first operation, and after pausing the robot for the convergence time, assembling the first part to a second part in the second operation.

9 . A robot apparatus comprising:
a multijoint robot including motors for driving respective joints, and joint angle detectors for detecting angles of the respective joints; and a control means configured to control rotations of the respective motors of the robot, and to execute each step of the robot control method according to claim 1 .

Assignees

• Canon Kk

Inventors

• Ishikawa Takahiro
• Osaka Tsutomu
• Kawamura Shunsuke

Classifications

• B25J9/1641 Primary

  compensation for backlash, friction, compliance, elasticity in the joints · CPC title

• B25J9/12

  electric · CPC title

• B25J9/06

  characterised by multi-articulated arms · CPC title

• Y10S901/09

  Closed loop, sensor feedback controls arm movement · CPC title

• G05B2219/39195

  Control, avoid oscillation, vibration due to low rigidity · CPC title