Robot control device

The robot control device addresses the issue of inaccurate movement and signal timing reproduction by storing and synchronizing position and orientation information with external signals, enabling precise control and improved production quality.

WO2024236653A1PCT designated stage expired Publication Date: 2024-11-21FANUC LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
PCT/JP2023/017956
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-12
Publication Date
2024-11-21

AI Technical Summary

Technical Problem

Conventional robot control systems fail to accurately reproduce the intended movements and timing of external signals during direct teaching, leading to deviations in motion paths and signal outputs that affect production quality.

Method used

A robot control device that stores position and orientation information every cycle and external signal information every second cycle, using a processor to output control signals for the robot and external peripheral devices in synchronization, ensuring accurate reproduction of operator-intended movements and signal timings.

Benefits of technology

The system accurately reproduces the intended movements and timing of external signals, improving production quality by ensuring precise control of robot movements and peripheral device operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure JP2023017956_21112024_PF_FP_ABST
    Figure JP2023017956_21112024_PF_FP_ABST
Patent Text Reader

Abstract

The present invention provides a technique that enables a robot to accurately reproduce a movement intended by an operator, and can also accurately reproduce the output timing of an external signal from a robot control device to external peripheral equipment as intended by the operator. Provided is a robot control device for controlling a robot for changing the position and posture of external peripheral equipment, the robot control device comprising at least one storage device and at least one processor. The storage device stores the position and posture information of the robot every first cycle during direct teaching, and stores external signal information including ON / OFF signals of the external peripheral equipment every second cycle during direct teaching. The processor reads the position and posture information every first cycle, outputs a signal for controlling the position and posture of the robot, reads the external signal information every second cycle, and outputs a signal for controlling the external peripheral equipment to operate in conjunction with the robot.
Need to check novelty before this filing date? Find Prior Art

Description

Robot control device

[0001] The present disclosure relates to a robot control device.

[0002] Conventionally, a direct teaching function has been used in which an operator directly holds a robot arm in his or her hand and applies force to move the robot, thereby changing the position and posture of the robot and teaching the robot how to move (see, for example, Patent Document 1). Another known technique is to store several positions and postures achieved during direct teaching as teaching points, and then automatically generate an operation program as an operation command for interpolating the teaching points to move the robot. This technique has the advantage that the operation program can be easily modified after teaching.

[0003] JP 2023-38776 A

[0004] However, with the above technology, when an operation program is executed, the interpolated path between teaching points may not accurately reproduce the movement intended by the operator. In such cases, it is also difficult to reproduce the output of external signals from the robot control device to external peripheral devices at the timing intended by the operator. For example, for an external signal that controls the opening and closing of a door, a slight change in output timing has little impact on production quality. However, in the case of an external signal that controls the output start and end timing of a coating device or laser processing device in a coating material application operation or laser processing operation on a workpiece, a timing discrepancy significantly affects production quality.

[0005] The present disclosure has been made in consideration of the above-mentioned problems, and aims to provide technology that enables a robot to accurately reproduce the movements intended by an operator, and that enables the output timing of external signals from a robot control device to external peripheral devices to accurately reproduce the timing intended by the operator.

[0006] The present disclosure relates to a robot control device that controls a robot that changes the position and posture of an external peripheral device, the robot control device comprising at least one storage device and at least one processor, wherein the storage device stores position and posture information of the robot for each first period during direct teaching, and stores external signal information including an ON / OFF signal of the external peripheral device for each second period during the direct teaching, and the processor reads out the position and posture information stored in the storage device for each first period and outputs a signal for controlling the position and posture of the robot, and reads out the external signal information stored in the storage device for each second period and outputs a signal for controlling the external peripheral device to link with the robot.

[0007] FIG. 1 is a diagram illustrating a robot system including a robot control device according to an embodiment of the present disclosure; FIG. 2 is a functional block diagram of a robot control device according to an embodiment of the present disclosure; FIG. 3 is a diagram for explaining position and posture information of a robot and external signal information of external peripheral devices; FIG. 4 is a flowchart illustrating an example of a procedure for an action storage process by a robot control device according to an embodiment of the present disclosure; FIG. 5 is a flowchart illustrating an example of a procedure for an action reproduction process by a robot control device according to an embodiment of the present disclosure; FIG. 6 is a diagram illustrating a robot system including a robot control device according to another embodiment of the present disclosure.

[0008] Hereinafter, an embodiment of the present disclosure will be described in detail with reference to the drawings.

[0009] 1 is a diagram illustrating a robot system 4 including a robot control device 1 according to an embodiment of the present disclosure. As shown in FIG. 1, the robot system 4 of this embodiment includes the robot control device 1, a robot 2, and a coating device 3 as an external peripheral device.

[0010] The robot system 4 according to this embodiment is a system that includes a coating nozzle 31 of a coating device 3 at the tip of a robot arm 20, and applies a coating material to a workpiece W while changing the position and posture of the coating nozzle 31 by controlling the position and posture of the robot 2. The robot system 4 according to this embodiment has a direct teaching function that allows an operator to directly hold the robot arm 20 in his / her hand, for example, and apply force to move the robot 2 while changing the position and posture of the robot 2, thereby teaching the robot how to move.

[0011] The robot control device 1 is a computer that controls the position and posture of the robot 2 in order to apply the coating material to the workpiece W. The robot control device 1 controls the position and posture of the robot 2 based on robot operation path information taught by a direct teaching function. Details of the robot control device 1 will be described later.

[0012] The robot 2 is, for example, a six-axis vertical articulated robot, and as described above, is provided with a coating nozzle 31 at the tip of the robot arm 20. The operation of the robot 2 is controlled by the robot control device 1, and the robot 2 discharges a coating material from the coating nozzle 31 onto the workpiece W in conjunction with the operation of the robot 2 to coat it.

[0013] The robot 2 also has a plurality of state detectors 21 for detecting the position and posture of the robot 2. The state detectors 21 are composed of servo motors provided on each drive axis of the robot arm 20, and position (rotation angle) detectors such as encoders attached to each servo motor. For convenience, only the state detector 21 for one drive axis is shown in Fig. 1. During direct teaching, the torque, speed, and position are detected by these plurality of state detectors 21, thereby obtaining the position and posture of the robot 2 and making it possible to obtain robot motion path information.

[0014] Alternatively, an operating part (not shown) such as an operating handle may be provided on the wrist of the robot 2, and a force sensor may be built in to detect the force applied to the operating part by the operator, and the position and posture of the robot 2 may be acquired according to the magnitude and direction of the force detected by the force sensor.

[0015] The coating device 3 applies a coating material to the workpiece W. Examples of the coating device 3 include a cream coating device that applies cream to a decorated cake as the workpiece W as shown in Fig. 1, a painting device that applies paint, a sealing device that applies a sealant, and a gluing device that applies adhesive.

[0016] The coating device 3 includes, for example, a hopper into which the coating material is introduced, a storage tank for storing the coating material, a pump and supply pipe for pressurizing the coating material stored in the storage tank, and a coating nozzle 31 for ejecting the coating material.

[0017] Next, the robot control device 1 will be described in detail. Fig. 2 is a functional block diagram of the robot control device 1 according to this embodiment. The robot control device 1 according to this embodiment is configured using a computer including, for example, memories such as a ROM (read only memory) and a RAM (random access memory), a CPU (control processing unit), and a communication control unit, all connected to each other via a bus. The functions and operations of each functional unit, which will be described later, are achieved by cooperation between the CPU and memory installed in the computer and the control program stored in the memory.

[0018] The robot control device 1 may include a teaching operation panel (not shown). The teaching operation panel may include a display unit such as a monitor that can display an operation program, and a touch panel or keypad that can input teaching commands and the like.

[0019] 2, the robot control device 1 includes a storage device 11 and a processor 14. A plurality of storage devices 11 and a plurality of processors 14 may be provided.

[0020] The storage device 11 includes a position and orientation information storage unit 12 and an external signal information storage unit 13 .

[0021] The position and orientation information storage unit 12 acquires and stores the position and orientation information of the robot 2 as movement path information of the robot 2. Specifically, the position and orientation information storage unit 12 acquires and stores the position and orientation information from the rotation angles of each servo motor detected during direct teaching, etc.

[0022] More specifically, during direct teaching, the position and orientation information storage unit 12 of this embodiment acquires and stores the position and orientation information of the robot 2 every first period, for example, every few milliseconds, such as 8 milliseconds. FIG. 3 is a diagram illustrating the position and orientation information of the robot 2 and external signal information of the external peripheral device (coating device 3). As shown in FIG. 3, the position and orientation information of the robot 2 may include, for example, coordinate values ​​of each axis of the robot 2 at each time, i.e., information on the rotation angle values ​​J1 to J6 of each of the six axes. Alternatively, information may include Cartesian coordinate values ​​at each time, i.e., coordinate values ​​of the X-axis, Y-axis, and Z-axis, rotation angle values ​​of the A-axis, B-axis, and C-axis around these axes, and information on the configuration value P.

[0023] During direct teaching, the external signal information storage unit 13 acquires and stores external signal information including ON / OFF signals of external peripheral devices every second period, for example, every few milliseconds such as 8 milliseconds. The second period may be the same as or different from the first period. For example, the first period may be 5 milliseconds, and the second period may be 1 millisecond or 10 milliseconds.

[0024] Furthermore, the timing at which the position and orientation information storage unit 12 acquires the position and orientation information and the timing at which the external signal information storage unit 13 acquires the external signal information may be the same or different, as long as the acquisition timings of both can be linked together. For example, the external signal information storage unit 13 may acquire and store external signal information of an external peripheral device (coating device 3) when acquiring the position and orientation information of the robot 2 during direct teaching.

[0025] The external signal information includes at least an ON / OFF signal, which is an IO status signal of the external peripheral device (applicator 3). Specifically, in the case of the applicator 3, the external signal information is a signal that notifies the start / stop timing of application, as shown in Fig. 3. Note that the external signal information may also include a signal that variably controls the amount of application material discharged from the application nozzle 31 of the applicator 3 (for example, the amount of cream discharged as shown in Fig. 3).

[0026] In this way, the storage device 11 of this embodiment stores external signal output data of external peripheral devices acquired in conjunction with the time-series data of the position and orientation of the robot 2. That is, the storage device 11 stores the ON / OFF timing signals of the coating device 3, which serve as electrical signals for communicating with external peripheral devices, in conjunction with the operation of the robot 2.

[0027] As shown in FIG. 2, the processor 14 includes a position and orientation control unit 15 and an external peripheral device control unit 16 .

[0028] The position and orientation control unit 15 reads out the position and orientation information stored in the position and orientation information storage unit 12 for each first period and outputs a signal for controlling the position and orientation of the robot 2. Specifically, the position and orientation control unit 15 uses the position and orientation data read out for each first period as a control command and outputs a signal for controlling the servo motors provided on each axis of the robot 2. This controls the position and orientation of the robot 2, making it possible to change the position and orientation of the coating nozzle 31 of the coating device 3, which serves as an external peripheral device.

[0029] The external peripheral device control unit 16 reads out the external signal information stored in the external signal information storage unit 13 at every second period, and outputs a signal for controlling the external peripheral device so as to link with the robot 2. Specifically, the external peripheral device control unit 16 links with the robot 2 to cause the coating material to be discharged from the coating nozzle 31 of the coating device 3 serving as the external peripheral device.

[0030] Next, an example of the motion storage process and the motion reproduction process executed by the robot control device 1 according to this embodiment during direct teaching will be described in detail with reference to FIGS. 4 and 5. FIG.

[0031] 4 is a flowchart showing an example of the procedure of the operation storage process by the robot control device 1 according to this embodiment. This process is repeatedly executed during direct teaching.

[0032] In step S11, the position and orientation information of the robot 2 and the external signal information of the external peripheral device (coating device 3) are acquired. That is, the position and orientation information and the external signal information are acquired in synchronization with each other. Then, the process proceeds to step S12.

[0033] In step S12, it is determined whether the position and orientation information acquired in step S11 is being stored in the position and orientation information storage unit 12 and whether the external signal information acquired in step S11 is being stored in the external signal information storage unit 13. If this determination is YES, the process proceeds to step S13, and if NO, the operation storage process ends.

[0034] In step S13, the i-th position and orientation information currently processed, that is, the position and orientation information acquired in step S11, is stored in the position and orientation information storage unit 12. After that, the process proceeds to step S14.

[0035] In step S14, the i-th external signal information currently processed, that is, the external signal information acquired in step S11, is stored in the external signal information storage unit 13. After that, the process proceeds to step S15.

[0036] In step S15, the process waits for 8 milliseconds. After that, the process returns to step S11. This causes the process to move to the (i+1)th process, and the series of processes from step S11 to step S15 is repeatedly executed every 8 milliseconds.

[0037] 5 is a flowchart showing an example of the procedure of the operation reproduction process by the robot control device 1 according to this embodiment. This process is repeatedly executed during direct teaching.

[0038] In step S21, the i-th processing position and orientation information is read from the position and orientation information storage unit 12, and the i-th processing external signal information is read from the external signal information storage unit 13. After that, the process proceeds to step S22.

[0039] In step S22, it is determined whether the position and orientation control unit 15 is currently reproducing the position and orientation of the robot 2 based on the position and orientation information read out in step S21, or whether the external peripheral device control unit 16 is currently reproducing the state of the external peripheral device (coating device 3) based on the external signal information read out in step S21. If this determination is YES, the process proceeds to step S23, and if NO, the operation reproduction process is terminated.

[0040] In step S23, the external peripheral device control unit 16 applies the external signal information read out in step S21 to the external peripheral device (coating device 3), and reproduces the state of the external peripheral device (coating device 3) based on the external signal information. Then, the process proceeds to step S24.

[0041] In step S24, the position and orientation control unit 15 controls the robot 2 using the position and orientation information read out in step S21 as a control command, and reproduces the position and orientation of the robot 2 based on the position and orientation information. Then, the process proceeds to step S25.

[0042] In step S25, the process waits for 8 milliseconds. After that, the process returns to step S21. This causes the process to move to the (i+1)th process, and the series of processes from step S21 to step S25 is repeatedly executed every 8 milliseconds.

[0043] According to this embodiment, the following effects are achieved.

[0044] In this embodiment, the storage device 11 stores position and orientation information of the robot 2 for each first period during direct teaching, and stores external signal information including ON / OFF signals of the external peripheral devices 3 and 31 for each second period during direct teaching. The processor 14 reads the position and orientation information stored in the storage device 11 for each first period and outputs a signal for controlling the position and orientation of the robot 2, and reads the external signal information stored in the storage device 11 for each second period and outputs a signal for controlling the external peripheral devices 3 and 31 so as to link with the robot 2. This allows the robot 2 and the external peripheral devices to be controlled based on the position and orientation information of the robot 2 and the external signal information of the external peripheral devices, which are acquired periodically (e.g., every few milliseconds) in linkage with each other during direct teaching. This makes it possible to provide a robot control device 1 that allows the robot to accurately reproduce the movements intended by the operator and that can accurately reproduce the timing of outputting external signals from the robot control device 1 to the external peripheral devices as intended by the operator.

[0045] In this embodiment, the first period and the second period may be the same or different periods, and the timing at which the storage device 11 acquires the position and orientation information and the timing at which the external signal information is acquired may be the same or different periods. In either case, the same effects as those described above are achieved.

[0046] In this embodiment, the external peripheral device is the coating device 3. The processor 14 changes the position and posture of the coating nozzle 31 of the coating device 3 by outputting a signal for controlling the position and posture of the robot 2, and the processor 14 outputs a signal for discharging the coating material from the coating nozzle 31 in conjunction with the robot 2. As a result, during the coating operation of the coating material on the workpiece W, the robot 2 can accurately reproduce the operator's intended movements through direct teaching, and the robot control device 1 can accurately reproduce the timing of discharging the coating material from the coating nozzle 31 as intended by the operator. Therefore, the coating operation of a skilled worker can be accurately taught to the robot 2 and accurately reproduced, thereby improving production quality. Furthermore, while an operator typically has hardware such as a button or foot pedal to turn the coating device 3 on and off while directly moving the robot arm 20 with their hands, the present invention can accurately teach and reproduce even the operator's ON timing, taking into account the time lag until the coating material is actually output from the coating device 3.

[0047] Although the present disclosure has been described in detail, the present disclosure is not limited to the individual embodiments described above. Various additions, substitutions, modifications, partial deletions, etc. are possible in these embodiments without departing from the gist of the present disclosure or the spirit of the present disclosure derived from the content of the claims and their equivalents. These embodiments can also be implemented in combination. For example, in the above-described embodiments, the order of each operation and the order of each process are shown as examples and are not limited to these. The same applies when numerical values ​​or mathematical expressions are used in the description of the above-described embodiments.

[0048] For example, in the above embodiment, the coating device 3 is used as an example of the external peripheral device, but a laser processing device can also be used as the external peripheral device. Here, Fig. 6 is a diagram showing a robot system 4A including a robot control device 1A according to another embodiment of the present disclosure.

[0049] 6, a robot system 4A includes a robot control device 1A, a robot 2A, and a laser processing device 3A as an external peripheral device. The configuration of the robot control device 1A is basically the same as that of the robot control device 1 described in the above embodiment. The configuration of the robot 2A is the same as that of the robot 2 described in the above embodiment.

[0050] The laser processing device 3A performs laser processing (laser welding, laser cutting, etc.) by irradiating a laser onto a workpiece W. The laser processing device 3A includes a laser processing head 30, a laser oscillator 32, and a light guide path 33. The laser processing head 30 includes a laser processing nozzle 31A at its tip that emits a laser.

[0051] The laser processing head 30 is detachably attached to the wrist of the robot 2 A. The laser processing head 30 includes optical system components such as an optical lens and a lens driving mechanism.

[0052] The laser oscillator 32 generates laser light by internally oscillating a laser in response to a command from a laser control unit provided in the robot control device 1 A. The type of the laser oscillator 32 is not limited, and any conventionally known laser oscillator can be used.

[0053] The light guide path 33 guides the laser generated by the laser oscillator 32 to the laser processing head 30 and the laser processing nozzle 31A. The light guide path 33 is composed of various light guide materials such as optical fibers, reflecting mirrors, optical lenses, etc.

[0054] In another embodiment of the present disclosure, the external peripheral device is a laser processing device 3A. The processor 14 changes the position and posture of the laser processing head 30 of the laser processing device 3A by outputting a signal for controlling the position and posture of the robot 2A, and the processor 14 outputs a signal for irradiating a laser from the laser processing nozzle 31A of the laser processing head 30 in conjunction with the robot 2A. This allows the robot 2A to accurately reproduce the operator's intended movements during laser processing of the workpiece W through direct teaching, and the robot control device 1A can also accurately reproduce the operator's intended timing for irradiating the laser from the laser processing nozzle 31A. Therefore, the robot 2A can be accurately taught and accurately reproduced laser processing operations performed by an expert, thereby improving production quality.

[0055] In all of the above-described embodiments, the storage device 11 acquires and stores the external signal information every second period, and the processor 14 reads out the external signal information every second period, but this is not limiting. It is also possible to adopt a configuration in which the period for acquiring and reading out the external signal information is not limited.

[0056] The following supplementary notes are further disclosed regarding the above-described embodiments and modifications: (Supplementary Note 1) A robot control device (1, 1A) for controlling a robot (2, 2A) that changes the position and posture of an external peripheral device (31, 31A) includes at least one storage device (11) and at least one processor (14), wherein the storage device (11) stores position and posture information of the robot (2, 2A) for each first period during direct teaching, and stores external signal information including an ON / OFF signal of the external peripheral device (3, 3A) for each second period during direct teaching, and the processor (14) reads out the position and posture information stored in the storage device (11) for each first period and outputs a signal for controlling the position and posture of the robot (2, 2A), and reads out the external signal information stored in the storage device (11) for each second period and outputs a signal for controlling the external peripheral device (3, 3A) to link with the robot (2, 2A).

[0057] (Supplementary Note 2) In the robot control device (1), the first period and the second period may be the same or different periods.

[0058] (Supplementary Note 3) In the robot control device (1), the timing at which the storage device (11) acquires the position and orientation information and the timing at which the storage device (11) acquires the external signal information may be the same or different.

[0059] (Note 4) In the robot control device (1), the external peripheral device is a coating device (3), the processor (14) changes the position and posture of a coating nozzle (31) of the coating device (3) by outputting a signal for controlling the position and posture of the robot (2), and the processor (14) outputs a signal for ejecting a coating material from the coating nozzle (31) in conjunction with the robot (2).

[0060] (Supplementary Note 5) In the robot control device (1A), the external peripheral device is a laser processing device (3A), the processor (14) changes the position and posture of the laser processing head (30) of the laser processing device (3A) by outputting a signal for controlling the position and posture of the robot (2A), and the processor (14) outputs a signal for irradiating a laser from a laser processing nozzle (31A) of the laser processing head (30) so as to link with the robot (2A).

[0061] (Supplementary Note 6) A robot control device (1, 1A) for controlling a robot (2, 2A) that changes the position and posture of an external peripheral device (31, 31A), comprising: at least one storage device (11); and at least one processor (14), wherein the storage device (11) stores position and posture information of the robot (2, 2A) for each first period during direct teaching; and stores external signal information including ON / OFF signals of the external peripheral device (3, 3A) for each first period during direct teaching; and the processor (14) reads out the position and posture information stored in the storage device (11) for each first period and outputs a signal for controlling the position and posture of the robot (2, 2A), and reads out the external signal information stored in the storage device (11), and outputs a signal for controlling the external peripheral device (3, 3A) to link with the robot (2, 2A).

[0062] REFERENCE SIGNS LIST 1, 1A Robot control device 2, 2A Robot 3 Coating device (external peripheral device) 3A Laser processing device (external peripheral device) 4, 4A Robot system 11 Storage device 12 Position and orientation information storage unit 13 External signal information storage unit 14 Processor 15 Position and orientation control unit 16 External peripheral device control unit 20 Robot arm 21 Status detector 30 Laser processing head (external peripheral device) 31 Coating nozzle (external peripheral device) 31A Laser processing nozzle (external peripheral device) W Workpiece

Claims

1. A robot control device that controls a robot that changes the position and posture of an external peripheral device, comprising: at least one memory device; and at least one processor, wherein the memory device stores position and posture information of the robot for each first period during direct teaching, and stores external signal information including an ON / OFF signal of the external peripheral device for each second period during the direct teaching, and the processor reads out the position and posture information stored in the memory device for each first period and outputs a signal for controlling the position and posture of the robot, and reads out the external signal information stored in the memory device for each second period and outputs a signal for controlling the external peripheral device to link with the robot.

2. A robot control device as described in claim 1, wherein the first period and the second period are the same or different periods.

3. A robot control device according to claim 1 or 2, wherein the timing at which the storage device acquires the position and orientation information and the timing at which the storage device acquires the external signal information are the same or different.

4. A robot control device as described in any one of claims 1 to 3, wherein the external peripheral device is a coating device, the processor changes the position and posture of a coating nozzle of the coating device by outputting a signal for controlling the position and posture of the robot, and the processor outputs a signal for ejecting a coating material from the coating nozzle in conjunction with the robot.

5. A robot control device as described in any one of claims 1 to 3, wherein the external peripheral device is a laser processing device, the processor changes the position and posture of a laser processing head of the laser processing device by outputting a signal for controlling the position and posture of the robot, and the processor outputs a signal for irradiating a laser from a laser processing nozzle of the laser processing head so as to link with the robot.

6. A robot control device that controls a robot that changes the position and posture of an external peripheral device, comprising: at least one memory device; and at least one processor, wherein the memory device stores position and posture information of the robot for each first period during direct teaching; and stores external signal information including ON / OFF signals of the external peripheral device during the direct teaching, and the processor reads out the position and posture information stored in the memory device for each first period and outputs a signal for controlling the position and posture of the robot, and reads out the external signal information stored in the memory device and outputs a signal for controlling the external peripheral device to link with the robot.

Citation Information

Patent Citations

  • Control method and device for industrial robot

    JP1991270887A