Robot control device that performs zero-point calibration through torque or force control

By installing torque and force detectors on the robot's drive axis, zero-point calibration data is generated, solving the problem that the accuracy of zero-point calibration in the prior art depends on the operator's skill level. This achieves high-precision zero-point calibration and improves the control accuracy of the robot's position and posture.

CN118354877BActive Publication Date: 2026-11-17FANUC LTD
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202180104832.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-20
Publication Date
2026-11-17
Estimated Expiration
2041-12-20

AI Technical Summary

Technical Problem

In existing technologies, the accuracy of robot zero-point calibration depends on the operator's skill level, making it difficult to achieve high-precision zero-point calibration. Furthermore, it is susceptible to operator errors and light interference.

Method used

By installing torque and force detectors on specific drive axes of the robot, zero-point calibration data is generated. Using torque and force control methods, the robot's position and posture are automatically adjusted to generate high-precision zero-point calibration data.

Benefits of technology

It achieves high-precision zero-point calibration, reduces reliance on operator skill, improves the accuracy and reliability of zero-point calibration, and reduces the possibility of operator errors.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118354877B_ABST
    Figure CN118354877B_ABST
Patent Text Reader

Abstract

When the rotation of a component is prevented by a rotation stop, the robot's control unit controls the drive motor of a specific drive axis to make the torque output from the torque detector reach the torque setpoint. Once the torque reaches the setpoint, the control unit acquires the rotational position output by the rotational position detector of that specific drive axis. Based on the rotational position of the drive motor output by the rotational position detector and the design value of a pre-set zero-point calibration data set, the control unit generates zero-point calibration data relative to the output of the rotational position detector.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to a control device for a robot that performs zero-point calibration through torque or force control. Background Technology

[0002] Robotic devices equipped with joints can perform tasks using tools while changing the robot's position and posture. The robot's position and posture are related to the joint angles of each joint. The joint angles are related to the output of an encoder mounted on the drive motor.

[0003] In the prior art, zero-point calibration is known to accurately correlate the output value of an encoder mounted on a drive motor driving each joint with the design value (theoretical value). Zero-point calibration generates zero-point calibration data that transforms the encoder's output value into machine pulse values ​​used in the robot's control. This zero-point calibration data corresponds to the position of the origin on the robot's drive axis, for example, to the position where the encoder output is 0°.

[0004] As a method for zero-point calibration of a robot, it is known to acquire the encoder output when the robot's position and orientation are set to a specific position and orientation for zero-point calibration. For example, it is known to use a dedicated device for determining the robot's position and orientation, adjusting the robot's position and orientation for zero-point calibration. The robot's position and orientation are rigorously adjusted. For example, a dedicated device with a dial indicator is installed on a component of the robot. It is also known that an operator manually manipulates the robot to generate the position and orientation for zero-point calibration.

[0005] Alternatively, the robot can be positioned and posed in a predetermined manner using images from a camera mounted on it. For example, a gripper with a target can be mounted on a predetermined component of the robot. A camera can be mounted on the robot's wrist. It is known that by precisely adjusting the positional relationship between the camera and the target based on images acquired by the camera, the robot's position and pose can be set for zero-point calibration.

[0006] In recent years, it has been known to install force sensors on the wrist of a robot to detect the force applied to the working tool and control the robot's position and posture (e.g., Japanese Patent Application Publication No. 2016-221642). In addition, in order to realize the position and posture of the robot for zero-point calibration, there are known devices and controls for adjusting the position and posture of the robot based on the output of the force sensor (e.g., Japanese Patent Application Publication No. Hei 8-171410).

[0007] Existing technical documents

[0008] Patent documents

[0009] Patent Document 1: Japanese Patent Application Publication No. 2016-221642

[0010] Patent Document 2: Japanese Patent Application Publication No. 8-171410 Summary of the Invention

[0011] The problem that the invention aims to solve

[0012] In existing technologies, to achieve the position and posture of a robot used for zero-point calibration, an operator manually drives the robot using a teach pendant. The operator needs to make fine adjustments to the robot's three-dimensional position and posture. Therefore, the accuracy of zero-point calibration depends on the operator's skill level. Operators with low skill levels find it difficult to make subtle adjustments to the robot's position and posture, resulting in lower zero-point calibration accuracy. Alternatively, operator errors may occur during the setting of zero-point calibration data. Furthermore, when using measuring devices such as cameras, the accuracy of zero-point calibration can be degraded due to the influence of interfering light. Thus, existing technologies present a problem in achieving high-precision zero-point calibration through simple control.

[0013] Solution for solving the problem

[0014] The control device of the first aspect of this disclosure is a robot control device that generates zero-point calibration data relative to the output of a rotational position detector mounted on a drive motor of a specific drive axis that rotates a component of the robot. The control device includes: a torque detector that detects torque about the specific drive axis; a torque control unit that controls the drive motor of the specific drive axis such that when rotation of the component about the specific drive axis is prevented by a rotation prevention unit, the torque output from the torque detector becomes a preset torque setpoint; a rotational position acquisition unit that acquires the rotational position output by the rotational position detector of the specific drive axis when the torque output from the torque detector becomes the torque setpoint; and a data generation unit that generates zero-point calibration data for the output of the rotational position detector mounted on the specific drive axis based on the rotational position of the drive motor output by the rotational position detector and a design value of the preset zero-point calibration data.

[0015] The second aspect of the control device disclosed herein is a robot control device that generates zero-point calibration data relative to the output of a rotational position detector mounted on a drive motor of a specific drive axis that rotates a component of the robot. The control device includes: a gripper that prevents the component from rotating about the specific drive axis, and includes a force detector. The control device includes: a force control unit that controls the drive motor of the specific drive axis such that when the rotation of the component about the specific drive axis is prevented by the gripper, the force output from the force detector becomes a preset force set value. The control device includes: a rotational position acquisition unit that acquires the rotational position output by the rotational position detector of the specific drive axis when the force output from the force detector becomes the force set value. The control device includes: a data generation unit that generates zero-point calibration data for the output of the rotational position detector mounted on the specific drive axis based on the rotational position of the drive motor output by the rotational position detector and the design value of the preset zero-point calibration data.

[0016] Invention Effects

[0017] According to the present disclosure, it is possible to provide a control device for a robot that performs zero-point calibration with high precision through simple control. Attached Figure Description

[0018] Figure 1 This is a side view of the first robotic device according to the embodiment.

[0019] Figure 2 This is a block diagram of the first robotic device.

[0020] Figure 3 This is a side view illustrating the first control robot of the first robotic device.

[0021] Figure 4 This is a schematic top view illustrating the first control robot of the first robotic device.

[0022] Figure 5 This is another schematic top view illustrating the first control robot of the first robotic device.

[0023] Figure 6 This is a first enlarged sectional view of the meshing part of the gear.

[0024] Figure 7 This is a second enlarged sectional view of the meshing part of the gear.

[0025] Figure 8 This is a third enlarged sectional view of the meshing part of the gear.

[0026] Figure 9 This is a side view illustrating the second controlled robot of the first robotic device.

[0027] Figure 10 This is a schematic top view illustrating the second controlled robot of the first robotic device.

[0028] Figure 11 This is another schematic top view illustrating the second controlled robot of the first robotic device.

[0029] Figure 12 This is a side view illustrating the third control robot of the first robotic device.

[0030] Figure 13 This is a side view illustrating the fourth controlled robot of the first robotic device.

[0031] Figure 14 This is a side view illustrating the fifth control robot of the first robotic device.

[0032] Figure 15 This is another side view illustrating the fifth control robot of the first robotic device.

[0033] Figure 16 This is a side view illustrating the sixth controlled robot of the first robotic device.

[0034] Figure 17 This is a side view of the second robotic device according to the embodiment.

[0035] Figure 18 This is a block diagram of the second robotic device.

[0036] Figure 19 This is a schematic top view illustrating the control of the robot by the second robotic device.

[0037] Figure 20 This is another schematic top view illustrating the control of the robot by the second robotic device. Detailed Implementation

[0038] Reference Figures 1 to 20 The control device for the robot in this embodiment will be described. In the robot control device of this embodiment, each drive axis drives the robot, and zero-point calibration data is generated for each drive axis. The robot control device generates zero-point calibration data for the output of a rotary position detector mounted on a drive motor disposed on one drive axis.

[0039] Figure 1 This is a schematic diagram of the first robotic device in this embodiment. Figure 1 The image shows the state before the installation of the tools. Figure 2 A block diagram illustrating the robot device of this embodiment. (Refer to...) Figure 1 as well as Figure 2The first robotic device 5 includes a robot 1 with a mobile work tool 2. The robot 1 in this embodiment is a multi-joint robot including multiple joints. In particular, the robot 1 in this embodiment is a vertical multi-joint robot. The robot 1 includes multiple movable components. The components of the robot 1 are configured to rotate about respective drive axes.

[0040] Robot 1 includes a base portion 14 fixed to a mounting surface and a rotating base 13 supported on the base portion 14. The rotating base 13 rotates relative to the base portion 14 about a first drive shaft J1. Robot 1 includes an upper arm 11 and a lower arm 12. The lower arm 12 rotates relative to the rotating base 13 about a second drive shaft J2. The upper arm 11 rotates relative to the lower arm 12 about a third drive shaft J3. Furthermore, the upper arm 11 rotates about a fourth drive shaft J4 parallel to the extending direction of the upper arm 11.

[0041] Robot 1 includes a wrist 15 supported on an upper arm 11. The wrist 15 rotates about a fifth drive shaft J5. Additionally, the wrist 15 includes a flange 16 that rotates about a sixth drive shaft J6. A working tool 2 is fixed to the flange 16. In this embodiment, the base 14, the rotating base 13, the lower arm 12, the upper arm 11, the wrist 15, and the working tool 2 are considered components of the robot device 5.

[0042] The robot 1 in this embodiment has six drive axes from drive axis J1 to drive axis J6, but is not limited to this arrangement. A robot capable of changing position and posture through any mechanism can be employed. The work tool 2 employs a device corresponding to the work performed by the robot.

[0043] In the robot device 5, a coordinate system is set with a fixed position and a fixed orientation of the coordinate axes, known as the robot coordinate system. The robot coordinate system is also called the world coordinate system. Additionally, the robot device 5 has a flange coordinate system with an origin at the flange 16 of the wrist 15. The flange coordinate system moves and rotates with the surface of the flange 16. Furthermore, the robot device 5 has a tool coordinate system with an origin set at any position on the working tool. The tool coordinate system moves and rotates with the working tool. The relative position and orientation of the tool coordinate system with respect to the flange coordinate system are fixed and preset. The position of the robot 1 corresponds, for example, to the position of the origin of the tool coordinate system within the robot coordinate system. Furthermore, the orientation of the robot 1 corresponds to the orientation of the tool coordinate system relative to the robot coordinate system.

[0044] Robot 1 includes a robot drive device that changes the position and posture of robot 1. The robot drive device includes drive motors 22a to 22f, which are components such as drive arms and wrists. In this embodiment, multiple drive motors 22a to 22f are arranged corresponding to multiple drive axes J1 to J6. One drive motor is arranged relative to each drive axis. Robot device 5 includes a work tool drive device 21 for driving work tool 2. The work tool drive device 21 includes, for example, a motor, cylinder, and solenoid valve for driving work tool.

[0045] The robot device 5 includes a control device 4 for controlling the robot 1 and the work tool 2. The control device 4 includes a control device main body 40 for performing control and a teaching operation panel 37 for the operator to operate the control device main body 40. The control device main body 40 includes an arithmetic processing unit (computer) with a CPU (Central Processing Unit) as a processor. The arithmetic processing unit has RAM (Random Access Memory) and ROM (Read Only Memory) connected to the CPU via a bus.

[0046] The teach pendant 37 is connected to the control unit main body 40 via a communication device. The teach pendant 37 includes an input section 38 for inputting information related to the robot 1 and the working tool 2. The input section 38 consists of input components such as a keyboard and dials. The teach pendant 37 also includes a display section 39 for displaying information related to the robot 1 and the working tool 2. The display section 39 can be composed of any display panel, such as a liquid crystal display panel or an organic EL (Electro Luminescence) display panel.

[0047] The control device 4 inputs a pre-created motion program 46 for performing the actions of the robot 1 and the work tool 2. Alternatively, the operator can operate the teach pendant 37 to drive the robot 1 and set the teach point of the robot 1. The control device 4 can generate the motion program 46 of the robot 1 and the work tool 2 based on the teach point.

[0048] The control device main body 40 includes an action control unit 43 that controls the movements of the robot 1 and the working tool 2. The action control unit 43 sends action commands to the robot drive unit 45 for driving the robot 1 based on an action program 46. The robot drive unit 45 includes circuitry for driving drive motors 22a-22f. The robot drive unit 45 supplies power to the drive motors 22a-22f based on the action commands. Additionally, the action control unit 43 sends action commands to the working tool drive unit 44 for driving the working tool 2 based on the action program 46. The working tool drive unit 44 includes circuitry for driving the working tool drive device 21. The working tool drive unit 44 supplies power to the working tool drive device 21 based on the action commands.

[0049] The control device main body 40 includes a storage unit 42 for storing information related to the control of the robot 1 and the working tool 2. The storage unit 42 can be constructed from a non-temporary storage medium capable of storing information. For example, the storage unit 42 can be constructed from a storage medium such as volatile memory, non-volatile memory, magnetic storage medium, or optical storage medium. The action program 46 is stored in the storage unit 42.

[0050] The motion control unit 43 is equivalent to a processor that drives the operation according to the motion program 46. The motion control unit 43 is configured to read information stored in the storage unit 42. The processor reads the motion program 46 and implements the control determined by the motion program 46, thereby functioning as the motion control unit 43.

[0051] Robot 1 includes rotary position detectors 19a-19f for detecting the position and posture of robot 1. In this embodiment, the rotary position detectors 19a-19f are mounted on drive motors 22a-22f of each drive shaft. One rotary position detector is mounted on each drive motor. Each rotary position detector 19a-19f can be configured as an encoder that detects the rotation angle of the output shaft of the drive motor 22a-22f. The position and posture of robot 1 are detected based on the outputs of multiple rotary position detectors 19a-19f.

[0052] The control device 4 of the first robot device 5 includes torque sensors 25a to 25f, which are torque detectors used to detect torque around drive shafts J1 to J6 at joints. In this embodiment, torque sensors 25a to 25f are configured for all six drive shafts J1 to J6. One torque sensor is configured for each drive shaft. As torque sensors 25a to 25f, any sensor capable of detecting torque, such as a strain gauge, can be used. The torque sensors are configured between a component of the robot and other components supported and rotated by the component of the robot. For example, the torque sensors are configured between the output shaft of a reducer mounted on a drive motor and a component driven by the reducer.

[0053] Thus, in the robot 1 of the first robot device 5, a drive motor, a rotational position detector, and a torque sensor are arranged relative to a drive axis. For example, a rotational position detector 19a for detecting the rotational position is mounted on the drive motor 22a that rotates the rotating base 13 about the drive axis J1. In addition, a torque sensor 25a for detecting the torque about the drive axis J1 is arranged.

[0054] In this embodiment, zero-point calibration data for the robot is generated for each drive axis. That is, zero-point calibration data is generated based on the output of a rotational position detector mounted on a drive motor located at one joint. In this embodiment, the drive axis from which the zero-point calibration data is generated is referred to as a specific drive axis. The specific drive axis is preset by the operator.

[0055] The control unit body 40 includes a calculation unit 51 that performs force control on the robot 1 based on the output of a torque sensor disposed on a specific drive shaft. Furthermore, the calculation unit 51 generates zero-point calibration data based on the output of a rotational position detector mounted on the drive motor of the specific drive shaft. The calculation unit 51 includes a torque control unit 52 that controls the drive motor to make the torque output from the torque sensor a preset torque setpoint 47. Specifically, the torque control unit 52 controls the torque when the rotation of a component of the robot about the specific drive shaft is prevented by a rotation-stopping unit.

[0056] The calculation unit 51 includes a rotation position acquisition unit 53 that acquires the rotation position output by the rotation position detector of a specific drive shaft when the torque becomes the torque setpoint 47. The calculation unit 51 includes a data generation unit 54 that generates zero-point calibration data for the output of the rotation position detector configured on the specific drive shaft. The data generation unit 54 generates zero-point calibration data based on the rotation position of the drive motor output by the rotation position detector and the design value 49 of the preset zero-point calibration data.

[0057] The theoretical values ​​of the rotation angles on each drive shaft used for zero-point calibration are preset, namely the zero-point calibration design values ​​49. The zero-point calibration design values ​​49 relative to the outputs of the rotary position detectors installed on each drive motor are stored in the storage unit 42. The zero-point calibration design values ​​49 are generated for each rotary position detector 19a to 19f.

[0058] The aforementioned arithmetic unit 51, torque control unit 52, rotational position acquisition unit 53, and data generation unit 54 are equivalent to processors driven according to the action program 46. The processor reads the action program 46 and implements the control set by the action program 46, thereby functioning as each unit.

[0059] In order to detect the rotational position of the output shafts of drive motors 22a to 22f, rotational position detectors 19a to 19f are provided on each drive shaft J1 to J6 of the robot 1 in this embodiment. For each drive shaft J1 to J6, the rotational position of the drive motor used to control the robot, i.e., the machine pulse value, is determined by the following formula (1).

[0060] (Machine pulse value) = (output value of rotary position detector) - (zero point calibration data)...(1)

[0061] In the zero-point calibration operation, zero-point calibration data is calculated. This data represents the rotational position corresponding to the robot's origin. The output value of the rotational position detector becomes the same as the zero-point calibration data, and the machine pulse value becomes zero. The machine pulse value used for robot control can be calculated by subtracting the zero-point calibration data from the rotational position detector's output value.

[0062] For example, the joint angles of each drive shaft (joint) can be calculated based on the machine pulse value and the gear ratio of the reducer. Furthermore, based on the joint angles of each joint, the position and orientation coordinates of the robot in the robot coordinate system can be calculated through forward kinematics transformation. Alternatively, the joint angles of each joint can be calculated through inverse kinematics transformation based on the robot's position and orientation set in the motion program. Furthermore, the machine pulse value can be calculated based on the joint angles and the gear ratio of the reducer. The control device can control the rotational position of the drive motor to obtain this machine pulse value.

[0063] In this embodiment, the robot is driven around a specific drive axis. Rotation is prevented by a limit switch or a gripper. The torque control unit 52 controls the pressing of the component with a preset torque setting value 47. The theoretical value of the output of the rotation position detector at this time, i.e., the design value 49 for zero-point calibration, is preset. The zero-point calibration data can be calculated using the following formula (2).

[0064] (Zero-point calibration data) = (output value of the rotary position detector when pressing the component of the robot) - (theoretical value of the output of the rotary position detector)...(2)

[0065] In the control of this embodiment, high-precision zero-point calibration can be performed. During the zero-point calibration operation of this embodiment, the drive motors of drive axes other than the specific drive axis are not driven, but rather maintained at a preset rotational position. The joint angles of drive axes other than the specific drive axis are maintained at a preset angle. Then, the drive motor of the specific drive axis is driven. Therefore, before performing the zero-point calibration of this embodiment, it is preferable to perform a low-precision zero-point calibration. For example, in the past, when performing precise zero-point calibration, it was possible to form straight lines across the boundaries of adjacent robot components. Straight lines can be formed to determine the rotational position of one component relative to another. Lines can be formed for each joint.

[0066] The operator manually manipulates the robot's position and posture using a teach pendant to align the scribing lines of one component with those of another. When all the scribing lines in the joints are aligned, the position and posture for zero-point calibration are achieved. At this point, a coarse-grained zero-point calibration can be performed based on the output of the rotational position detector and the design (theoretical) value of the rotational position. Subsequently, a high-precision zero-point calibration according to this embodiment can be implemented.

[0067] Figure 3 This is a side view of the robot illustrating the first control of the first robot device in this embodiment. In the first control, drive axis J1 is selected as a specific drive axis. In the first control, zero-point calibration of drive axis J1 is performed. That is, zero-point calibration data is generated for the output of the rotational position detector 19a disposed on drive axis J1.

[0068] The base portion 14 corresponds to the first component of the robot 1, and the rotating base 13, as shown by arrow 85, corresponds to the second component that rotates relative to the first component about a specific drive axis. The stop portions 13a of the rotating base 13 and 14a of the base portion 14 are configured to prevent excessive rotation when the rotating base 13 rotates about the drive axis J1. That is, they are configured to limit the angle of rotation of the rotating base 13 (the range of joint angles of the drive axis J1).

[0069] In the first control, the rotation-stopping part that prevents the rotation of the rotating base 13 includes a stop portion 14a disposed on the base portion 14 as a contact portion and a stop portion 13a disposed on the rotating base 13 as a contact portion. The rotation-stopping part is configured such that when the rotating base 13 rotates as indicated by arrow 85, the stop portion 13a abuts against the stop portion 14a, thereby preventing the rotation of the rotating base 13.

[0070] Figure 4 A schematic top view illustrating the first control of the first robotic device is shown. (Refer to...) Figures 2 to 4 To perform zero-point calibration, the torque control unit 52 drives the drive motor 22a, thereby rotating the rotary base 13 in one direction as shown by arrow 85a. While the rotary base 13 is rotating, the other drive motors 22b to 22f stop. That is, the joint angles of the other drive shafts J2 to J6 are maintained at a preset angle.

[0071] Stop 13a contacts stop 14a, thereby preventing the rotation of the rotating base 13. Torque control unit 52 obtains torque from torque sensor 25a. Torque control unit 52 controls drive motor 22a so that the torque output from torque sensor 25a when preventing the rotation of rotating base 13 becomes a preset torque setting value 47. The torque setting value 47 at this time is preset and stored in storage unit 42.

[0072] The torque control unit 52 can employ any method to control the torque applied to the constituent components. Preferably, the control implemented is to reduce the rotational speed of the drive motor as the torque detected by the torque sensor 25a approaches the target torque value. For example, the torque control unit 52 can implement damping control as force control. In damping control, the speed command v is calculated by dividing the difference between the current force F and the preset target force Fd by a preset damping coefficient D. The formula for damping control can be expressed by the following equation (3).

[0073] v=(F-Fd) / D…(3)

[0074] The torque control unit 52 can calculate the force by dividing the torque obtained from the torque sensor 25a by a preset rotation radius from the rotation center to the contact point. For example, by dividing the output of the torque sensor 25a by the distance from the drive shaft J1 to the stop 13a, the force F applied to the stop 13a can be calculated. Furthermore, the damping control described above using equation (3) can be implemented based on the force F calculated from the torque obtained from the torque sensor 25a.

[0075] The torque control unit 52 sends the speed command v of the drive motor 22a to the motion control unit 43. The motion control unit 43 can control the drive motor 22a of the drive shaft J1 based on the command from the torque control unit 52.

[0076] Furthermore, in equation (3), the speed command v can also be calculated using a formula that converts the target force Fd into the target torque and the current force F into the current torque. Alternatively, in this embodiment, torque sensors 25a to 25f are arranged on all drive shafts J1 to J6. Therefore, the force at the contact point of the stop can be calculated entirely based on the output of torque sensors 25a to 25f. Furthermore, the speed command of the drive motor 22a can also be calculated based on the force at the contact point.

[0077] Next, when the torque output by torque sensor 25a reaches the torque setpoint 47, the rotational position acquisition unit 53 acquires the rotational position output by rotational position detector 19a of drive shaft J1. The data generation unit 54 generates zero-point calibration data for the output of rotational position detector 19a mounted on drive shaft J1 according to the above formula (2). The data generation unit 54 generates zero-point calibration data based on the rotational position of drive motor 22a output by rotational position detector 19a and the preset design value 49 of zero-point calibration data. The storage unit 42 stores the zero-point calibration data related to drive shaft J1 generated by the data generation unit 54.

[0078] In the actual operation of the robot device, when controlling the position and posture of robot 1, the machine pulse value calculated based on the zero-point calibration data is used, as shown in equation (1). As a result, the robot can be driven in a manner that corresponds to the robot's design values ​​with high precision. That is, the position and posture of the robot can be controlled with high precision in a manner that corresponds to the robot's designed position and posture.

[0079] The control device of this embodiment can perform zero-point calibration using torque sensors disposed on each drive shaft. In this embodiment, a component of the robot is rotated and its rotation is stopped by a rotation stop. At this time, the torque control unit controls the torque to press a predetermined component with a torque setpoint. Through this control, the components that stop rotation can be reliably pressed against each other, and precise robot position and posture can be achieved. In this embodiment, zero-point calibration data is generated based on the rotational position when a predetermined force is applied to the pressing part of the predetermined component. Therefore, precise zero-point calibration can be performed.

[0080] The robot control device in this embodiment can generate zero-point calibration data with high precision through simple control. High-precision zero-point calibration can be performed regardless of the operator's skill level. In particular, the zero-point calibration operation is automatically performed by the arithmetic unit 51, making zero-point calibration easy and reducing operator errors.

[0081] Furthermore, the control device of this embodiment can perform zero-point calibration for each drive shaft. Even if zero-point calibration is not performed on all drive shafts, zero-point calibration can be performed on the output of the rotational position detector of the drive motor of a portion of the drive shafts. For example, if a portion of the drive motors or rotational position detectors are replaced, zero-point calibration related to the replaced portion of the drive shafts can be performed. Alternatively, after performing low-precision zero-point calibration such as scribing-based zero-point calibration, the control of this embodiment can be performed on the drive shafts for which the accuracy of zero-point calibration is desired.

[0082] In the first control of the first robot device, the zero-point calibration on drive axis J1 was described, but it is not limited to this method. Regarding the other drive axes J2 to J6, the same control as the first control can be implemented if stop portions limiting the rotation range are provided. Alternatively, stop portions can be provided relative to each robot in a manner that limits the rotation angle of the robot drive.

[0083] However, when driving robot 1, the output of drive motors 22a to 22f is transmitted to each component after being reduced in speed by a reducer. In the reducer, multiple gears mesh with each other. Therefore, a loosening (backlash) effect occurs at the meshing points of the gears. Next, the control that corrects the backlash effect in the first control will be explained.

[0084] Reference Figure 4 The torque control unit 52 rotates the rotary base 13 in the direction indicated by arrow 85a, which is the first direction. The rotation position acquisition unit 53 detects a first rotation position when the rotation of the rotary base 13 in the first direction is prevented. The rotation position acquisition unit 53 detects a first rotation position when the stop part 13a is pressed against a stop part 14a of the base part 14.

[0085] Figure 5 This is a schematic top view showing other aspects of the first control of the first robot device. Next, the torque control unit 52 rotates the rotary base 13 in the direction indicated by arrow 85b, which is the second direction opposite to the first direction. The stop 13a contacts another stop 14a to prevent rotation. The torque control unit 52 also controls the rotation by pressing the stop 13a against the stop 14a to achieve a torque setpoint 47. The rotation position acquisition unit 53 detects a second rotation position when rotation of the rotary base 13 in the second direction is prevented. The rotation position acquisition unit 53 detects the second rotation position when the stop 13a is pressed against the stop 14a. Next, the data generation unit 54 calculates a correction value for the zero-point calibration data based on the first and second rotation positions.

[0086] Figure 6 A schematic cross-sectional view showing the meshing portion of the gears in the speed reducer. Figure 6 The diagram shows the portion of the reducer where one gear 81 meshes with other gears 82. In this example, the teeth 81a of gear 81 engage with the teeth 82a and 82b of gear 82. Arrow 89a corresponds to a first direction that causes the base portion 14 to rotate. Arrow 89b corresponds to a second direction that causes the base portion 14 to rotate.

[0087] Figure 7 This is an enlarged sectional view showing the gear rotating in the first direction. Figure 8 This is an enlarged, approximate sectional view showing the gear rotating in the second direction. (See reference...) Figures 6 to 8 By rotating gear 81 in the direction indicated by arrow 89a, tooth 81a contacts tooth 82b. By rotating gear 81 in the direction indicated by arrow 89b, tooth 81a contacts tooth 82a. Although gear 81 rotates, gear 82 sometimes does not rotate due to backlash.

[0088] Reference Figure 4 as well as Figure 5 In this embodiment, the arithmetic unit 51 detects a first rotational position when the rotating base 13 is rotated in the first direction indicated by arrow 85a. The arithmetic unit 51 detects a second rotational position when the rotating base 13 is rotated in the second direction indicated by arrow 85b.

[0089] As indicated by arrow 90, the data generation unit 54 calculates the rotation angle when rotating from the first rotation position to the second rotation position. Furthermore, the angle obtained by subtracting the design value of the rotation angle from the actual rotation angle when the rotary base 13 rotates is equivalent to the backlash rotation angle δ. Figure 7 as well as Figure 8 The difference in rotation angles shown corresponds to the rotation angle δ of the tooth gap.

[0090] When the rotational position output from the rotational position detector rotates in the negative direction, the output rotational position has a smaller backlash, so δ / 2 can be added to the machine pulse value. The data generation unit 54 can subtract δ / 2 from the zero-point calibration data. On the other hand, when the rotational position of the rotational position detector rotates in the positive direction, the output rotational position is larger, so δ / 2 can be subtracted from the machine pulse value. That is, the data generation unit 54 can add δ / 2 to the zero-point calibration data. In this way, the calculation unit 51 can calculate the correction value of the output pulse value of the above formula (1). That is, the calculation unit 51 can calculate the correction value of the zero-point calibration data.

[0091] In this way, by pressing twice in opposite directions, the correction value of the zero-point calibration data related to the backlash can be calculated. Furthermore, pressing of the robot's components or the gripper supporting the robot can be performed by two rotations: one in the positive direction and one in the negative direction, but this can also be repeated three or more times.

[0092] Figure 9 This is a side view of the robot illustrating the second control of the first robot device in this embodiment. In the second to sixth controls of the first robot device, which will be described later, a gripper is configured as a rotation stop to prevent rotation of the components of robot 1. In the second control, drive shaft J1 is selected as a specific drive shaft. Torque control unit 52 rotates the rotating base 13, which is a second component, relative to the base portion 14, which is a first component. The rotating base 13 is rotated about drive shaft J1 in the direction indicated by arrow 85.

[0093] Figure 10 A schematic top view illustrating the second control robot of the first robotic device is shown. (Refer to...) Figure 9 as well as Figure 10 The rotation-stopping part includes a clamp 71 fixed to the base portion 14, which is a first component. The clamp 71 is fixed to the component when it is stationary during robot operation. The clamp 71 is formed in a rod shape. For example, the clamp 71 is formed in a cylindrical shape. The clamp 71 is configured to contact the wrist portion 15 when the rotating base 13 is rotated. The clamp 71 contacts the wrist portion 15, thereby preventing the rotation of the rotating base 13. It is preferable to strictly adjust the position where the clamp 71 is fixed and the posture of the clamp 71.

[0094] The torque control unit 52 rotates the rotary base 13 together with the lower arm 12, the upper arm 11, and the wrist part 15 in the direction indicated by arrow 85a, which is the first rotation direction. The rotational positions of the drive motors 22b to 22f in the other drive shafts J2 to J6 that rotate the rotary base 13 are preset. The joint angles of the specific drive shafts, namely drive shafts J2 to J6 other than drive shaft J1, are fixed.

[0095] The torque control unit 52 controls the drive motor 22a so that the torque detected by the torque sensor 25a when the wrist 15 contacts the clamp 71 becomes the torque setpoint 47. When the torque detected by the torque sensor 25a becomes the torque setpoint, the rotational position acquisition unit 53 acquires a first rotational position from the rotational position detector 19a. Furthermore, the data generation unit 54 is able to generate zero-point calibration data based on the first rotational position of the drive motor 22a and the design value 49 of the zero-point calibration data.

[0096] Figure 11 A further schematic top view of the robot illustrating the second control of the first robot device is shown. In the second control, a correction value for the zero-point calibration data, taking into account the effect of backlash, can also be calculated. The torque control unit 52 rotates the rotary base 13 in a second direction opposite to the first direction. The torque control unit 52 rotates the rotary base 13 in the direction of arrow 85b, which is the second direction, pressing the wrist 15 against the gripper 71 with a torque setpoint 47. The rotational position acquisition unit 53 acquires the second rotational position from the rotational position detector 19a.

[0097] Rotation position acquisition unit 53 acquisition Figure 10 The first rotation position shown when rotation in the first direction is prevented and Figure 11 The second rotation position is shown when rotation in the second direction is prevented. Similar to the first control, the data generation unit 54 calculates the correction value for the zero-point calibration data based on the first and second rotation positions. The data generation unit 54 can calculate the correction value related to the backlash of the zero-point calibration data based on the difference between the rotation angle from the first to the second rotation position (as shown by arrow 91) and the theoretical value of the rotation angle. Other controls, functions, and effects are the same as the first control.

[0098] Figure 12 This is a side view of the robot illustrating the third control of the first robot device. In the third control, the second drive axis J2 is selected as the specific drive axis. In the third control, zero-point calibration data is generated for the output of the rotary position detector 19b mounted on the drive motor 22b disposed on the drive axis J2. In the third control, the clamp 71 is also fixed to the base portion 14 in the same manner as in the second control.

[0099] In the third control, the torque control unit 52 changes the position and posture of the robot 1 so that the upper arm 11 and wrist 15 are oriented upward relative to the lower arm 12. The joint angles of drive shafts J1, J3 to J6 are preset. The torque control unit 52 does not drive the drive motors 22a, 22c to 22f in drive shafts J1, J3 to J6, but keeps them stationary. The torque control unit 52 drives the drive motor 22b of drive shaft J2. As shown by arrow 86, the torque control unit 52 brings the lower arm 12 into contact with the gripper 71. Furthermore, the torque control unit 52 controls the drive motor 22b so that the torque output from the torque sensor 25b becomes the preset torque setpoint 47.

[0100] Next, the rotational position detector 19b detects the rotational position when the lower arm 12 is pressed against the clamp 71. Furthermore, the data generation unit 54 generates zero-point calibration data based on this rotational position and the zero-point calibration design value 49. Other controls, functions, and effects are the same as the first control.

[0101] Figure 13 This is a side view illustrating the fourth control of the first robot device. The gripper, which prevents the constituent parts from rotating about a specific drive axis, is not limited to a stationary gripper; it can also move along with the robot's drive. In the fourth control, the second drive axis J2 is selected as the specific drive axis.

[0102] In the fourth control, the gripper 73 is fixed to the rotating base 13. The position and posture of the gripper 73 are precisely adjusted. The gripper 73 moves together with the rotating base 13. The gripper 73 is formed in a rod shape. As shown by arrow 87, the torque control unit 52 drives the lower arm 12 to rotate by driving the drive motor 22b disposed on the drive shaft J2. At this time, the joint angles of the other drive shafts J1, J3 to J6 remain constant. With the torque control unit 52 pressing the lower arm 12 against the gripper 73 with a preset torque setting value 47, the rotation position acquisition unit 53 acquires the rotation position output from the rotation position detector 19b. The data generation unit 54 generates zero-point calibration data for the output of the rotation position detector 19b disposed on the drive shaft J2. Thus, the gripper that prevents the rotation of the robot's components on a specific drive shaft can also move together with the robot's components. Other controls, actions, and effects are the same as in the first control.

[0103] Figure 14 This is a side view illustrating the fifth control of the first robot device. In the fifth control, the fifth drive axis J5 is selected as the specific drive axis. In the fifth control, zero-point calibration data is generated for the output of the rotational position detector 19e of the drive motor 22e configured on the drive axis J5.

[0104] In the fifth control, a clamp 74 is used, comprising a first component 74a and a second component 74b. The first component 74a is a plate-shaped component with a quadrilateral planar shape. The first component 74a is fixed to the flange 16 of the wrist portion 15. The largest surface of the first component 74a is fixed to the flange 16. The first component 74a can change its position and posture by the robot 1.

[0105] In contrast, the second component 74b is a stationary component. The second component 74b is fixed to the base portion 14. The position and orientation of the second component 74b are precisely adjusted. Alternatively, the second component 74b can also be fixed to the mounting surface of the robot 1. A recess 74bx with a quadrilateral planar shape is formed on the upper surface of the second component 74b. The first component 74a has a size that allows it to be disposed within the recess 74bx.

[0106] In the fifth control, the torque control unit 52 rotates the wrist 15 around the drive shaft J5 in the direction of arrow 88a, which is the first direction. The joint angles of the other drive shafts J1 to J4 and J6 remain constant. The torque control unit 52 contacts the end face 74aa of the first component 74a with the side face 74ba of the recess 74bx of the second component 74b. Based on the output of the torque sensor 25e, the torque control unit 52 presses the first component 74a with a preset torque setting value 47. At this time, the rotation position acquisition unit 53 acquires the first rotation position from the rotation position detector 19e. Furthermore, the data generation unit 54 is able to generate zero-point calibration data relative to the output of the rotation position detector 19e based on the output of the rotation position detector 19e and the zero-point calibration design value 49.

[0107] Figure 15 This shows another side view of the robot under the fifth control of the first robot device. The planar shape of the recess 74bx of the second component 74b is formed to be slightly larger than the planar shape of the first component 74a. In the fifth control, it is also possible to calculate the correction value of the zero-point calibration data that takes into account the influence of backlash.

[0108] The torque control unit 52 rotates the wrist 15 in the direction indicated by arrow 88b, which is the second direction opposite to the first direction. The end face 74ab of the first component 74a contacts the side face 74bb of the recess 74bx of the second component 74b. With the first component 74a pressed at the torque setting value 47, the rotation position acquisition unit 53 acquires the second rotation position of the rotation position detector 19e. As indicated by arrow 92, the data generation unit 54 calculates the rotation angle from the first rotation position to the second rotation position. The data generation unit 54 can calculate the correction value of the rotation angle related to backlash, i.e., the rotation angle (δ / 2), based on the difference between the measured value and the design value (theoretical value) of this rotation angle.

[0109] Therefore, in the fifth control, the backlash-related correction value can also be calculated by rotating the wrist 15 in the first direction and in the second direction opposite to the first direction. The other controls, functions, and effects are the same as in the first control.

[0110] In the fifth control, zero-point calibration data for the fifth drive shaft J5 is generated. However, zero-point calibration data for the third drive shaft J3 can also be generated using the same control. That is, by maintaining the joint angles of drive shafts J1, J2, and J4 to J6 (other than drive shaft J3) at a constant, the first component 74a of the clamp 74 is pressed against the recess 74bx of the second component 74b by driving the drive motor 22c. Furthermore, by detecting the rotational position of the rotational position detector 19c mounted on the drive motor 22c, zero-point calibration data relative to the output of the rotational position detector 19c can be generated.

[0111] Figure 16 This is a side view of the robot illustrating the sixth control of the first robot device. In this sixth control, a fixture 74, including a first component 74a and a second component 74b, is also used. In this sixth control, a sixth drive axis J6 is selected as the specific drive axis. In this sixth control, zero-point calibration data is generated for the output of a rotational position detector 19f of the drive motor 22f configured on drive axis J6.

[0112] In the sixth control, the surface with the largest area of ​​the first component 74a is arranged to extend horizontally. The side surface 74ba of the recess 74bx of the second component 74b and the end surface 74aa of the first component 74a are formed as planes. The torque control unit 52 makes the end surface 74aa contact with the side surface 74ba. Alternatively, the first component 74a may be arranged in a predetermined position and posture with a gap formed between the side surface 74ba and the end surface 74aa.

[0113] The torque control unit 52 rotates the first component 74a in one of the directions of arrow 93, i.e., the first direction. The joint angles of the other drive shafts J1 to J5 remain constant. The torque control unit 52 implements control to press the first component 74a against the second component 74b with a torque setpoint 47. The torque control unit 52 controls the drive motor 22f so that the torque detected by the torque sensor 25f becomes the preset torque setpoint 47. The rotational position acquisition unit 53 acquires the first rotational position, and the data generation unit 54 is able to generate zero-point calibration data relative to the output of the rotational position detector 19f based on the first rotational position.

[0114] Additionally, the torque control unit 52 rotates the first component 74a in the opposite direction of arrow 93, namely the second direction. During the period when the torque control unit 52 controls the first component 74a to press at the torque setpoint 47, the rotation position acquisition unit 53 acquires the second rotation position. The data generation unit 54 can calculate a backlash-related correction value based on the rotation angle from the first rotation position to the second rotation position. Other controls, functions, and effects are the same as the first control.

[0115] In the sixth control, zero-point calibration data for the sixth drive axis J6 is generated, but this method is not limited. Zero-point calibration data related to the J4 axis can also be generated using the same control. The arithmetic unit 51 drives the drive motor 22d to press the end face 74aa of the first component 74aa against the side surface 74ba of the recess 74bx of the second component 74b. Furthermore, the arithmetic unit 51 can generate zero-point calibration data for the rotary position detector 19d based on the output of the rotary position detector 19d.

[0116] Thus, in the fifth and sixth controls, zero-point calibration data for drive shafts J3 to J5 can be generated using the fixture 74. The first component of the fixture 74 can have any shape. Furthermore, the shape of the recess in the second component can also be any shape. Specifically, a spherical first component can replace the quadrilateral first component 74a. Additionally, a hemispherical recess can replace the quadrilateral recess 74bx of the second component 74b. By employing this structure, zero-point calibration data related to drive shafts J1 and J2 can be generated. With the first component pressed against the recess of the second component, the rotational position output by each drive motor 22a and 22b can be obtained. Zero-point calibration data can be generated based on the rotational position.

[0117] Figure 17 This is a side view of the second robot device in this embodiment. Figure 18 A block diagram illustrating the second robot device of this embodiment. (Refer to...) Figure 17 as well as Figure 18 The second robot device 6 includes a robot 3 and a control device 7. In the second robot device 6, the torque sensor of the first robot device 5 may not be located at the joint of the robot 3.

[0118] The control device 7 of the second robot device 6 includes a gripper 76 that prevents the constituent components from rotating around a specific drive axis. The gripper 76 includes a force sensor 24 that acts as a force detector, detecting forces in a predetermined direction. The force sensor 24 in this embodiment can detect forces applied in the positive and negative directions of three mutually orthogonal axes (X-axis, Y-axis, and Z-axis). As the force sensor 24, any force sensor, including a strain sensor or an electrostatic capacitive sensor, can be used.

[0119] The clamp 76 has a fixed portion 76a mounted on one side of the force sensor 24 and a movable portion 76b mounted on the other side of the force sensor 24. In this embodiment, the fixed portion 76a and the movable portion 76b are both formed in the shape of rods. The fixed portion 76a is fixed to a component that is stationary when the robot 3 is driven. In this example, the fixed portion 76a is fixed to the base portion 14 of the robot 3. The position and posture of the clamp 76 are precisely adjusted.

[0120] The control device 7 of the second robot device 6 implements force control for pressing components or grippers based on the output of the force sensor 24 instead of the torque sensor. Zero-point calibration is also performed on each drive axis in the second robot device. In this example, drive axis J1 is selected as the specific drive axis.

[0121] The control unit 7 includes a calculation unit 61 that performs force control and generates zero-point calibration data. The calculation unit 61 includes a force control unit 62 that controls a drive motor of a specific drive shaft so that the force output from the force sensor 24 becomes a force setpoint 48. The force control unit 62 performs this control when the rotation of the components of the robot 3 is prevented by the gripper 76. The force setpoint 48 is preset and stored in the storage unit 42.

[0122] When the force output from the force sensor 24 becomes the force set value 48, the rotational position acquisition unit 53 acquires the rotational position output by the rotational position detector of a specific drive shaft. The data generation unit 54 generates zero-point calibration data for the output of the rotational position detector on the specific drive shaft based on the rotational position of the drive motor output by the rotational position detector and the design value 49 of the preset zero-point calibration data.

[0123] Figure 19 This is a schematic top view illustrating the control of the second robotic device. (See reference...) Figures 17 to 19 In the second robot device 6, the force control unit 62 controls the wrist 15, which is a component of the robot 3, to press against the movable part 76b of the gripper 76. The second robot device also implements control to maintain the joint angle of drive axes other than a specific drive axis at a constant value.

[0124] The force control unit 62 drives the first drive motor 22a to rotate the wrist 15 in the direction indicated by arrow 85a, which is the first direction. The wrist 15 then contacts the movable part 76b. The force control unit 62 controls the drive motor 22a based on the output of the force sensor 24 so that the force of the wrist 15 pressing the movable part 76b becomes the force set value 48.

[0125] When the force output from the force sensor 24 becomes the force set value 48, the rotational position acquisition unit 53 acquires the first rotational position output by the rotational position detector 19a. The data generation unit 54 can generate zero-point calibration data relative to the output of the rotational position detector 19a based on the first rotational position of the drive motor 22a output by the rotational position detector 19a and the design value 49 of the zero-point calibration data.

[0126] In the second robot device 6, a force sensor 24 is installed on the gripper 76 instead of the torque sensor in the first robot device. Furthermore, force control is implemented based on the output of the force sensor 24, and zero-point calibration data is generated. Zero-point calibration can also be performed with high precision through simple control in the second robot device.

[0127] Figure 20 This is a schematic top view illustrating the control of the second robot device. In the second robot device, the backlash correction value can be calculated in the same way as the second control of the first robot device. The force control unit 62 drives the first drive motor 22a to move the wrist 15 in a second direction, as indicated by arrow 85b, which is opposite to the first direction. The wrist 15 of the robot 3 can be pressed against the movable part 76b of the gripper 76. The force control unit 62 implements control to rotate the wrist 15 in a second direction, opposite to the first direction.

[0128] The force control unit 62 controls the first drive motor 22a to press the movable part 76b with a preset force setting value 48. The rotation position acquisition unit 53 acquires the second rotation position at this time. In this way, control is implemented to rotate the component in the first direction and to rotate the component in the second direction opposite to the first direction. The rotation position acquisition unit 53 detects the first rotation position when rotation in the first direction is blocked and the second rotation position when rotation in the second direction is blocked.

[0129] Furthermore, the data generation unit 54 calculates the rotation angle from the first rotation position to the second rotation position, as indicated by arrow 91, based on the first rotation position and the second rotation position. The data generation unit 54 can calculate the backlash correction value, i.e., the rotation angle (δ / 2), based on this rotation angle and its theoretical value.

[0130] This allows for the generation of zero-point calibration data by configuring force detectors on the robot's components or in the clamps that press the workpiece. For example, it enables... Figure 12 A force detector is mounted on the fixture 71 shown. Additionally, it is possible to... Figure 13 A force sensor is mounted on the fixture 73 shown. Additionally, it is possible to... Figure 14 A force sensor is mounted on the second component 74b of the fixture 74 shown. Furthermore, zero-point calibration data can be generated based on the output value of the force detector and the design value of the force when a component of the robot or a fixture supported by the robot is pressed against the fixed fixture.

[0131] The clamp including the force detector in this embodiment is formed in a rod shape, but it is not limited to this method; clamps of any shape can be used. The structure, function, and effects of the second robot device other than those described above are the same as those of the first robot device, and therefore will not be described again here.

[0132] In each of the above controls, the order of steps can be appropriately changed without altering the function or effect.

[0133] The above-described embodiments can be appropriately combined. In the above figures, identical or equivalent parts are labeled with the same symbols. Furthermore, the above-described embodiments are illustrative and do not limit the invention. Additionally, the embodiments include variations of the embodiments shown within the scope of the technical solution.

[0134] Symbol Explanation

[0135] 1, 3—Robot; 4, 7—Control device; 5, 6—Robot device; 11—Upper arm; 12—Lower arm; 13—Rotating base; 13a—Stop; 14—Base; 14a—Stop; 15—Wrist; 16—Flange; 19a~19f—Rotation position detector; 22a~22f—Drive motor; 24—Force sensor; 25a~25f—Torque sensor; 37—Teach pendant; 38—Input unit; 39—Display unit; 40—Control device body; 42—Storage unit; 47—Torque setpoint; 48—Force setpoint; 49—Design value for zero-point calibration; 52—Torque control unit; 53—Rotation position acquisition unit; 54—Data generation unit; 62—Force control unit; 71, 73, 74, 75—Figment; 74a—First component; 74b—Second component; 76—Figment.

Claims

1. A control device for a robot, generating zero-point calibration data relative to the output of a rotational position detector mounted on a drive motor of a specific drive axis that rotates a component of the robot, the control device being characterized by comprising: Torque detector, which detects torque about a specific drive shaft; The torque control unit controls the drive motor of a specific drive shaft so that when the rotation of a component about the specific drive shaft is prevented by the rotation prevention unit, the torque output from the torque detector becomes a preset torque setting value. A rotational position acquisition unit acquires the rotational position output by a rotational position detector of a specific drive shaft when the torque output from the torque detector becomes a torque setpoint; and The data generation unit generates zero-point calibration data for the output of a rotary position detector configured on a specific drive shaft, based on the rotational position of the drive motor output by the rotary position detector and the design value of the preset zero-point calibration data.

2. The control device according to claim 1, characterized in that, The robot includes a second component that rotates about a specific drive axis relative to the first component. The rotation-stopping part includes a contact portion disposed on a first component and a contact portion disposed on a second component, configured such that the contact portion of the first component abuts against the contact portion of the second component to prevent rotation of the second component. The torque control unit controls the torque of the drive motor that drives the second component so that the torque when the rotation of the second component is stopped becomes a preset torque setting value.

3. The control device according to claim 1, characterized in that, The robot includes a second component that rotates about a specific drive axis relative to the first component. The rotation-stopping part includes a clamp that prevents the rotation of the second component.

4. The control device according to claim 3, characterized in that, The clamp is fixed to the first component.

5. The control device according to claim 3, characterized in that, The clamp is fixed to a component that is stationary when the robot is driven.

6. The control device according to claim 1, characterized in that, The torque control unit implements control to rotate the component in a first direction and control to rotate the component in a second direction opposite to the first direction. The rotation position acquisition unit detects a first rotation position when rotation in the first direction is blocked and a second rotation position when rotation in the second direction is blocked. The data generation unit calculates the correction value of the zero-point calibration data based on the first rotation position and the second rotation position.

7. A control device for a robot, which generates zero-point calibration data relative to the output of a rotational position detector mounted on a drive motor of a specific drive axis that rotates a component of the robot, the control device being characterized by comprising: A clamp that prevents constituent components from rotating about a specific drive shaft and includes a force detector; The force control unit controls the drive motor of a specific drive shaft so that when the rotation of a component about the specific drive shaft is stopped by a clamp, the force output from the force detector becomes a preset force setting value. The rotational position acquisition unit acquires the rotational position output by the rotational position detector of a specific drive shaft when the force output from the force detector becomes a force set value. as well as The data generation unit generates zero-point calibration data for the output of a rotary position detector configured on a specific drive shaft, based on the rotational position of the drive motor output by the rotary position detector and the design value of the preset zero-point calibration data.

8. The control device according to claim 7, characterized in that, The force control unit implements control to rotate the component in a first direction and control to rotate the component in a second direction opposite to the first direction. The rotation position acquisition unit detects a first rotation position when rotation in the first direction is blocked and a second rotation position when rotation in the second direction is blocked. The data generation unit calculates the correction value of the zero-point calibration data based on the first rotation position and the second rotation position.

Citation Information

Patent Citations

  • Robot mastering method

    JP1996171410A

  • Robot, robot control device, robot control method and robot system

    JP2016221642A

  • Zero point setting apparatus of torque sensor in steering device for vehicle

    JP2004309231A

  • Origin position setting device, origin position setting method, link mechanism and leg wheel type robot

    JP2009050937A