Weaving control device for articulated robot

Patent metadata

Field	Value
Publication number	US-9505074-B2
Application number	US-201314434083-A
Country	US
Kind code	B2
Filing date	Oct 15, 2013
Priority date	Oct 19, 2012
Publication date	Nov 29, 2016
Grant date	Nov 29, 2016

Abstract

A weaving control device of a multi-joint robot, which achieves high-precision weaving, and suppresses occurrence of weaving movement error stemming from the movement of another joint axis and the dynamic characteristics of the motor driving the joint axis. The weaving control device contains: a signal computation unit that computes the target position signal for each axis; a filter computation unit that computes a target command signal resulting from low-pass filter processing of the target position signal; and a motor control unit that drives each axis with the target command signal as an input. The frequency characteristics of the gain of the motor control unit are configured in an approximately flat manner, and the dynamic characteristics from the target position to the motor output angle are similar to the filter. A weaving signal correction unit computes a target position signal having a corrected gain on the basis of filter characteristics.

First claim

The invention claimed is:

1. A weaving control device for an articulated robot which drives a plurality of joint axes so that a tool attached to the articulated robot traces a desired weaving trajectory, the control device comprising:
a signal computation unit that computes a target position signal for each axis of the articulated robot based on the weaving trajectory;
a filter computation unit that performs low-pass filter processing on the computed target position signal to remove a natural frequency component of the articulated robot, and computers a filter-processed target instruction signal for each axis of the articulated robot; and
a motor control unit that drives each axis of the articulated robot with the filter-processed target instruction signal as input;
wherein the frequency characteristics of gain at the motor control unit are configured approximately flat;
and wherein the signal computation unit computes a gain-corrected target position signal.

2. The control device according to claim 1 ,
wherein the motor control unit includes a position feedback unit and a speed feedback unit and a speed feed-forward unit;
and wherein the signal computation unit computes a gain-corrected target position signal based on filter characteristics at the filter computation unit and the weaving trajectory.

3. The control device according to claim 2 ,
wherein the motor control unit further includes a feed-forward control unit which predicts inertia force, gravity, and friction force acting on an own axis by the own axis accelerating/decelerating, and adds these to a torque instruction value output from the speed feedback unit.

4. The control device according to claim 3 ,
wherein the motor control unit further includes a feed-forward control unit which predicts inertia force and centrifugal/Coriolis force acting on the own axis by another axis accelerating/decelerating, and adds these to a torque instruction value output from the speed feedback unit.

5. The control device according to claim 1 ,
wherein the filter used for the low-pass filter processing is the same for all axes;
and wherein the signal computation unit computes a gain-corrected target position signal by multiplying the target position signal by an inverse of a filter gain in a weaving frequency obtained from filter characteristics of the filter computation unit.

6. The control device according to claim 1 ,
wherein the signal computation unit computes a target position signal subjected to phase compensation, in addition to gain correction, based on filter characteristics of the filter computation unit and weaving frequency obtained from filter characteristics of the filter computation unit.

Assignees

• Kobe Steel Ltd

Inventors

• Wada Takashi
• Nishida Yoshiharu
• Inoue Yoshihide
• Inada Shuichi

Classifications

• Y10S901/42

  Welding · CPC title

• B25J9/1641

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

• B23K9/173

  and of a consumable electrode · CPC title

• B23K9/0216 Primary

  Seam profiling, e.g. weaving, multilayer · CPC title

• B23K9/0953

  using computing means · CPC title