Control device, mechanical system and time synchronization method

By installing an acceleration sensor on the front end of the robot, the delay time of the acceleration time series data is calculated, the synchronization between the control device and the sensor is achieved, the problem of robot vibration suppression is solved, and synchronization efficiency and accuracy are improved.

CN111993410BActive Publication Date: 2024-11-26FANUC LTD
View PDF 12 Cites 0 Cited by

Patent Information

Application Number
CN202010449217.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2019-05-27
Filing Date
2020-05-25
Publication Date
2024-11-26
Estimated Expiration
2040-05-25

AI Technical Summary

Technical Problem

During the process of high-speed robot movement, due to insufficient rigidity of the reducer and robot arm, it is difficult for the prior art to effectively synchronize the control device and acceleration sensor, resulting in failure of vibration suppression or increased vibration.

Method used

By installing an acceleration sensor on the front end of the robot, the wireless signal transmission and reception unit, the data acquisition unit, the data calculation unit and the delay time calculation unit calculate the delay time of the acceleration time series data, so as to realize synchronization between the control device and the sensor time.

Benefits of technology

It realizes easy synchronization between the control device and the wireless sensor at the moment, effectively suppresses the vibration of the front end of the robot, and reduces the time and error of synchronization at the moment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN111993410B_ABST
    Figure CN111993410B_ABST
Patent Text Reader

Abstract

The present invention provides a control device, a mechanical system and a time synchronization method. The control device controls a mechanical device having a movable part driven by a motor, and comprises: a wireless signal sending and receiving unit, which receives a sensor signal indicating the position, speed or acceleration of the front end portion detected by a sensor unit at the front end portion of the movable part of the mechanical device; a data acquisition unit, which acquires first time series data of acceleration according to the received sensor signal; a data calculation unit, which calculates second time series data of acceleration of the front end portion of the movable part according to a driving instruction of the motor; a delay time calculation unit, which calculates the delay time of the first time series data relative to the second time series data according to the correlation between the first time series data and the second time series data when the mechanical device is operated in a predetermined basic action; and a time synchronization unit, which synchronizes the time of the sensor unit with the time of the control device according to the delay time.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a control device, a mechanical system and a time synchronization method. Background Art

[0002] Reducing the cycle time by increasing the speed of the robot's movements directly affects production efficiency. However, as the robot's movements become faster, the front end of the robot will vibrate due to insufficient rigidity of the speed reducer and robot arm.

[0003] As a method for coping with this problem, a technique has been proposed in which an acceleration sensor is mounted on the front end of a robot, the acceleration sensor is used to detect vibrations associated with the robot's motion, and the vibrations are reduced by performing learning control.

[0004] However, due to the complexity of the wiring of the cable connecting the control device and the acceleration sensor that controls the robot, an acceleration sensor (hereinafter also referred to as a "wireless sensor") that wirelessly transmits the measured acceleration to the control device is sometimes used. In addition, the vibration of the robot is calculated based on the comparison between the command acceleration output by the control device and the acceleration detected by the wireless sensor. Therefore, it is necessary to synchronize the timing of the control device and the timing of the wireless sensor with each other. If the timing of the control device is not synchronized with the timing of the wireless sensor, an erroneous vibration is calculated. Moreover, sometimes even if you want to suppress the vibration, you cannot suppress it correctly, and the vibration will become larger.

[0005] In this case, for example, (A) a method of directly connecting the wireless sensor and the control device via a cable, etc. and synchronizing them, or (B) a method of synchronizing them by sending a signal indicating the current time from the control device (or wireless sensor) to the wireless sensor (or control device).

[0006] In method (A), the timing of the control device and the timing of the wireless sensor deviate over time, so they need to be connected regularly for synchronization. However, the robot and the control device are often installed far away from each other, and it is laborious to directly connect the control device and the wireless sensor with a cable or the like. In addition, in order to measure vibration using a wireless sensor, it is necessary to set the position and direction of the wireless sensor, and it is laborious to perform the above settings every time the wireless sensor is removed from the robot.

[0007] On the other hand, in method (B), a random delay occurs between the control device and the wireless sensor. Therefore, even if the control device (or wireless sensor) sends a signal at the current time to the wireless sensor (or control device) at time t1, the receiving time t2 on the receiving side will be different due to the random delay.

[0008] In this regard, a technique has been proposed in which a reference value of a correlation value is set based on the command acceleration of the arm tip portion to synchronize the time series data of the command acceleration with the time series data of the detected acceleration.

[0009] Figure 1A This figure shows an example of time series data of command acceleration at an operating speed where vibration becomes a problem. Figure 1B This figure shows an example of time series data of acceleration detected by a wireless sensor at an operation speed where vibration becomes a problem.

[0010] like Figure 1A as well as Figure 1B As shown, in an operation where vibration actually becomes a problem, the waveforms of the time series data of the command acceleration and the time series data of the detected acceleration differ greatly, and there is a case where they cannot be synchronized correctly.

[0011] Patent Document 1: Japanese Patent Application Publication No. 2018-130800

[0012] Patent Document 2: Japanese Patent Application Publication No. 2015-163416 Summary of the invention

[0013] Therefore, when suppressing vibrations by learning control, it is desirable to easily synchronize the timing of the control device and the timing of the wireless sensor.

[0014] (1) One aspect of the control device disclosed herein controls a mechanical device having a movable part driven by a motor, the control device comprising: a wireless signal transmitting and receiving unit that receives a sensor signal indicating a position, velocity or acceleration of the front end portion of the movable part periodically detected by a sensor unit provided at the front end portion of the movable part of the mechanical device; a data acquisition unit that acquires first time series data of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal; a data calculation unit that calculates second time series data of the acceleration of the front end portion of the movable part corresponding to the first time series data based on a drive instruction of the motor; a delay time calculation unit that calculates a delay time of the first time series data relative to the second time series data based on a degree of correlation between the first time series data acquired by the data acquisition unit and the second time series data calculated by the data calculation unit when causing the mechanical device to operate in a predetermined basic action; and a time synchronization unit that synchronizes the time of the sensor unit with the time of the control device based on the delay time calculated by the delay time calculation unit.

[0015] (2) One mode of the control device disclosed in the present invention controls a mechanical device having a movable part driven by an electric motor, the control device comprising: a wireless signal transmitting and receiving unit that receives a sensor signal indicating the position, velocity or acceleration of the front end portion of the movable part of the mechanical device that is periodically detected by a sensor unit provided at the front end portion of the movable part; a data acquisition unit that acquires first time series data of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal; and a data calculation unit that calculates the acceleration of the movable part corresponding to the first time series data based on the driving instruction of the electric motor. second time series data of the acceleration of the front end portion; a delay time calculation portion, which calculates the delay time of the first time series data relative to the second time series data based on the degree of correlation between the first time series data acquired by the data acquisition portion and the second time series data calculated by the data calculation portion, when causing the mechanical device to perform the action represented by the program at a speed less than a predetermined value instead of the speed represented by the program executed by the control device; and a time synchronization portion, which synchronizes the time of the sensor portion with the time of the control device based on the delay time calculated by the delay time calculation portion.

[0016] (3) One aspect of the mechanical system of the present disclosure includes a mechanical device having a movable part driven by a motor, and the control device of (1) or (2).

[0017] (4) One mode of the time synchronization method disclosed in the present invention is to perform time synchronization between a sensor unit and the control unit in a mechanical system having a mechanical device having a movable part driven by a motor and a control unit that controls the mechanical device, wherein the sensor unit is disposed at a front end portion of the movable part of the mechanical device, and the method comprises the following steps: a wireless signal sending and receiving step, receiving a sensor signal representing a position, velocity or acceleration of the front end portion periodically detected by the sensor unit; a data acquisition step, acquiring first time series data of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal; and data calculation. A step of calculating, according to a driving instruction of the motor, second time series data of the acceleration of the front end portion of the movable component corresponding to the first time series data; a delay time calculation step of calculating, when the mechanical device is caused to move in a predetermined basic action, the delay time of the first time series data relative to the second time series data according to the degree of correlation between the first time series data acquired by the data acquisition step and the second time series data calculated by the data calculation step; and a time synchronization step of synchronizing the time of the sensor unit with the time of the control device according to the delay time calculated by the delay time calculation step.

[0018] (5) One mode of the time synchronization method disclosed in the present invention is to perform time synchronization between a sensor unit and the control unit in a mechanical system having a movable part driven by a motor and a control unit for controlling the mechanical device, wherein the sensor unit is arranged at the front end of the movable part of the mechanical device, and the method comprises the following steps: a wireless signal sending and receiving step, receiving a sensor signal indicating the position, speed or acceleration of the front end periodically detected by the sensor unit; a data acquisition step, acquiring first time series data of the acceleration of the front end of the movable part based on the position, speed or acceleration of the received sensor signal; and a data calculation step, calculating the time series data based on the driving instruction of the motor. An instruction for calculating the second time series data of the acceleration of the front end portion of the movable component corresponding to the first time series data; a delay time calculation step for calculating the delay time of the first time series data relative to the second time series data based on the degree of correlation between the first time series data obtained by the data acquisition step and the second time series data calculated by the data calculation step when the mechanical device is caused to perform the action represented by the program at a speed less than a predetermined value instead of the speed represented by the program executed by the control device; and a time synchronization step for synchronizing the time of the sensor portion with the time of the control device based on the delay time calculated by the delay time calculation step.

[0019] According to one embodiment, when suppressing vibration by learning control, the time of the control device and the time of the wireless sensor can be easily synchronized. BRIEF DESCRIPTION OF THE DRAWINGS

[0020] Figure 1A This figure shows an example of time series data of command acceleration at an operating speed where vibration becomes a problem.

[0021] Figure 1B This figure shows an example of time series data of acceleration detected by a wireless sensor at an operation speed where vibration becomes a problem.

[0022] Figure 2 It is a functional block diagram showing an example of the functional configuration of the mechanical system according to the first embodiment.

[0023] Figure 3 This shows an example of a robot.

[0024] Figure 4 illustrate Figure 3 The coordinate system of the robot.

[0025] Figure 5A Indicates that in basic actions Figure 2 An example of time series data of command acceleration calculated by the data operation unit.

[0026] Figure 5B Indicates that in basic actions Figure 2 An example of time series data of acceleration detected by a wireless sensor.

[0027] Figure 6 express Figure 2 An example of related processing performed by the delay time calculation unit.

[0028] Figure 7 An example of the relationship between the time series data of the command acceleration and the time series data of the detected acceleration when the correlation coefficient is at the maximum value is shown.

[0029] Figure 8 This is a flowchart illustrating the time synchronization process of the control device.

[0030] Description of Reference Numerals

[0031] 1: Mechanical system, 10: Mechanical device (robot), 20: Control device, 101: Wireless sensor, 202: Data acquisition unit, 203: Motor control unit, 204: Data calculation unit, 205: Delay time calculation unit, 206: Time synchronization unit, 207: Learning control unit. DETAILED DESCRIPTION

[0032] Hereinafter, a first embodiment will be described with reference to the drawings.

[0033] <First Embodiment>

[0034] Figure 2 1 is a functional block diagram showing an example of the functional configuration of the mechanical system 1 according to the first embodiment. Figure 2 As shown, the mechanical system 1 has a mechanical device 10 and a control device 20 .

[0035] The mechanical device 10 and the control device 20 can be directly connected to each other via a connection interface not shown. In addition, the mechanical device 10 and the control device 20 can be connected to each other via a network such as a LAN (Local Area Network). In this case, the mechanical device 10 and the control device 20 can have a communication unit not shown for communicating with each other through the above connection.

[0036] The mechanical device 10 is, for example, a machine tool or an industrial robot, etc. In addition, the mechanical device 10 will be described below as an industrial robot (hereinafter also referred to as “robot 10 ”).

[0037] Figure 3 An example of the robot 10 is shown.

[0038] The robot 10 is, for example, Figure 3 The robot 10 is a 6-axis vertical multi-joint robot having 6 joint axes 11 (1) to 11 (6) and an arm 12 connected to the joint axes 11 (1) to 11 (6). The robot 10 drives each of the servo motors 102 (1) to 102 (6) respectively arranged on the joint axes 11 (1) to 11 (6) according to a drive instruction from a control device 20, thereby driving movable parts such as the arm 12. In addition, an end effector 13 such as a welding gun, a gripper, a laser irradiation device, etc. is installed at the front end of the movable part of the robot 10, such as the front end of the joint axis 11 (6). And a wireless sensor 101 is provided on the end effector 13.

[0039] In addition, the robot 10 is a 6-axis vertical multi-joint robot, but it can also be a vertical multi-joint robot other than a 6-axis robot, or a horizontal multi-joint robot or a parallel link robot, etc.

[0040] In the following, when it is not necessary to distinguish each of the joint axes 11 ( 1 ) to 11 ( 6 ), they are collectively referred to as “joint axes 11 ”. In the following, when it is not necessary to distinguish each of the servo motors 102 ( 1 ) to 102 ( 6 ), they are collectively referred to as “servo motors 102 ”.

[0041] Figure 4 It is used to illustrate Figure 3FIG. 1 is a diagram of the coordinate system of the robot 10 .

[0042] like Figure 4 As shown, the robot 10 has a world coordinate system ∑w which is a three-dimensional orthogonal coordinate system fixed in space and a mechanical interface coordinate system ∑m which is a three-dimensional orthogonal coordinate system set on a flange at the front end of the joint shaft 11 (6) of the robot 10. In this embodiment, the positional correlation between the world coordinate system ∑w and the mechanical interface coordinate system ∑m is obtained in advance by a known calibration. In this way, the control device 20 described later can control the position of the front end of the robot 10 on which the end effector 13 is installed using the position defined in the world coordinate system ∑w.

[0043] The wireless sensor 101 is an acceleration sensor that periodically detects the acceleration of the front end of the movable part accompanying the movement of the robot 10 at a predetermined sampling time. The wireless sensor 101 has a clock unit (not shown), and each time the acceleration is detected, the time information output from the clock unit is obtained as the detected time. In addition, the wireless sensor 101 includes, for example, a wireless signal transmission and reception unit 111. And the wireless signal transmission and reception unit 111 wirelessly transmits a sensor signal including the detected acceleration and the time information to the control device 20 via the antenna 112.

[0044] In addition, the predetermined sampling time may be appropriately set according to the operation content of the robot 10 or the environment of the factory where the robot 10 is arranged.

[0045] The wireless sensor 101 is not limited to an acceleration sensor, and may be a velocity sensor for detecting the velocity of the tip of a movable member, a laser tracker for detecting the position of the tip of a movable member, a camera, or a motion capture device.

[0046] In addition, the wireless signal transmission and reception unit 111 is included in the wireless sensor 101 , but may be a device independent of the wireless sensor 101 .

[0047] <Control device 20>

[0048] The control device 20 is a control device (also referred to as a “robot controller”) that outputs a drive command to the robot 10 according to a program and controls the operation of the robot 10 .

[0049] like Figure 2 As shown, the control device 20 of this embodiment includes a wireless signal transmission and reception unit 201, a data acquisition unit 202, a motor control unit 203, a data calculation unit 204, a delay time calculation unit 205, a time synchronization unit 206, a learning control unit 207 and a storage unit 208.

[0050] In addition, the control device 20 is to achieve Figure 2 The control device 20 is provided with a CPU (Central Processing Unit) and other arithmetic processing devices (not shown) for controlling the operation of the functional blocks. In addition, the control device 20 is provided with a ROM (Read Only Memory) and an HDD (Hard Disk Drive) and other auxiliary storage devices (not shown) for storing various control programs, and a RAM (Random Access Memory) and other main storage devices (not shown) for storing data temporarily required when the arithmetic processing device executes the program.

[0051] Furthermore, in the control device 20, the operation processing device reads the OS or application software from the auxiliary storage device, expands the read OS or application software to the main storage device, and performs operation processing based on these OS or application software. Based on the operation results, the control device 20 controls each hardware. In this way, Figure 2 That is, the controller 20 can be implemented by the cooperation of hardware and software.

[0052] The wireless signal transmission and reception unit 201 receives a sensor signal including acceleration and time information detected at the tip of the robot 10 via the antenna 211. The wireless signal transmission and reception unit 201 outputs the received sensor signal to the data acquisition unit 202.

[0053] The data acquisition unit 202 acquires the acceleration detected by the wireless sensor 101 at the tip of the movable member of the robot 10 and the time of detection from the sensor signal received via the wireless signal transmission and reception unit 201. The data acquisition unit 202 stores the acquired acceleration and the time of detection as time series data of the detected acceleration in the storage unit 208 described later.

[0054] The motor control unit 203 outputs a drive command to the servo motor 102 disposed on each of the joint axes 11 of the robot 10 according to a program, for example.

[0055] More specifically, the motor control unit 203 performs feedback control based on a signal from a position detector (not shown) such as a rotary encoder included in each of the servo motors 102 so that the rotation of each servo motor 102 matches the value of the drive command.

[0056] In addition, when the control device 20 performs time synchronization processing, the motor control unit 203 drives the servo motor 102 (6) according to a predetermined basic action, such as a program of simple actions such as the rotation action of one axis of the joint axis 11 (6) arranged at the front end of the movable part. In addition, the motor control unit 203 can also drive the robot 10 according to a program that replaces the joint axis 11 (6) with the action of any one axis of the joint axes 11 (1)-11 (5) as the basic action. Alternatively, the basic action can also be an action performed by two or three of the six joint axes 11, which is less than six.

[0057] The data calculation unit 204 calculates the command acceleration of the position where the wireless sensor 101 is attached, that is, the tip end of the movable member, based on the drive command from the motor control unit 203 to each servomotor 102 , for example.

[0058] More specifically, the data calculation unit 204 calculates the time series data of the command position of the front end portion of the movable member based on the value of the drive command for each of the servo motors 102. The data calculation unit 204 calculates the time series data of the command acceleration of the front end portion of the movable member by performing a second-order differentiation of the calculated time series data of the command position with respect to time. The data calculation unit 204 stores the calculated time series data of the command acceleration in the storage unit 208.

[0059] When the control device 20 performs the time synchronization process, as described above, the motor control unit 203 drives the servo motor 102 ( 6 ) according to a predetermined basic operation program to perform a single-axis rotation operation of the joint shaft 11 ( 6 ).

[0060] Figure 5A Indicates that in basic actions Figure 2 The time series data a of the command acceleration calculated by the data calculation unit 204 r (t) is an example. Figure 5B Indicates that in basic actions Figure 2 The time series data a of the acceleration detected by the wireless sensor 101 s (t) is an example.

[0061] At this time, the driving instruction issued by the motor control unit 203 is a simple action, so Figure 5A as well as Figure 5B As shown, regardless of the magnitude of the acceleration, the time series data of the command acceleration calculated by the data operation unit 204 and the time series data of the acceleration detected by the wireless sensor 101 show waveforms that are identical or similar to each other. Thus, the control device 20 of this embodiment can synchronize the timing of the control device 20 with the timing of the wireless sensor 101.

[0062] The delay time calculation unit 205 calculates the time series data a of the detected acceleration when the robot 10 is operated in a predetermined basic operation. s (t) and the calculated command acceleration time series data a r The delay time calculation unit 205 calculates the acceleration time series data a based on the calculated correlation degree. s (t) Time series data a relative to the command acceleration r (t) delay time.

[0063] Figure 6 express Figure 2 An example of related processing of the delay time calculation unit 205.

[0064] Figure 7 The time series data a representing the command acceleration when the correlation coefficient r(τ) is at its maximum value r (t) and the time series data of the detected acceleration a s An example of the relationship between (t).

[0065] In addition, Figure 6 as well as Figure 7 In the figure, the solid line represents the time series data of the command acceleration a r (t). In addition, the time series data a of the acceleration detected by the wireless sensor 101 is indicated by a two-dot chain line. s (t). In addition, the dotted line indicates the time series data a of the detected acceleration that has deviated by the delay time τ. s (t-of).

[0066] More specifically, if Figure 6 As shown, the delay time calculation unit 205 calculates the time series data a of the acceleration detected by the wireless sensor 101. s (t) relative to the time series data a of the command acceleration calculated by the data calculation unit 204 r (t) is shifted by τ seconds in the direction indicated by the arrow, thereby calculating the correlation coefficient r(τ). The delay time calculation unit 205 calculates the correlation coefficient r(τ) for various times of τ, and Figure 7 In other words, the clock unit (not shown) included in the wireless sensor 101 and the clock unit (not shown) included in the control device 20 indicate a time shifted from the time τ when the correlation coefficient r(τ) is the maximum.

[0067] The time synchronization unit 206 may synchronize the time of the wireless sensor 101 and the time of the control device 20 based on the delay time τ calculated by the delay time calculation unit 205 .

[0068] More specifically, the time synchronization unit 206 uses the delay time τ to correct the time information output by the clock unit (not shown) of the control device 20. Thus, the time synchronization unit 206 can synchronize the time information output by the clock unit (not shown) of the wireless sensor 101 with the time information output by the clock unit (not shown) of the control device 20.

[0069] The learning control unit 207, for example, executes the actual machining program that is the object of learning control after synchronizing the timing of the wireless sensor 101 with the timing of the control device 20, and acquires the time series data of the acceleration detected by the wireless sensor 101 and the position command included in the drive command during the operation of the robot 10. The learning control unit 207 stores the acquired time series data of the acceleration and the position command in the storage unit 208.

[0070] After executing the program that is the learning control object once, the learning control unit 207 calculates the vibration amount in each control cycle in the operation of the robot 10 and the vibration correction amount for eliminating the vibration amount, and stores them in the storage unit 208. When the learning control unit 207 executes the same program next, it applies the vibration correction amount stored in the storage unit 208. By repeating this operation multiple times, the vibration of the front end portion of the movable part of the robot 10 can be reduced.

[0071] Note that the learning control by the learning control unit 207 can use, for example, the same method as that in Patent Document 1, and a detailed description thereof will be omitted.

[0072] The storage unit 208 is a RAM or the like, and stores programs, time series data of acceleration detected by the wireless sensor 101 , time series data of command acceleration calculated by the data calculation unit 204 , and the like.

[0073] <Time Synchronization Processing of Control Device 20>

[0074] Next, the operation of the time synchronization process of the control device 20 according to the present embodiment will be described.

[0075] Figure 8 1 is a flowchart illustrating the time synchronization process performed by the control device 20 .

[0076] In step S11 , the motor control unit 203 outputs a drive command according to a predetermined basic operation program to drive the robot 10 .

[0077] In step S12, the data acquisition unit 202 acquires the time series data a of the acceleration of the tip of the movable member detected by the wireless sensor 101 during the basic motion of the robot 10 based on the sensor signal received via the wireless signal transmission and reception unit 201. s (t).

[0078] In step S13, the data calculation unit 204 calculates the time series data a of the command acceleration of the tip of the movable member of the robot 10 based on the drive command of the basic motion. r (t).

[0079] In step S14, the delay time calculation unit 205 calculates the time series data a of the acceleration acquired in step S11. s (t) and the time series data a of the command acceleration calculated in step S12 r (t) and calculate the correlation coefficient r(τ) between the detected acceleration time series data a s (t) Time series data a relative to the command acceleration r (t) is the delay time τ.

[0080] In step S15 , the time synchronization unit 206 synchronizes the time of the wireless sensor 101 and the time of the control device 20 based on the delay time τ calculated in step S13 .

[0081] As described above, the control device 20 of the first embodiment causes the robot 10 to operate in a predetermined basic motion, and obtains the time series data a of the acceleration detected by the wireless sensor 101 at the tip of the movable part of the robot 10. s (t) and the time series data of the command acceleration a r (t). The control device 20 detects the time series data a of the acceleration. s (t) and the time series data of the command acceleration a r (t) and calculate the correlation between the detected acceleration time series data a s (t) Time series data a relative to the command acceleration r (t) is the delay time τ.

[0082] Thus, the control device 20 can easily synchronize the timing of the wireless sensor 101 and the timing of the control device 20 based on the calculated delay time τ, and can suppress vibration of the tip of the robot 10 due to learning control.

[0083] Furthermore, even when the control device 20 periodically synchronizes the time of the wireless sensor 101 with the time of the control device 20 , the basic operation of the robot 10 for one joint axis 11 is performed only once, so that time synchronization can be performed with less effort.

[0084] <Second Embodiment>

[0085] The control device of the second embodiment is different from the first embodiment in that, instead of operating the robot in a predetermined basic motion, the control device operates the robot at a speed equal to or less than a predetermined value instead of operating the robot at a speed indicated by the program executed by the control device.

[0086] Hereinafter, a second embodiment will be described.

[0087] The mechanical system of the second embodiment of the present disclosure has Figure 2 The mechanical system 1 of the first embodiment shown has the same structure.

[0088] In addition, the mechanical device (robot) and the control device of the second embodiment also have Figure 2 and Figure 3 The control device (robot) 10 and the control device 20 of the first embodiment shown have the same structure.

[0089] However, the second embodiment is different from the first embodiment in that the motor control unit 203 of the control device 20 causes the robot 10 to perform the operation indicated by the program at a speed equal to or less than a predetermined value instead of the speed indicated by the program executed by the control device 20 during the time synchronization process.

[0090] For example, in the time synchronization processing, when a clamp is arranged around the robot 10, or when basic movements are difficult to perform due to the large size of the end effector 13 mounted on the robot 10, the motor control unit 203 may move the robot 10 according to the program used for the actual processing that is the object of learning control.

[0091] More specifically, the motor control unit 203 may drive the servo motor 102 so that the robot 10 moves at a speed equal to or less than a predetermined value instead of moving the robot 10 at the speed indicated by the program used in actual processing.

[0092] In this case, the motion speed of the robot 10 in the time synchronization process can be set to at least the time series data a of the acceleration detected by the wireless sensor 101. s (t) and the time series data a of the command acceleration calculated by the data calculation unit 204 r (t) are the speeds of waveforms that are the same or similar to each other. For example, the motor control unit 203 may cause the robot 10 to operate at various speeds in advance in the motion indicated by the actual machining program that is the learning control object. The control device 20 observes the time series data a of the acceleration detected by the wireless sensor 101 at each speed. s The waveform of (t) and the time series data a of the command acceleration calculated by the data calculation unit 204r The waveform of (t) is set to a speed equal to or smaller than a predetermined value of the same or similar waveform.

[0093] In addition, the predetermined value may be appropriately set according to the operation content of the robot 10 or the environment of the factory where the robot 10 is installed.

[0094] Furthermore, when the delay time calculation unit 205 causes the robot 10 to perform the program operation at a speed equal to or less than a predetermined value instead of the speed indicated by the program used for actual processing, the time series data a of the detected acceleration is used. s (t) and the calculated time series data of command acceleration a r The correlation between the acceleration time series data a s (t) Time series data a relative to the command acceleration r (t) is the delay time τ.

[0095] In this way, the control device 20 synchronizes the timing of the wireless sensor 101 with the timing of the control device 20 according to the program used in the actual processing, and thus can perform learning control with higher accuracy.

[0096] As described above, the control device 20 of the second embodiment causes the robot 10 to perform the above-described program operation at a speed less than a predetermined value instead of the speed indicated by the program used in the actual processing. The control device 20 obtains the time series data a of the acceleration detected by the wireless sensor 101 at the tip of the movable part of the robot 10. s (t) and the time series data of the command acceleration a r (t). The control device 20 detects the time series data a of the acceleration. s (t) and the time series data of the command acceleration a r (t) and calculate the correlation between the detected acceleration time series data a s (t) Time series data a relative to the command acceleration r (t) is the delay time τ.

[0097] Thus, the control device 20 can easily synchronize the timing of the wireless sensor 101 and the timing of the control device 20 based on the calculated delay time τ, and can suppress vibration of the tip of the robot 10 caused by learning control.

[0098] Furthermore, the control device 20 synchronizes the timing of the wireless sensor 101 with the timing of the control device 20 according to the program used in the actual processing, and thus can perform learning control with higher accuracy.

[0099] As mentioned above, although the 1st embodiment and the 2nd embodiment were demonstrated, the control device 20 is not limited to the said embodiment, and includes deformation|transformation, improvement, etc. within the range which can achieve an objective.

[0100] In the above-mentioned first embodiment and second embodiment, the wireless sensor 101 is set as an acceleration sensor, but it can also be an inertial sensor, or a speed sensor for detecting the speed of the front end of the movable part, a laser tracker for detecting the position of the front end of the movable part, a camera or a motion capture device, or other position sensor.

[0101] For example, when the wireless sensor 101 is a velocity sensor, the data acquisition unit 202 acquires the velocity detected at the tip of the movable part of the robot 10 and the time of detection from the received sensor signal. Furthermore, the data acquisition unit 202 performs a first-order differentiation of the acquired time series data of the velocity with respect to time, thereby being able to acquire time series data of the acceleration.

[0102] In addition, when the wireless sensor 101 is a position sensor, the data acquisition unit 202 acquires the position detected at the tip of the movable part of the robot 10 and the time of detection from the received sensor signal. Furthermore, the data acquisition unit 202 performs a second-order differentiation of the acquired time series data of the position with respect to time, thereby being able to acquire time series data of acceleration.

[0103] In addition, for example, in the first and second embodiments, the wireless sensor 101 is provided at the front end of the movable part of the robot 10, but it may be arranged at a movable part other than the front end of the robot 10. Thus, the influence of the position where the wireless sensor 101 is provided for each end effector 13 can be reduced.

[0104] In the first embodiment and the second embodiment, each function included in the control device 20 can be implemented by hardware, software, or a combination thereof. Here, implementation by software means implementation by a computer reading a program and executing the program.

[0105] Various types of non-transitory computer readable media (Non-transitory computer readable medium) can be used to store the program and provide it to the computer. Non-transitory computer readable media include various types of tangible recording media (tangible storage medium). Examples of non-transitory computer readable media include magnetic recording media (such as floppy disks, magnetic tapes, hard disk drives), optical magnetic recording media (such as optical magnetic disks), CD-ROM (Read Only Memory), CD-R, CD-R / W, semiconductor memory (such as mask ROM, PROM (Programmable ROM), EPROM (Erasable Erasable PROM), flash ROM, RAM). In addition, the program can also be provided to the computer through various types of transient computer readable media (transitory computer readable medium). Examples of transient computer readable media include electrical signals, optical signals, and electromagnetic waves. Transient computer readable media can provide the program to the computer via wired communication lines such as wires and optical fibers or wireless communication lines.

[0106] In addition, the steps describing the program recorded in the recording medium include not only processes that are executed in time series according to the order thereof but also processes that are not necessarily processed in time series but are executed in parallel or individually.

[0107] In other words, the control device, mechanical system, and time synchronization method of the present disclosure can take various embodiments having the following structures.

[0108] (1) The control device 20 of the present disclosure is a control device for controlling a mechanical device 10 having a movable part driven by a motor (servo motor 102), and comprises: a wireless signal transmitting and receiving unit 201 for receiving a sensor signal indicating the position, velocity or acceleration of the front end of the movable part of the mechanical device 10, which is periodically detected by a sensor unit (wireless sensor 101) provided at the front end of the movable part; and a data acquisition unit 202 for acquiring first time series data a of the acceleration of the front end of the movable part based on the position, velocity or acceleration of the received sensor signal. s (t); data operation unit 204, which calculates the first time series data a according to the driving instruction of the motor s (t) corresponds to the second time series of the acceleration of the tip of the movable member. r (t); a delay time calculation unit 205, which, when the mechanical device 10 is operated in a predetermined basic action, is based on the first time series data a obtained by the data acquisition unit 202; s(t) and the second time series data a calculated by the data calculation unit 204 r (t), calculate the correlation between the first time series data a s (t) relative to the second time series data a r and a time synchronization unit 206, which synchronizes the timing of the sensor unit and the timing of the control device 20 according to the delay time τ calculated by the delay time calculation unit 205.

[0109] According to the control device 20 , the timing of the wireless sensor 101 and the timing of the control device 20 can be easily synchronized, and the vibration of the front end portion of the mechanical device 10 caused by the learning control can be suppressed.

[0110] (2) The basic operation may be an operation of driving at least one of the plurality of motors (servo motor 102 ) included in the mechanical device 10 .

[0111] Thus, even when the time of the wireless sensor 101 and the time of the control device 20 are synchronized periodically, the time synchronization can be performed in a short time.

[0112] (3) The control device 20 of the present disclosure is a control device for controlling a mechanical device 10 having a movable part driven by a motor (servo motor 102), and comprises: a wireless signal transmitting and receiving unit 201 for receiving a sensor signal indicating the position, velocity or acceleration of the front end portion of the movable part of the mechanical device 10, which is periodically detected by a sensor unit (wireless sensor 101) provided at the front end portion of the movable part; and a data acquisition unit 202 for acquiring first time series data a of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal. s (t); data operation unit 204, which calculates the first time series data a according to the driving instruction of the motor s (t) corresponds to the second time series of the acceleration of the tip of the movable member. r (t); a delay time calculation unit 205, which replaces the speed indicated by the program executed by the control device 20 and causes the mechanical device 10 to perform the action indicated by the above program at a speed below a predetermined value, based on the first time series data a obtained by the data acquisition unit 202 s (t) and the second time series data a calculated by the data calculation unit 204 r (t), calculate the correlation between the first time series data a s (t) relative to the second time series data a rand a time synchronization unit 206, which synchronizes the timing of the sensor unit and the timing of the control device 20 according to the delay time τ calculated by the delay time calculation unit 205.

[0113] According to the control device 20 , the timing of the wireless sensor 101 and the timing of the control device 20 can be easily synchronized, and the vibration of the front end portion of the mechanical device 10 due to the learning control can be suppressed.

[0114] (4) The mechanical device 10 may be a robot, and the control device 20 may be a robot control device.

[0115] This makes it possible to perform learning control on the vibration of the tip portion of the movable member of the robot (mechanical device) 10 with high accuracy.

[0116] (5) The mechanical system 1 of the present disclosure includes a mechanical device having a movable part driven by a motor (servo motor 102 ) and any one of the control devices 20 of (1) to (4).

[0117] According to the mechanical system 1, the same effects as any of the above-mentioned (1) to (4) can be achieved.

[0118] (6) The time synchronization method disclosed in the present invention is a time synchronization method for performing time synchronization between a sensor unit (wireless sensor 101) provided at a front end portion of a movable part of the mechanical device 10 and the control device 20 in a mechanical system 1 having a mechanical device 10 having a movable part driven by a motor (servo motor 102) and a control device 20 for controlling the mechanical device 10, and comprises the following steps: a wireless signal sending and receiving step of receiving a sensor signal indicating a position, velocity or acceleration of the above-mentioned front end portion periodically detected by the sensor unit; and a data acquisition step of acquiring first time series data a of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal. s (t); Data calculation step, according to the driving instruction of the motor, calculate the first time series data a s (t) corresponds to the second time series of the acceleration of the tip of the movable member. r (t); Delay time calculation step, when the mechanical device 10 is operated in a predetermined basic action, according to the first time series data a obtained by the data acquisition step s (t) and the second time series data a calculated in the data operation step r (t), calculate the correlation between the first time series data a s (t) relative to the second time series data a rand a time synchronization step, according to the delay time τ calculated by the delay time calculation step, so that the time of the sensor unit and the time of the control device 20 are synchronized.

[0119] According to this time synchronization method, the same effect as the above-mentioned (1) can be achieved.

[0120] (7) The time synchronization method disclosed in the present invention is a time synchronization method for performing time synchronization between a sensor unit (wireless sensor 101) provided at a front end portion of a movable part of the mechanical device 10 and the control device 20 in a mechanical system 1 having a mechanical device 10 having a movable part driven by a motor (servo motor 102) and a control device 20 for controlling the mechanical device 10, and comprises the following steps: a wireless signal sending and receiving step of receiving a sensor signal indicating a position, velocity or acceleration of the above-mentioned front end portion periodically detected by the sensor unit; and a data acquisition step of acquiring first time series data a of the acceleration of the front end portion of the movable part based on the position, velocity or acceleration of the received sensor signal. s (t); Data calculation step, according to the driving instruction of the motor, calculate the first time series data a s (t) corresponds to the second time series of the acceleration of the tip of the movable member. r (t); a delay time calculation step, in which the mechanical device 10 performs the action indicated by the program at a speed below a predetermined value instead of the speed indicated by the program executed by the control device 20, according to the first time series data a obtained by the data acquisition step s (t) and the second time series data a calculated in the data operation step r (t), calculate the correlation between the first time series data a s (t) relative to the second time series data a r and a time synchronization step, according to the delay time τ calculated by the delay time calculation step, so that the time of the sensor unit and the time of the control device 20 are synchronized.

[0121] According to this time synchronization method, the same effect as the above-mentioned (3) can be achieved.

Claims

1. A control device for controlling a mechanical device having a movable part driven by a plurality of motors, characterized in that: The control device has: a wireless signal transmitting and receiving unit for receiving a sensor signal including a position, speed or acceleration of the front end portion periodically detected by a sensor unit provided at the front end portion of the movable member of the mechanical device, and time information outputted from a clock unit included in the sensor unit; a data acquisition unit that acquires first time series data of the acceleration of the front end portion of the movable member based on the position, velocity or acceleration of the received sensor signal and the time information; a data calculation unit that calculates second time series data of the command acceleration of the front end portion of the movable member based on the command acceleration of the front end portion of the movable member corresponding to the first time series data and time information output from the clock unit provided in the control device, according to the drive command of the motor; a delay time calculation unit that calculates a delay time of the first time series data relative to the second time series data based on a degree of correlation between the first time series data acquired by the data acquisition unit and the second time series data calculated by the data calculation unit when driving one of the plurality of motors of the mechanical device that is disposed closest to the front end portion of the movable member on which the sensor unit is disposed to rotate the front end portion of the movable member; as well as The time synchronization unit corrects the time information output by the clock unit of the control device according to the delay time calculated by the delay time calculation unit, so as to synchronize the time information output by the clock unit of the sensor unit with the time information output by the clock unit of the control device.

2. A control device for controlling a mechanical device having a movable part driven by an electric motor, characterized in that: The control device has: a wireless signal transmitting and receiving unit for receiving a sensor signal including a position, speed or acceleration of the front end portion periodically detected by a sensor unit provided at the front end portion of the movable member of the mechanical device, and time information outputted from a clock unit included in the sensor unit; a data acquisition unit that acquires first time series data of the acceleration of the front end portion of the movable member based on the position, velocity or acceleration of the received sensor signal and the time information; a data calculation unit that calculates second time series data of the command acceleration of the front end portion of the movable member based on the command acceleration of the front end portion of the movable member corresponding to the first time series data and time information output from the clock unit provided in the control device, according to the drive command of the motor; a delay time calculation unit for calculating a delay time of the first time series data relative to the second time series data based on a correlation between the first time series data acquired by the data acquisition unit and the second time series data calculated by the data calculation unit when the mechanical device is caused to perform the action indicated by the program at a speed not exceeding a predetermined value at which the waveforms of the first time series data and the second time series data become identical or similar waveforms, instead of the speed indicated by the program executed by the control unit, when a clamp is arranged at least around the movable member or an end effector mounted on the movable member is large and it is therefore difficult to cause the mechanical device to perform the action indicated by the program; as well as The time synchronization unit corrects the time information output by the clock unit of the control device according to the delay time calculated by the delay time calculation unit, so as to synchronize the time information output by the clock unit of the sensor unit with the time information output by the clock unit of the control device.

3. The control device according to claim 1 or 2, characterized in that: The mechanical device is a robot, and the control device is a robot control device.

4. A mechanical system, characterized in that: have: Mechanical devices with movable parts driven by electric motors; and The control device as claimed in any one of claims 1 to 3.

5. A time synchronization method, in a mechanical system including a mechanical device having a movable part driven by a plurality of motors and a control device for controlling the mechanical device, wherein a sensor unit provided at a front end portion of the movable part of the mechanical device and the control device are synchronized with each other, characterized in that: The time synchronization method has the following steps: a wireless signal transmission and reception step of receiving a sensor signal including a position, a speed or an acceleration of the front end periodically detected by the sensor unit and time information outputted from a clock unit of the sensor unit; A data acquisition step of acquiring first time series data of the acceleration of the front end portion of the movable member based on the position, velocity or acceleration of the received sensor signal and the time information; a data calculation step of calculating second time series data of the command acceleration of the front end portion of the movable member based on the command acceleration of the front end portion of the movable member corresponding to the first time series data and time information output from the clock unit provided in the control device according to the drive command of the motor; a delay time calculation step of calculating a delay time of the first time series data relative to the second time series data based on a correlation between the first time series data acquired in the data acquisition step and the second time series data calculated in the data calculation step when driving one of the plurality of motors of the mechanical device that is disposed closest to the front end portion of the movable member on which the sensor portion is disposed and causing the front end portion of the movable member to rotate; as well as The time synchronization step corrects the time information output by the clock unit of the control device according to the delay time calculated by the delay time calculation step, so that the time information output by the clock unit of the sensor unit is synchronized with the time information output by the clock unit of the control device.

6. A time synchronization method, in a mechanical system including a mechanical device having a movable part driven by a motor and a control device for controlling the mechanical device, performing time synchronization between a sensor unit provided at a front end portion of the movable part of the mechanical device and the control device, characterized in that: The time synchronization method has the following steps: a wireless signal transmission and reception step of receiving a sensor signal including a position, a speed or an acceleration of the front end periodically detected by the sensor unit and time information outputted from a clock unit of the sensor unit; A data acquisition step of acquiring first time series data of the acceleration of the front end portion of the movable member based on the position, velocity or acceleration of the received sensor signal and the time information; a data calculation step of calculating second time series data of the command acceleration of the front end portion of the movable member based on the command acceleration of the front end portion of the movable member corresponding to the first time series data and time information output from the clock unit provided in the control device according to the drive command of the motor; a delay time calculation step, in which, when a clamp is arranged at least around the movable part or an end effector mounted on the movable part is large and it is difficult to make the mechanical device move in a predetermined basic action, the mechanical device is made to move in the program at a speed lower than a predetermined value at which the waveforms of the first time series data and the second time series data become the same or similar waveforms instead of the speed indicated by the program executed by the control device, the delay time of the first time series data relative to the second time series data is calculated based on the degree of correlation between the first time series data obtained in the data acquisition step and the second time series data calculated in the data calculation step; as well as The time synchronization step corrects the time information output by the clock unit of the control device according to the delay time calculated by the delay time calculation step, so that the time information output by the clock unit of the sensor unit is synchronized with the time information output by the clock unit of the control device.

Citation Information

Patent Citations

  • Robot system with learning control function and learning control method

    JP2018130800A

  • Machine system including wireless sensor

    CN104875209A

  • Apparatus and method for managing behavior of robot

    CN108145709A

  • Machine system

    CN108568829A

  • Device, system, and method for automatically generating motion path of robot

    CN108687770A