阅读说明：本技术 控制装置 (Control device ) 是由 浪越孝宏 于 2019-09-26 设计创作，主要内容包括：本发明的对具有多个关节部和臂部的多关节机器人进行控制的控制装置,包括：获取部,该获取部获取为驱动所述多个关节部的每一个马达所分配的固有的识别信息；判定部,该判定部根据所述获取部所获取的各个所述马达的识别信息,判定所述马达中是否有某个或多个进行了更换；以及更新部,在所述判定部判定为所述马达中有某个或多个进行了更换的情况下,该更新部根据被判定为进行了更换的所述马达的识别信息,更新用于使该马达进行动作的调整值信息。(The present invention provides a control device for controlling a multi-joint robot having a plurality of joints and an arm, comprising: an acquisition unit that acquires unique identification information assigned to each motor that drives the plurality of joint units; a determination unit that determines whether or not one or more of the motors have been replaced, based on the identification information of each of the motors acquired by the acquisition unit; and an updating unit that updates adjustment value information for operating the motor, based on identification information of the motor determined to have been replaced, when the determination unit determines that one or more of the motors have been replaced.)

1. A control device for controlling a multi-joint robot having a plurality of joints and an arm, comprising:

an acquisition unit that acquires unique identification information assigned to each motor that drives the plurality of joint units;

a determination unit that determines whether or not one or more of the motors have been replaced, based on the identification information of each of the motors acquired by the acquisition unit; and

and an updating unit that updates adjustment value information for operating the motor, based on the identification information of the motor determined to have been replaced, when the determination unit determines that one or more of the motors have been replaced.

2. The control device of claim 1,

the identification information includes type identification information for identifying a type of the motor,

the update unit updates the adjustment value information for operating the motor determined to be replaced, based on a center value of the adjustment value information corresponding to the type identification information of the motor.

3. The control device according to claim 1 or 2,

a storage unit for storing identification information of each motor at the previous end,

the determination unit determines whether or not one or more of the motors have been replaced, based on identification information of each of the motors at the time of startup and each of the identification information stored in the storage unit.

4. The control device according to any one of claims 1 to 3,

the adjustment value information includes at least one of a difference of a rated torque current value, a rotation angle offset value, and a deviation of the speed reducer.

5. The control device according to any one of claims 1 to 4, characterized by comprising:

an imaging unit attached to a predetermined position of the articulated robot and configured to image a surrounding image;

a control unit that controls the articulated robot in a predetermined basic posture;

a comparison unit that compares the image captured by the imaging unit when the articulated robot is controlled to the predetermined basic posture with a predetermined image; and

and a replacement determination unit that determines whether or not any one or more of the plurality of joints and the arm has been replaced, based on a comparison result of the comparison unit.

Technical Field

The present invention relates to a control device for controlling a multi-joint robot.

Background

Articulated robots use multiple motors. In order to control the articulated robot with high accuracy, adjustment value information (calibration data) needs to be set for each motor. For example, japanese patent laid-open No. 3910134 discloses the following technique: even when the robot mechanism component itself is replaced or the mechanism units constituting a part of the robot mechanism component are replaced as a unit, the robot device can be used in real time without any trouble without calibrating the dimensions, the installation angles, and the like of the respective parts or the mechanism units of the robot mechanism part.

Documents of the prior art

Patent document

Patent document 1: japanese laid-open gazette: japanese patent No. 3910134

Disclosure of Invention

Technical problem to be solved by the invention

In the technique disclosed in japanese patent laid-open No. 3910134, a memory is provided in a mechanism part or the like of a robot, stored information such as parameters for performing track calculation is stored in the memory in advance, and the stored information stored in the memory is read to a robot control device connected to the mechanism part or the like of the robot.

However, the parameters and the like used for the calculation of the trajectory are equivalent to the results of calibration performed in advance, and therefore calibration is still required in advance. Therefore, it takes time to make a response to an emergency failure or the like, and it may be difficult to quickly respond to the emergency failure or the like. Further, a memory needs to be provided in advance in a mechanism part of the robot. On the other hand, if the calibration value is not updated at the time of motor replacement, the error may increase to be larger than the deviation value of the component, and the operation accuracy may be degraded.

In view of the above-described problems, an object of the present invention is to provide a control device capable of easily updating adjustment value information of a motor that has been replaced.

Technical scheme for solving technical problem

In order to solve the above problem, according to an aspect of the control device according to the present invention, there is provided a control device for controlling a multi-joint robot having a plurality of joints and an arm, the control device including: an acquisition unit that acquires unique identification information assigned to each motor that drives the plurality of joint units; a determination unit that determines whether or not one or more of the motors have been replaced, based on the identification information of each of the motors acquired by the acquisition unit; and an updating unit that updates adjustment value information for operating the motor, based on identification information of the motor determined to have been replaced, when the determination unit determines that one or more of the motors have been replaced.

Effects of the invention

According to the present invention having the above configuration, the adjustment value information of the replaced motor can be easily updated.

Drawings

Fig. 1 is a perspective view showing a configuration example of a robot control system using a control device according to embodiment 1 of the present invention.

Fig. 2 is a block diagram showing a configuration example of the robot control system.

Fig. 3 is a diagram showing an example of calibration data of the motor.

Fig. 4 is a diagram showing an example of the center value of the calibration data.

Fig. 5 is a flowchart showing an example of the update processing of the calibration data.

Fig. 6 is a diagram showing an example of calibration data after update processing.

Fig. 7 is a diagram showing a specific example of the marker portion.

Fig. 8 is a flowchart showing an example of processing at the time of robot startup.

Fig. 9 is a perspective view showing an example of a basic posture of the robot.

Fig. 10 is an exemplary view showing an image acquired from a photographing signal of a camera in a basic posture.

Fig. 11 is a conceptual diagram illustrating an example of a state in which a part of an arm of a robot is replaced.

Fig. 12 is a diagram showing an example of a basic posture in a state where a part of the arm is replaced.

Fig. 13 is a diagram showing an example of an image obtained from a captured signal of a camera in a basic posture in a state in which a part of an arm is replaced.

Detailed Description

Embodiments for carrying out the present invention will be described in detail below with reference to the accompanying drawings.

< embodiment 1>

Fig. 1 is a perspective view showing a configuration example of a robot control system using a control device according to embodiment 1.

The robot control system includes: a multi-joint robot (hereinafter simply referred to as a robot) 1 having a plurality of joints a and an arm B, a controller (control device) 2 for controlling the operation of the robot 1 in accordance with an instruction from an external device, and a camera 3 for capturing a peripheral image. The camera 3 is attached to, for example, a hand at the front end of the robot 1. The robot control system further includes a marker unit (image display unit) 4 that displays a reference image for detecting the state of the robot 1. The joint a of the robot 1 includes a plurality of joints 31a, 31b, 32a, 32b, 33a, and 33 b. The joint 31 is attached to the base 30 to be freely rotatable. The arm part B includes a plurality of arms 35, 36. The robot 1 has a modular structure according to the use, and can replace a part of the plurality of joints 31a to 33b and arms 35 and 36.

The controller 2, as shown in fig. 2 for example, includes: an image acquiring unit 21 for acquiring an image from a video signal captured by the camera 3; an image analysis unit 22 for analyzing the image acquired by the image acquisition unit 21; a setting holding unit 23 for holding adjustment value information for controlling the robot 1; and a posture calculation unit 24 that calculates the posture of the robot 1 based on an instruction signal from an external device. The controller 2 further includes: a drive instruction unit 25 that drives the robot 1 based on the posture calculated by the posture calculation unit 24; a control unit 26 for controlling the operation of the entire controller 2; and a warning indicator 27 for outputting a warning signal for displaying a warning. The warning display corresponding to the warning signal from the warning indicator 27 may be any of sound, light, and characters. The controller 2 can control the operation of the robot 1 by analyzing the image acquired by the image acquisition unit 21 in the image analysis unit 22.

The robot 1 further includes motors 11, 12, 13, 14, 15, and 16 that drive the plurality of joint units 31a to 33b, and a motor driver 17 that drives the motors 11 to 16. The motors 11 to 16 are configured to be replaceable. Unique Identification information (UID: Unique Identification) is assigned to each of the motors 11 to 16. The Identification information UID contains type Identification information (MID: Model Identification, such as "AA" or the like) for identifying the type of the motor. Specifically, the identification information UID includes type identification information (e.g., "AA"), a serial number (e.g., "01", "02", and other numbers). The identification information of each motor 11-16 is provided to the control unit 26 via a transmission line connected in a daisy chain, for example.

For example, as shown in fig. 3, the setting holding unit 23 stores, for each motor designated by the module number, adjustment value information (calibration data) for causing the motor to operate in accordance with the identification information UID of the motor used when the previous driving of the robot 1 was completed, and the like. The calibration data includes parameters such as a rated torque current value (difference) of the motor, a rotation angle offset value of the motor, and a deviation of the reduction gear. The rated torque current value (difference) is a difference value between a current value when the motor rotates at a rated load and a reference value, and is used for determining a motor failure. The rotation angle offset value is a deviation between an actual arm position and a 0-degree position when a motor having a servo function is driven by outputting a 0-degree command, and is used to correct an angular deviation when the robot takes a reference posture. When the motor rotates by a large amount corresponding to the reduction ratio of the reduction gear, the joint should actually rotate by one revolution, but actually does not rotate by exactly one revolution, and a slight deviation may occur. The deviation of the speed reducer is a deviation amount when the motor rotates by a magnitude corresponding to the reduction ratio, which is represented by the number of pulses of the encoder for detecting the angle of the joint. The offset value of the speed reducer is used to accurately rotate the motor.

The setting holding portion 23 also stores a center value of calibration data for each type identification information (MID) for identifying the type of the motor, as shown in fig. 4, for example. The center value is obtained by statistically processing calibration data of the same type of motor. The control unit 26 also acquires unique identification information assigned to each of the motors 11 to 16, for example, when the robot 1 is started. The control unit 26 determines whether or not any one or more of the motors 11 to 16 has been replaced, based on the acquired identification information of the motors 11 to 16. The control unit 26 updates the calibration data based on the identification information of the motor determined to have been replaced. Specifically, the control unit 26 acquires the center value of the calibration data corresponding to the type identification information out of the identification information of the motor determined to be replaced from the setting holding unit 23, and updates the value of the calibration data.

< update processing of calibration data >

In this robot control system, when the robot 1 is started, the control unit 26 executes the calibration data update process shown in fig. 5.

When the robot 1 is started, the control unit 26 first acquires identification information (UID) of each of the motors 11 to 16 in S21. Then, in S22, the control unit 26 compares the acquired identification information of each of the motors 11 to 16 with the identification information of each of the motors in the calibration data stored in the setting holding unit 23, and checks whether or not the identification information matches the identification information of the motor at the previous end.

When the acquired identification information of each of the motors 11 to 16 and the identification information of each of the motors in the calibration data stored in the setting holding unit 23 all match, the control unit 26 proceeds to S23 and shifts to a normal operation to end the processing of fig. 5 because all of the motors 11 to 16 have not been replaced after the previous driving is completed. On the other hand, when there is a combination in which the acquired identification information of each of the motors 11 to 16 does not match the identification information of each of the motors in the calibration data stored in the setting holding unit 23, the corresponding motor 11 to 16 is replaced after the previous driving is completed, and therefore, the control unit 26 proceeds to S24 to update the calibration data. Specifically, the control unit 26 acquires the center value of the calibration data corresponding to the type identification information among the identification information of the replaced motor from the setting holding unit 23, and registers the center value in the calibration data in association with the identification information of the replaced motor, as shown in fig. 6, for example. Then, the control unit 26 proceeds to S23, and shifts to the normal operation, and ends the processing in fig. 5. After the process of fig. 5 is completed, the robot 1 is controlled using the updated calibration data.

As described above, in the present embodiment, the control unit 26 can determine whether or not one or more of the motors 11 to 16 have been replaced, based on the identification information acquired from each of the motors 11 to 16. In the present embodiment, when one or more of the motors 11 to 16 are replaced, the calibration data can be updated using the intermediate value of the calibration data corresponding to the type identification information identifying the type of the replaced motor. Therefore, even when the motor is replaced due to an emergency failure or the like, the adjustment value information of the replaced motor can be easily updated. If the calibration is performed again after the motor is replaced, it is time consuming and labor intensive, and equipment is required. In the present embodiment, since the calibration data is updated using the intermediate value of the calibration data, the robot 1 may be controlled using the updated calibration data although the update accuracy may be degraded. In particular, in the present embodiment, since the image analysis unit 22 analyzes the image acquired by the image acquisition unit 21, the operation of the robot 1 can be controlled, and therefore, even if an intermediate value of the calibration data is used, the robot 1 can be controlled while suppressing a decrease in accuracy.

Further, as shown in fig. 7, for example, an image of the scale is displayed on the surface of the marker 4. The image may be printed or may be displayed by imprinting or the like as long as the image can be captured by the camera 3. The marker 4 is provided at a position that comes within the angle of view of the camera 3 when the robot 1 is controlled to a basic posture (a posture in which the robot 1 acquires a surrounding image when started).

< processing at startup of robot 1>

In this robot control system, when the robot 1 is started, the robot 1 is controlled to a predetermined basic posture, an image of the marker 4 is captured by the camera 3, and the state of the robot 1 is detected. Specifically, it is determined whether or not one or more of the joint units 31a to 33b and the arms 35 and 36 have been replaced as the state of the robot 1.

The control unit 26 of the controller 2 executes the processing shown in fig. 8 after the start of the robot 1. First, in S1, the robot 1 is controlled to a predetermined basic posture. The basic posture is, for example, a posture as shown in fig. 9, in which the camera 3 can capture an image of the marker 4. The control unit 26 instructs the posture calculation unit 24 of information on the basic posture (the rotation angles of the joint units 31a to 33b, etc.) in order to control the robot 1 to the basic posture. The posture calculation unit 24 calculates the posture of the robot 1 based on an instruction from the control unit 26, and causes the drive instruction unit 25 to generate a drive instruction. The drive instruction unit 25 generates a drive instruction of the robot 1 based on the instruction from the posture calculation unit 24, and supplies the drive instruction to the motor driver 17 of the robot 1. The motor driver 17 drives the motors 11 to 16 in accordance with a drive instruction from the drive instruction unit 25. Thereby, the robot 1 is controlled in the basic posture.

Next, in S2, the image acquiring unit 21 acquires an image from the video signal from the camera 3.

After the image acquisition unit 21 acquires the image in the basic posture, the control unit 26 instructs the image analysis unit 22 to perform image analysis in S3. Specifically, the image analysis unit 22 holds, for example, an image of the basic posture at the previous end as a reference image, and compares the reference image with an image of the basic posture at the present startup. Alternatively, the image analysis unit 22 may hold the image of the basic posture at the previous startup as a reference image and compare the reference image with the image of the basic posture at the current startup.

Then, in S4, the control unit 26 confirms (determines) whether there is a difference between the image of the basic posture at the present start and the reference image based on the analysis result of the image analysis unit 22. If there is no difference from the reference image, the control unit 26 determines that none of the joint units 31a to 33b and the arms 35 and 36 have been replaced, and proceeds to S5 to transition to normal operation, and the process of fig. 8 is ended. On the other hand, if there is a difference from the reference image, the control unit 26 determines that one or more of the joint units 31a to 33b and the arms 35 and 36 have been replaced, and proceeds to S6 to bring the robot 1 to an emergency stop, and the process of fig. 8 is ended.

As described above, in the present embodiment, it is possible to determine whether or not any one or more of the joints 31a to 33b and the arms 35 and 36 have been replaced, based on whether or not there is a difference between the image acquired from the video signal of the camera 3 when the robot 1 is controlled to the basic posture and the reference image. When one or more of the joints 31a to 33b and the arms 35 and 36 are replaced, it is necessary to change the setting information for operating the robot 1. If the change of the setting information is not performed properly, the operation of the robot 1 may be hindered. Therefore, in the present embodiment, when one or more of the joint units 31a to 33b and the arms 35 and 36 are replaced, the robot 1 is urgently stopped. Thus, the user can be notified that the setting information needs to be changed. As described above, when the robot 1 is brought to an emergency stop, the warning instruction unit 27 may output a warning signal to cause an external device to display a warning. Thus, the user can be reliably notified of the need to change the setting information.

< image example >

Fig. 10 shows an example of an image acquired from a shooting signal of the camera 3 in the basic posture. This image shows a partial image 71 of the hand at the tip of the robot 1 and an image 72 of the marker 4. For example, the image analysis unit 22 holds the image as the reference image in advance. For example, as shown in fig. 11, when the arm 36 having a length of L1 is replaced with the arm 37 having a length of L2 and shorter than L1, the basic posture when the robot 1 is started is as shown in fig. 12. In this state, the image obtained from the image pickup signal of the camera 3 is, for example, as shown in fig. 13, and the image 73 of the marker 4 is displayed at a position different from that shown in fig. 10. When the image analysis unit 22 compares the image shown in fig. 13 with the image (reference image) shown in fig. 10, it is found that the difference is present between the image and the reference image. As a result, at S4 in fig. 8, the controller 26 determines that one or more of the joints 31a to 33b and the arms 35 and 36 have been replaced, and proceeds to S6 to bring the robot 1 to an emergency stop. When the joints 31a to 33b are replaced, the image in the basic posture differs from the reference image due to the size of the replaced joint, and it can be determined that one or more of the joints 31a to 33b and the arms 35 and 36 have been replaced.

< modification example >

In the above embodiment, the marker section 4 is provided, and it is determined whether or not any one or more of the joint sections 31a to 33b and the arms 35 and 36 have been replaced, based on the difference between the image acquired from the video signal of the camera 3 in the basic posture and the reference image. However, instead of providing the marker 4, it is also possible to determine whether or not any one or more of the joint units 31a to 33b and the arms 35 and 36 have been replaced, using an image of the periphery of the robot 1. In this case, it is possible to determine whether or not one or more of the joint units 31a to 33b and the arms 35 and 36 have been replaced, by using the feature points in the surrounding image.

Further, the basic gesture may be more than one.

When there are a plurality of basic postures, a plurality of mark portions are provided in advance at positions within the angle of view of the camera 3 corresponding to the plurality of basic postures. Then, the robot 1 is controlled to a plurality of reference postures, and images of the respective marker portions are acquired. Accordingly, it is possible to determine whether or not any one or more of the joint units 31a to 33b and the arms 35 and 36 have been replaced in a plurality of basic postures. Therefore, even when the plurality of joint units 31a to 33b and the arms 35 and 36 are replaced, the accuracy of the determination can be improved.

In addition, when the robot 1 is configured such that only the specific joint portions 31a to 33b and the arms 35 and 36 can be replaced, the basic posture is set in accordance with the replaceable members.

In the above-described embodiment, the case where the robot 1 is brought into the basic posture at the time of starting the robot 1 and the image is acquired from the video signal from the camera 3 has been described, but the present invention is not limited to the case where the robot 1 is started, and the image may be acquired by appropriately bringing the robot 1 into the basic posture in response to an instruction from a user or the like. The above embodiment is an example of an implementation of the present invention, and may be modified or changed as appropriate depending on a device, a system configuration, and various conditions to which the present invention is applied.

Description of the reference symbols

1, a robot; 2, a controller; 3, a camera; 4 a marking part; a joint part A; b, a hand arm part; 21 an image acquisition unit; 22 an image analysis section; 23 setting a holding part; a 24-posture calculation unit; 25 driving the indication part; 26 a control unit; 27 a warning indication unit; joint portions 31a, 31b, 32a, 32b, 33a, 33 b; 35. 36, 37 arms.