Control device and control method for controlling workpiece moving device and robot to operate in cooperation with each other
10723023 ยท 2020-07-28
Assignee
Inventors
Cpc classification
G05B2219/39101
PHYSICS
Y02P90/02
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B23K37/02
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
G05B19/41815
PHYSICS
B23K37/04
PERFORMING OPERATIONS; TRANSPORTING
B25J9/0096
PERFORMING OPERATIONS; TRANSPORTING
B23K31/02
PERFORMING OPERATIONS; TRANSPORTING
B23K26/00
PERFORMING OPERATIONS; TRANSPORTING
International classification
B25J9/00
PERFORMING OPERATIONS; TRANSPORTING
B23K37/04
PERFORMING OPERATIONS; TRANSPORTING
B23K37/02
PERFORMING OPERATIONS; TRANSPORTING
B23K31/02
PERFORMING OPERATIONS; TRANSPORTING
B23K26/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
This control device is able to prevent the position displacement of a workpiece supported by a workpiece moving device. The control device includes a workpiece moving device controller configured to control the workpiece moving device wherein a time constant corresponding to a time period from a commencement to an termination of acceleration and deceleration of the workpiece moving device is longer for causing the robot and the workpiece moving device to perform an operation other than the workpiece processing operation, compared with the time constant for performing a workpiece processing operation in which the robot and the workpiece moving device perform work on the workpiece in cooperation with each other.
Claims
1. A control device configured to control a workpiece moving device moving a workpiece and a robot carrying out a work on the workpiece such that the workpiece moving device and the robot cooperate with each other, the control device comprising a workpiece moving device controller configured to control the workpiece moving device such that a time constant for when the robot and the workpiece moving device perform an operation other than a workpiece processing operation, in which the robot and the workpiece moving device carries out a work on the workpiece in cooperation with each other, is longer than that for when the robot and the workpiece moving device performs the workpiece processing operation, the time constant corresponding to a time period from commencement to termination of acceleration or deceleration of the workpiece moving device.
2. The control device of claim 1, further comprising a robot controller configured to accelerate or decelerate the robot in synchronization with the commencement and the termination of acceleration or deceleration of the workpiece moving device when performing the workpiece processing operation.
3. The control device of claim 1, wherein, when performing the operation other than the workpiece processing operation, the workpiece moving device controller operates the workpiece moving device at a speed higher than that in the workpiece processing operation.
4. The control device of claim 1, wherein the workpiece moving device controller controls the workpiece moving device such that the time constant for the acceleration of the workpiece moving device is shorter than that for the deceleration of the workpiece moving device, when performing the workpiece processing operation or the operation other than the workpiece processing operation.
5. The control device of claim 1, further comprising a time constant determination section configured to determine the time constant depending on a type of workpiece.
6. A method of controlling a workpiece moving device moving a workpiece and a robot carrying out a work on the workpiece such that the workpiece moving device and the robot cooperate with each other, the method comprising controlling the workpiece moving device such that a time constant for when the robot and the workpiece moving device perform an operation other than a workpiece processing operation, in which the robot and the workpiece moving device carries out a work on the workpiece in cooperation with each other, is longer than that for when the robot and the workpiece moving device performs the workpiece processing operation, the time constant corresponding to a time period from commencement to termination of acceleration or deceleration of the workpiece moving device.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
DETAILED DESCRIPTION
(8) Hereinafter, embodiments of the present disclosure will be described in detail with reference to the drawings. Note that, in the various embodiments described below, similar elements are assigned the same reference numeral, and redundant descriptions thereof will be omitted. First, a system 10 according to an embodiment will be described with reference to
(9) The system 10 according to this embodiment is for arc-welding on a workpiece W, and includes a robot 12, a workpiece moving device 14, a driven device 16, and a control device 100. The robot 12 is a vertical articulated robot, and includes a base 18, a revolving drum 20, a robot arm 22, and a wrist 24.
(10) The revolving drum 20 is provided at the base 18 so as to be rotatable about a vertical axis. The robot arm 22 includes a lower arm 26 rotatably connected to the revolving drum 20 and an upper arm 28 rotatably connected to a distal end of the lower arm 26.
(11) The wrist 24 includes a first wrist element 30 rotatably connected to the upper arm 28, a second wrist element 32 rotatably connected to a distal end of the first wrist element 30, and a third wrist element 34 rotatably connected to a distal end of the second wrist element 32.
(12) An end effector 36 is attached to a distal end of the third wrist element 34. In this embodiment, the end effector 36 is a welding torch configured to carry out arc welding on the workpiece W.
(13) Servomotors 38 (
(14) The workpiece moving device 14 includes a base 40, a motor housing 42, and an output flange 44. The motor housing 42 is fixed to the base 40 on a side opposite the output flange 44.
(15) The output flange 44 is provided at the base 40 so as to be rotatable about an axis O. In this embodiment, the output flange 44 has a circular shape. A servomotor 48 (
(16) The driven device 16 includes a base 50 and a driven flange 52 provided at the base 50 so as to be rotatable about the axis O. In this embodiment, the driven flange 52 has a circular shape, and is arranged concentrically with the output flange 44 with respect to the axis O.
(17) A jig 46 for fixing the workpiece W is mounted on the output flange 44 and the driven flange 53. The jig 46 is provided with a plurality of clamp members 54 for clamping the workpiece W, wherein the workpiece W is clamped to the jig 46 by the clamp members 54.
(18) In this way, the workpiece W is fixed to the output flange 44 and the driven flange 52 via the jig 46. When the jig 46 is rotated by the output flange 44, the driven flange 52, which supports the other end of the jig 46, is also driven to rotate about the axis O in accordance with the rotation of the jig 46.
(19) As illustrated in
(20) The robot controller 104 generates a command (an acceleration command, torque command, or current command) to the servomotor 38 built in the robot 12, and controls an operation of the robot 12. In addition, the robot controller 104 transmits a command to the end effector 36 so as to carry out a work (specifically, arc welding) on the workpiece W by the end effector 36.
(21) The control device 100 includes at least one processor and storage (both not illustrated). A single processor may functions as the workpiece moving device controller 102 and the robot controller 104, or different processors may functions as the workpiece moving device controller 102 and the robot controller 104, respectively. The function of the workpiece moving device controller 102 and the robot controller 104 will be described later.
(22) The control device 100 performs a workpiece processing operation to carry out the work on the workpiece W by the end effector 36 while operating the robot 12 and the workpiece moving device 14 in cooperation with each other. Hereinafter, with reference to
(23) The graph shown in section (a) in
(24) As illustrated by a characteristic 60 in section (a) in
(25) Together with this operation, the robot controller 104 accelerates the robot 12 over a time period .sub.a1 from the time point t.sub.1 to a time point t.sub.2, so as to increase the operation speed V.sub.R of the robot 12 from a first speed V.sub.R1 to a second speed V.sub.R2.
(26) The time period .sub.a1 is a time constant .sub.a1 for acceleration of the robot 12, wherein the time point t.sub.1 corresponds to the commencement of the acceleration of the robot 12, while the time point t.sub.2 corresponds to the termination of the acceleration of the robot 12. For example, the first speed V.sub.R1 is zero. Then, the robot controller 104 operates the robot 12 at the constant operation speed V.sub.R2 over a time period .sub.o1 from the time point t.sub.2 to a time point t.sub.3.
(27) Then, the robot controller 104 decelerates the robot 12 over a time period .sub.d1 from the time point t.sub.3 to a time point t.sub.4, so as to decrease the operation speed V.sub.R from the second speed V.sub.R2 to the first speed V.sub.R1. The time period .sub.d1 is a time constant .sub.d1 for deceleration of the robot 12, wherein the time point t.sub.3 corresponds to the commencement of the deceleration, while the time point t.sub.4 corresponds to the termination of the deceleration.
(28) The robot controller 104 stops the operation of the end effector 36 at the time point t.sub.4 to end the work on the workpiece W. In synchronization with such an operation of the robot 12, the workpiece moving device controller 102 of the control device 100 operates the workpiece moving device 14.
(29) Specifically, as illustrated by a characteristic 62 in section (b) in
(30) The time period .sub.a1 is the time constant .sub.a1 for acceleration of the workpiece moving device 14, wherein the time point t.sub.1 corresponds to the commencement of the acceleration of the workpiece moving device 14, while the time point t.sub.2 corresponds to the termination of the acceleration of the workpiece moving device 14. Then, the control device 100 operates the workpiece moving device 14 at the constant operation speed V.sub.W2 over the time period .sub.o1 from the time point t.sub.2 to the time point t.sub.3.
(31) Then, the workpiece moving device controller 102 decelerates the workpiece moving device 14 over the time period .sub.d1 from the time point t.sub.3 to the time point t.sub.4, so as to decrease the operation speed V.sub.W from the second speed V.sub.W2 to the first speed V.sub.W1. The time period .sub.d1 is the time constant .sub.d1 for deceleration of the workpiece moving device 14, wherein the time point t.sub.3 corresponds to the commencement of the deceleration of the workpiece moving device 14, while the time point t.sub.4 corresponds to the termination of the deceleration of the workpiece moving device 14.
(32) In this way, during the workpiece processing operation, the workpiece moving device controller 102 and the robot controller 104 accelerate and decelerate the workpiece moving device 14 and the robot 12, respectively, such that the timing of commencement t.sub.1 and termination t.sub.2 of the acceleration of the workpiece moving device 14 and the robot 12 are synchronized with each other, and the timing of commencement t.sub.3 and termination t.sub.4 of the deceleration of the workpiece moving device 14 and the robot 12 are synchronized with each other.
(33) Thus, during the workpiece processing operation, the control device 100 carries out the work on the workpiece W by the end effector 36 while moving the end effector 36 relative to the workpiece W by the robot 12 in synchronization with moving the workpiece W by the workpiece moving device 14. By synchronizing the timing of commencement and termination of the acceleration and deceleration, it is possible to prevent irregularities in a trajectory of the work (i.e., a trajectory of arc welding) on the workpiece W.
(34) After completing the workpiece processing operation (or before carrying out the workpiece processing operation), the control device 100 carries out an operation other than the workpiece processing operation (hereinafter, referred to as a non-processing operation).
(35) For example, as the non-processing operation, the control device 100 carries out a retracting operation and an approach operation. Specifically, the robot controller 104 operates the robot 12 in a state in which the end effector 36 is deactivated, so as to retract the end effector 36 from the workpiece W (retracting operation). As a result, the end effector 36 is retracted to a position separated from the workpiece W, as illustrated in
(36) Together with this operation, the workpiece moving device controller 102 operates the workpiece moving device 14 so as to rotate the output flange 44 by a predetermined angle, thereby moving the workpiece W to a desired position. Then, the robot controller 104 operates the robot 12 so as to move the end effector 36 to a waiting position for carrying out next workpiece processing operation (approach operation).
(37) Note that, while carrying out the non-processing operation, the control device 100 may operates the robot 12 and the workpiece moving device 14 in cooperation with each other. Specifically, the control device 100 may retract the end effector 36 from the workpiece W by the robot 12 in synchronization with moving the workpiece W by the workpiece moving device 14.
(38) In prior art, the time constant for acceleration or deceleration of the workpiece moving device 14 may be set to one value, and the time constant could not be set arbitrarily. In this case, the time constants .sub.a1 and .sub.d1 for acceleration and deceleration of the workpiece moving device 14 during the non-processing operation are set to a value .sub.SET, which is the same as that in the workpiece processing operation (i.e., .sub.a1=.sub.d1=.sub.SET).
(39) A characteristic 64 in the graph in
(40) Then, the workpiece moving device 14 is operated at the constant speed V.sub.W3 from the time point t.sub.2 to the time point t.sub.3. In this way, the workpiece moving device 14 is operated at a higher speed (V.sub.W3>V.sub.W2) than that in the workpiece processing operation.
(41) Then, the operation speed V.sub.W is decreased from the third speed V.sub.W3 to the first speed V.sub.W1 within the time constant .sub.d1 (=.sub.SET) from the time point t.sub.3 to the time point t.sub.4. In the case of this characteristic 64, the absolute value of an acceleration a during acceleration and deceleration of the workpiece moving device 14 is larger than that in the characteristic 62.
(42) In prior art, one time constant (.sub.SET) for the workpiece moving device 14 may be set to be minimum within an allowable range determined in the device's specification (e.g., the maximum load torque or allowable maximum inertia of the servomotor 48) of the workpiece moving device 14, in light of reduction of a cycle time.
(43) When the workpiece moving device 14 is accelerated and decelerated in accordance with the characteristic 64 (i.e., the non-processing operation) by using such a minimum time constant (.sub.SET), the position displacement of the workpiece W placed on the jig 46 or an excessive load on the servomotor 48 may occur.
(44) In order to avoid such a situation, the control device 100 according to this embodiment controls the workpiece moving device 14 such that the time constant for acceleration and deceleration of the workpiece moving device 14 during the non-processing operation is longer than the time constant (.sub.a1 and .sub.d1) for acceleration and deceleration of the workpiece moving device 14 during the workpiece processing operation.
(45) A characteristic 66 in
(46) In the characteristic 66 according to this embodiment, the workpiece moving device controller 102 accelerates the workpiece moving device 14 from the time point t.sub.1 (commencement of accelerate) to a time point t.sub.5 (termination of acceleration) within a time constant .sub.a2 (>.sub.a1), so as to increase the operation speed V.sub.W of the workpiece moving device 14 from the first speed V.sub.W1 to the third speed V.sub.W3. Then, the control device 100 operates the workpiece moving device 14 at the constant operation speed V.sub.W3 over a time period .sub.o2 (<.sub.01 from the time point t.sub.5 to a time point t.sub.6.
(47) Then, the workpiece moving device controller 102 decelerates the workpiece moving device 14 from the time point t.sub.6 (commencement of deceleration) to the time point t.sub.4 (termination of deceleration) within a time constant .sub.d2, so as to decrease the operation speed V.sub.W from the third speed V.sub.W3 to the first speed V.sub.W1. According to this characteristic 66, the absolute value of the acceleration a when the workpiece moving device 14 is accelerated and decelerated during the non-processing operation can be smaller than in the characteristic 64.
(48) There are various methods of controlling the operation speed V.sub.W in accordance with the characteristic 66. As an example, the storage of the control device 100 pre-stores the time constants .sub.a1 and .sub.d1 for the workpiece processing operation, and the time constants .sub.a2 and .sub.d2 for the non-processing operation.
(49) These time constants .sub.a1, .sub.d1, .sub.a2, and .sub.d2 are predetermined by a user in view of the specification of the jig 46 provided in the workpiece moving device 14 (e.g., clamping force of the jig for clamping the workpiece, or strength of the jig), the specification of the workpiece moving device 14 (e.g., the maximum load torque or allowable maximum inertia of the servomotor 48), work cycle time, etc.
(50) During the workpiece processing operation, the workpiece moving device controller 102 generates a command for the servomotor 48 to operate the workpiece moving device 14 such that the time constants for the acceleration and deceleration of the workpiece moving device 14 are the time constants .sub.a1 and .sub.d1, respectively, as illustrated in the characteristic 62 in
(51) On the other hand, during the non-processing operation, the workpiece moving device controller 102 generates a command for the servomotor 48 to operate the workpiece moving device 14 such that the time constants for the acceleration and deceleration of the workpiece moving device 14 are the time constants .sub.a2 and .sub.d2, respectively, as illustrated in the characteristic 66 in
(52) In this way, the workpiece moving device controller 102 controls the operation of the workpiece moving device 14 in accordance with the predetermined time constants .sub.a1, .sub.d1, .sub.a2, and .sub.d2 (so-called, time constant control).
(53) As another example, the workpiece moving device controller 102 generates a command (an acceleration command, a torque command, or a current command) for the servomotor 48 of the workpiece moving device 14 to control the workpiece moving device 14 such that the acceleration a of the workpiece moving device 14 does not exceed an allowable maximum value a.sub.MAX (so-called, acceleration control, torque control, or current control).
(54) This allowable maximum value a.sub.MAX depends on the specification of the jig 46 (e.g., clamping force or strength) and the specification of the workpiece moving device 14 (e.g., the maximum load torque or allowable maximum inertia).
(55) In this example, when accelerating the workpiece moving device 14 during the workpiece processing operation, the workpiece moving device controller 102 transmits a command C.sub.a1 to the servomotor 48 so as to increase the operation speed V.sub.W of the workpiece moving device 14 from the first speed V.sub.W1 to the second speed V.sub.W2.
(56) In addition, when decelerating the workpiece moving device 14 during the workpiece processing operation, the workpiece moving device controller 102 transmits a command C.sub.d1 to the servomotor 48 so as to decrease the operation speed V.sub.W of the workpiece moving device 14 from the second speed V.sub.W2 to the first speed V.sub.W1.
(57) On the other hand, when accelerating the workpiece moving device 14 during the non-processing operation, the workpiece moving device controller 102 transmits a command C.sub.a2 to the servomotor 48 so as to increase the operation speed V.sub.W of the workpiece moving device 14 from the first speed V.sub.W1 to the third speed V.sub.W3.
(58) In addition, when decelerating the workpiece moving device 14 during the non-processing operation, the workpiece moving device controller 102 transmits a command C.sub.d2 to the servomotor 48 so as to decrease the operation speed V.sub.W of the workpiece moving device 14 from the third speed V.sub.W3 to the first speed V.sub.W1.
(59) The above-mentioned commands C.sub.a1, C.sub.a2, C.sub.d1, and C.sub.d2 are predetermined by the user as values with which the acceleration a of the workpiece moving device 14 does not exceed the allowable maximum value a.sub.MAX, and stored in the storage of the control device 100. For example, the commands C.sub.a1, C.sub.a2, C.sub.d1, and C.sub.d2 are set such that the acceleration a of the workpiece moving device 14 becomes as large as possible within a range not exceeding the allowable maximum value a.sub.MAX.
(60) Due to this, the workpiece moving device 14 is accelerated or decelerated such that the acceleration a thereof does not exceed the allowable maximum value a.sub.MAX during the non-processing operation. As a result, the time constants for the acceleration and deceleration of the workpiece moving device 14 become the time constants .sub.a2 (>.sub.a1) and .sub.d2 (>.sub.d1), as illustrated in the characteristic 66 in
(61) As described above, according to this embodiment, it is possible to prevent the acceleration a of the workpiece moving device 14 from being excessively large when the workpiece moving device 14 is accelerated or decelerated during the non-processing operation. Thereby, it is possible to prevent the position displacement of the workpiece W placed on the jig 46 or an excessive load on the servomotor 48 from occurring.
(62) Note that, the time constant .sub.a1 for the acceleration during the workpiece processing operation may be set shorter than the time constant .sub.d1 for the deceleration. In addition, the time constant .sub.a2 for the acceleration during the non-processing operation may be set shorter than the time constant .sub.d2 for the deceleration.
(63) By setting the time constants .sub.a1, .sub.d1, .sub.a2, .sub.d2 in this way, it is possible to advantageously decrease residual vibration of the output flange 44 (and the end effector 36) when the operation speed V.sub.W (and V.sub.R) of the workpiece moving device 14 (and the robot 12) is decelerated from the second speed V.sub.W2 (and V.sub.R2) to the first speed V.sub.W1 (and V.sub.R1). However, the time constants may be set as .sub.a1=.sub.d1 or .sub.a2=.sub.d2.
(64) Next, a control device 100 according to another embodiment will be described with reference to
(65) A plurality of types of workpiece are processed in the system 10. The various workpieces to be processed can be classified into different types on the basis of the weight, shape, or dimension, etc. thereof (e.g., type A=workpiece weight: 10 kg, type B=workpiece weight: 15 kg, type C=workpiece weight: 30 kg, . . . ).
(66) In this embodiment, the time constant determination section 106 automatically determines the above-described time constants .sub.a2 and .sub.d2 depending on the type of workpiece to be processed. As an example, the storage of the control device 100 stores a data table that indicates the relationship between the type of workpiece and the time constants .sub.a2 and .sub.d2.
(67) The time constants .sub.a2 and .sub.d2 included in this data table for each type of workpiece are predetermined by the user on the basis of the information relating to the type of workpiece (e.g., a workpiece weight), the specification of the jig 46 (e.g., the clamping force, the strength), and the specification of the workpiece moving device 14 (e.g., the maximum load torque, allowable maximum inertia).
(68) The control device 100 receives an input for identifying the type of workpiece from the user, host controller, or operation program. Upon reception of the input, the time constant determination section 106 identifies the type of workpiece, reads out from the data table the time constants .sub.a2 and .sub.d2 corresponding to the identified type, and determines the read-out time constants .sub.a1 and .sub.d2 as those to be used for acceleration and deceleration of the workpiece moving device 14 during the non-processing operation.
(69) As another example, the control device 100 may temporarily operate the workpiece moving device 14 when a workpiece to be processed is set on the workpiece moving device 14, and determine the time constants .sub.a1 and .sub.d2 on the basis of a feedback value transmitted from the servomotor 48 at this time.
(70) Specifically, an operator sets the workpiece on the jig 46. Then, the workpiece moving device controller 102 transmits a command to the servomotor 48 so as to temporarily operate the workpiece moving device 14 (i.e., rotate the output flange 44 by a predetermined angle).
(71) At this time, the servomotor 48 transmits a feedback value (e.g., a load torque value or a feedback current value) to the control device 100. This feedback value depends on a load applied to the servomotor 48 (i.e., the weight of the workpiece set on the workpiece moving device 14). The time constant determination section 106 determines the time constants .sub.a2 and .sub.d2 on the basis of the feedback value received from the servomotor 48.
(72) For example, the storage of the control device 100 stores a data table indicating the relationship between the feedback values from the servomotor 48 and the time constants .sub.a2 and .sub.d2. The time constants .sub.a2 and .sub.d2 included in this data table for each feedback value are predetermined by the user on the basis of e.g. the specification of the jig 46 and the specification of the workpiece moving device 14.
(73) The time constant determination section 106 reads out from the data table the time constants .sub.a2 and .sub.d2 corresponding to the received feedback value, and determines the read-out time constants .sub.a2 and .sub.d2 as those to be used for acceleration and deceleration of the workpiece moving device 14 during the non-processing operation.
(74) Alternatively, the time constant determination section 106 may determine the time constants .sub.a2 and .sub.d2 by calculation from the feedback value received from the servomotor 48.
(75) By using the above-described methods, the time constant determination section 106 can determine the time constants .sub.a2 and .sub.d2 for acceleration and deceleration of the workpiece moving device 14 during the non-processing operation, in response to the type of workpiece to be processed.
(76) Then, the workpiece moving device controller 102 performs the time constant control, acceleration control, torque control, or current control of the workpiece moving device 14 such that the workpiece moving device 14 is accelerated with the determined time constant .sub.a2, and decelerated with the determined time constant .sub.d2, as illustrated in the characteristic 66 in
(77) According to this embodiment, if a plurality of types of workpiece are to be processed, it is possible to automatically determine the time constants .sub.a2 and .sub.d2 for the non-processing operation, depending on the type of workpiece to be processed. Thereby, it is possible to optimize the time constants .sub.a2 and .sub.d2 in response to the type of workpiece, and therefore, the cycle time for work can be reduced while preventing the acceleration a of the workpiece moving device 14 from exceeding the allowable maximum value a.sub.MAX.
(78) In the above-described embodiment, the system 10 is for carrying out arc welding on the workpiece W. However, the system 10 may be a system for carrying out a work, such as laser machining or material spraying, on the workpiece W.
(79) For example, if the system 10 is for laser machining, the end effector 36 is a laser emission nozzle. O the other hand, if the system 10 is for material spraying, the end effector 36 is a material spraying nozzle.
(80) The workpiece moving device 14 is not limited to the one that rotates the circular output flange 44 about the axis O, but may be configured to move a rectangular output flange along a predetermined x-y plane (e.g., a horizontal plane), for example.
(81) In the embodiment illustrated in
(82) Such an embodiment is illustrated in
(83) While the present disclosure has been described through the embodiments, the above-described embodiments do not limit the invention as defined by the appended claims.