ROBOT CONTROLLING METHOD, ROBOT APPARATUS, PROGRAM, RECORDING MEDIUM, AND METHOD FOR MANUFACTURING ASSEMBLY COMPONENT

• US 20150360369A1
• Filed: 06/08/2015
• Published: 12/17/2015
• Est. Priority Date: 06/11/2014
• Status: Active Grant

• Current Assignee: Canon Kabushiki Kaisha (Canon Inc.)
• Original Assignee: Canon Kabushiki Kaisha (Canon Inc.)
• Inventors: Ishikawa, Takahiro, Osaka, Tsutomu, Kawamura, Shunsuke
• Granted Patent: US 9,718,187 B2
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: B25J 9/1674 characterised by safety, monitoring, diagnostic
• CPC Class Codes: G05B 2219/34388 Detect correct moment, position, advanced, delayed, then next command
• CPC Class Codes: G05B 2219/37297 Two measurements, on driving motor and on slide or on both sides of motor
• CPC Class Codes: G05B 2219/39098 Estimate stop, brake distance in predef time, then verify if in safe distance
• CPC Class Codes: Y10S 901/09 Closed loop, sensor feedback controls arm movement
• CPC Class Codes: Y10S 901/23 Electric motor
• CPC Class Codes: Y10S 901/25 Gearing
• CPC Class Codes: Y10T 29/49828 Progressively advancing of work assembly station or assembled portion of work
• CPC Class Codes: Y10T 74/20317 including electric motor

Abstract

Feedback control is carried out on respective servomotors so that detection angles detected by respective input-side encoders become target angles to be obtained when a leading end of a robot has moved to a positioning completion position of a first motion. Subsequently, the position of the leading end of the robot is obtained on the basis of the detection angles detected by the respective output-side encoders. The time from a time point at which the detection angles detected by the input-side encoders are brought to the target angles through the feedback control to a time point at which a vibration width of the calculated position of the leading end of the robot relative to the positioning completion position converges within a convergence range is obtained. The obtained time is set in the stopping duration of the robot.

Claims

1. A robot controlling method for controlling an articulated robot, joint driving devices configured to drive respective joints of the articulated robot each including a servomotor, a reduction gear, a motor-side angle detector configured to detect an output angle of the servomotor, and a reduction gear-side angle detector configured to detect an output angle of the reduction gear, the articulated robot being stopped for a stopping duration by a control unit before the articulated robot moves from a first motion to a second motion, the robot controlling method comprising:

a feedback control step of carrying out feedback control on the servomotors such that detection angles detected by the respective motor-side angle detectors become target angles;

a leading end position calculation step of obtaining a position of a leading end of the articulated robot based on detection angles detected by the respective reduction gear-side angle detectors;

a timing step of obtaining a time from a reference time point to a time point at which a vibration width, relative to a positioning completion position, of the position of the leading end of the articulated robot calculated in the leading end position calculation step converges within a convergence range; and

a setting step of setting the time obtained in the timing step as the stopping duration.

2. The robot controlling method according to claim 1,

wherein, in the timing step, in response to the position of the leading end of the articulated robot being expressed in an orthogonal coordinate system, the convergence range is set individually in each axial direction of the orthogonal coordinate system.

3. The robot controlling method according to claim 1,

wherein, in the setting step, in a case in which the stopping duration is stored in a storage unit and the feedback control step, the leading end position calculation step, and the timing step are carried out again, in response to the time obtained in the timing step having changed relative to the stopping duration stored in the storage unit, the stopping duration stored in the storage unit is updated to the time obtained in the timing step.

4. The robot controlling method according to claim 1,

wherein, in the setting step, in a case in which the stopping duration is stored in a storage unit and the feedback control step, the leading end position calculation step, and the timing step are carried out again, in response to the time obtained in the timing step having changed by a predetermined period of time or more relative to the stopping duration stored in the storage unit, the stopping duration stored in the storage unit is updated to the time obtained in the timing step.

5. The robot controlling method according to claim 1, further comprising:

a determination step of determining whether the time obtained in the timing step is equal to or greater than a threshold value set in advance; and

a notification step of issuing a warning in a case in which the determination step determines that the time obtained in the timing step is equal to or greater than the threshold value set in advance.

6. The robot controlling method according to claim 1, further comprising:

an operation parameter changing step of changing an operation parameter of the first motion in accordance with an operation parameter list;

a minimum time detection step of detecting a minimum operation time of the first motion; and

an operation parameter setting step of setting an operation parameter corresponding to a minimum time in the first motion.

7. The robot controlling method according to claim 6,

wherein, in the timing step, in response to the position of the leading end of the articulated robot being expressed in an orthogonal coordinate system, the convergence range is set individually in each axial direction of the orthogonal coordinate system.

8. A robot apparatus, comprising:

an articulated robot including joint driving devices configured to drive respective joints, the joint driving devices each including a servomotor, a reduction gear, a motor-side angle detector configured to detect an output angle of the servomotor, and a reduction gear-side angle detector configured to detect an output angle of the reduction gear; and

a control unit configured to execute each of the steps in the robot controlling method according to claim 1.

9. A program that causes a computer to execute each of the steps in the robot controlling method according to claim 1.

10. A computer readable recording medium storing a program according to claim 9.

11. A method for manufacturing an assembly component, the method comprising:

setting the stopping duration by executing each of the steps in the robot controlling method according to claim 1;

causing the articulated robot to hold a first component and to carry out the first motion; and

the articulated robot having been stopped for the stopping duration, assembling the first component and a second component through the second motion so as to manufacture the assembly component.

12. The method according to claim 11, wherein the stopping duration is set by executing each of the steps in the robot controlling method according to claim 2.

13. The method according to claim 11, wherein the stopping duration is set by executing each of the steps in the robot controlling method according to claim 3.

14. The method according to claim 11, wherein the stopping duration is set by executing each of the steps in the robot controlling method according to claim 4.

15. The method according to claim 11, wherein the stopping duration is set by executing each of the steps in the robot controlling method according to claim 5.