Robot control device, robot control system, and robot control method
The robot control device corrects other-axis errors in torque detection by estimating and controlling contact forces, enhancing the precision of force application in industrial robots.
Patent Information
- Application Number
- JP2023079754
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-15
- Publication Date
- 2024-11-27
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Industrial robots equipped with torque sensors face errors in torque detection due to rotational and translational forces, which conventional methods fail to correct during forceful work with work objects.
A robot control device that includes a torque detection unit, position information acquisition, command value acquisition, error estimation, and control units to estimate and correct other-axis errors in torque detection based on contact forces, using a system of torque sensors, encoders, and motors to accurately control the robot arm.
The system effectively corrects other-axis errors in torque detection, enabling precise force application to workpieces, improving processing quality by ensuring accurate force control and reducing errors in torque measurement.
Smart Images

Figure 2024164343000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a robot control device, a robot control system, and a robot control method. [Background technology]
[0002] Generally, industrial robots are known that are equipped with torque sensors at the joints of the robot arms and can detect rotational forces (called torque) acting around the rotation axis of the joints. Such robots can detect external forces acting on the hand or links of the robot arms and perform mechanical tasks such as pressing an end effector attached to the hand of the robot arm against a workpiece to be processed. The torque sensors of such robots are designed to detect torque acting on the joints, but in reality, they can be affected by rotational forces in two directions and translational forces in three directions other than the torque acting on the torque sensor, resulting in errors (called other-axis errors) in the torque detection results.
[0003] Conventionally, a robot has been disclosed that estimates and corrects other axis errors that occur in torque detection results due to the mass of a robot arm or the like (see, for example, Patent Document 1). [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2020-037172 A Summary of the Invention [Problem to be solved by the invention]
[0005] In the above-mentioned robot force work, other-axis errors may occur in the torque detection results due to the robot arm coming into contact with the work target. However, the robot described in Patent Document 1 has a problem in that it cannot correct other-axis errors in such force work.
[0006] The present disclosure is intended to solve the above-mentioned problems, and aims to provide a robot control device, a robot control system, and a robot control method that are capable of correcting other-axis errors that occur in torque detection results due to forces received by a robot arm from a work object. [Means for solving the problem]
[0007] The robot control device according to the present disclosure is characterized by including a torque detection unit that detects torque acting on a joint of a robot arm; a position information acquisition unit that acquires position information regarding the position of a specific part of the robot arm when the specific part is brought into contact with an object; a command value acquisition unit that acquires a command value of a contact force when the specific part of the robot arm is brought into contact with an object; an error estimation unit that estimates a other-axis error caused by the contact force when the specific part is in contact with the object, which is contained in the torque detected by the torque detection unit, based on the position information acquired by the position information acquisition unit and the command value acquired by the command value acquisition unit; and a control unit that controls the robot arm so that the specific part comes into contact with the object, based on the torque detected by the torque detection unit and the error estimated by the error estimation unit. Effect of the Invention
[0008] According to the present disclosure, the other-axis error that occurs when a specific part of the robot arm is brought into contact with an object is estimated based on a contact force command value, and the robot arm is controlled based on the estimation result, thereby making it possible to correct the other-axis error that occurs in the torque detection result due to the force that the robot arm receives from the work object. [Brief description of the drawings]
[0009] [Figure 1] 1 is a schematic diagram showing a robot control system according to a first embodiment. [Diagram 2] FIG. 1 is a block diagram showing a configuration of a robot control system according to a first embodiment. [Diagram 3] FIG. 2 is a diagram showing an example of a hardware configuration of the robot control device according to the first embodiment. [Figure 4] FIG. 2 is a diagram showing an example of a hardware configuration of the robot control device according to the first embodiment. [Diagram 5] FIG. 2 is a block diagram showing a configuration of a other-axis error correction unit according to the first embodiment. [Figure 6] FIG. 2 is a block diagram showing the configuration of a disturbance correction unit according to the first embodiment. [Figure 7] FIG. 2 is a block diagram showing the configuration of a force control unit according to the first embodiment. [Figure 8] FIG. 2 is a block diagram showing the configuration of a position control unit according to the first embodiment. [Figure 9] FIG. 2 is a block diagram showing a configuration of a drive control unit according to the first embodiment. [Figure 10] 4 is a flowchart showing a process performed by the robot control device according to the first embodiment. [Figure 11] 5 is a flowchart showing a process performed by a other-axis error correction unit according to the first embodiment. [Figure 12] FIG. 2 is a conceptual diagram showing an example of a definition of a coordinate system of the torque sensor according to the first embodiment. [Figure 13] 4 is a flowchart showing a process performed by a force control unit according to the first embodiment. [Figure 14] 5 is a flowchart showing a process performed by a position control unit according to the first embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] Hereinafter, embodiments of the present disclosure will be described in detail with reference to the drawings. Embodiment 1 Fig. 1 is a diagram showing an example of the configuration of a robot control system 1A according to the first embodiment. As shown in Fig. 1, the robot control system 1A includes a command value generating unit 1, a robot control device 2, and a robot arm 3. The command value generating unit 1 generates various command values when the robot control device 2 performs processing. The robot control device 2 controls the operation of the robot arm 3.
[0011] The robot arm 3 has two or more links including links L1 and L2 that are relatively movable with respect to each other, and an end effector E1 attached to the tip. The links are connected to each other by joints so that adjacent links can rotate with respect to each other about a specific central axis. For example, the links L1 and L2 are connected to each other by a joint J1 so that they can rotate with respect to each other about a specific central axis. In addition, for example, the robot arm 3 is configured as a six-axis vertical multi-joint robot having six joints. In the following description, the rotation direction of the joint J1 about the specific central axis is also referred to as the rotation direction of the joint J1.
[0012] The robot arm 3 operates upon receiving a current supply from the robot control device 2. For example, the robot arm 3 operates to bring an end effector E1, which is a specific part, into contact with a workpiece W1, which is an object, upon receiving a current supply from the robot control device 2. In other words, the robot arm 3 performs a task of applying a contact force to the workpiece W1 by pressing the end effector E1, which is a force point, against the workpiece W1 upon receiving a current supply from the robot control device 2. Specifically, the robot arm 3 performs a task of machining the workpiece W1 by pressing the end effector E1, which is a machining tool, against the workpiece W1, which is a workpiece to be machined, upon receiving a current supply from the robot control device 2.
[0013] The robot arm 3 is not limited to being operated by receiving a current from the robot control device 2, but may be configured to receive a power supply from another device (not shown) and to acquire a control signal from the robot control device and operate based on the control signal from the robot control device. The work performed by the robot arm may be any work in which a specific part of the robot arm comes into contact with a workpiece and receives an external force from the workpiece, and may be work to push and move the workpiece, work to push and deform the workpiece, or work to lift the workpiece. In the following description, work in which a specific part of the robot arm comes into contact with a workpiece and receives an external force from the workpiece is also referred to as force work.
[0014] 2 is a block diagram showing the configuration of a robot control system 1A according to the first embodiment. For example, the command value generating unit 1 generates (calculates) a force command value, which is a command value for the contact force of the end effector E1 against a workpiece W1 when performing force work, and a position command value, which is a command value for the position and orientation of the end effector E1 when performing force work, in accordance with a predetermined robot program for controlling the robot arm 3. In addition, the command value generating unit 1 reflects relative position information of the point of force as viewed from the boundary between the end effector E1 and the robot arm 3 in a robot kinematics and dynamics model held by the robot control device 2.
[0015] 2, the robot arm 3 has a plurality of torque sensors 31, a plurality of encoders 32, and a plurality of motors 33 corresponding to the respective joints, and each is electrically connected to the robot control device 2 by electric wires such as power lines and signal lines. Note that the robot arm 3 is not limited to being connected to the robot control device 2 by electric wires, and may be configured to be wirelessly connected to the robot control device so as to be able to transmit and receive signals and to receive power from a device other than the robot control device, or may be configured to be connected to the robot control device by electric wires so as to be able to transmit and receive signals and to receive power from a device other than the robot control device, or may be configured to receive power and control signals from a device other than the robot control device (not shown).
[0016] The motor 33 rotates the links connected at the corresponding joints relative to each other based on a control signal from the robot control device 2. For example, the motor 33 is configured by a servo motor. The encoder 32 detects (measures) the rotation angle of the corresponding joint and outputs a signal according to the detected rotation angle. In the following description, the value of the rotation angle detected by the encoder 32 is also referred to as an angle measurement value.
[0017] The torque sensor 31 detects (measures) the torque applied to the corresponding joint. In other words, the torque sensor 31 detects the torque acting on the corresponding joint. When the torque sensor 31 detects the torque, it outputs a signal according to the magnitude of the detected torque. For example, the torque sensor 31 is configured by a strain gauge type torque sensor. Note that the torque sensor may be a sensor that detects torque by other methods such as a capacitance type, a magnetostriction type, an optical type, etc. In the following description, the value of the torque detected by the torque sensor 31 is also referred to as a torque measurement value.
[0018] The torque sensor 31 is provided to detect the torque acting in the rotation direction (drive direction) of the joint. Generally, the torque measurement value by such a torque sensor is affected by a force in a direction other than the rotation direction of the joint, and therefore the torque measurement value includes an error. In other words, the torque measurement value by the torque sensor is a value reflecting a force in a direction other than the rotation direction of the joint in addition to the torque applied in the rotation direction of the joint. For example, the torque sensor receives a force in a direction other than the rotation direction of the joint due to an external force received from the workpiece W1 (see FIG. 1) when the robot arm 3 comes into contact with the workpiece W1, gravity and inertia forces due to the mass of the robot arm 3, and the like. In the following description, the force in a direction other than the rotation direction of the joint received by the robot arm 3 is also referred to as the other-axis force of each joint. In the following description, the error caused by the other-axis force included in the torque measurement value is also referred to as the other-axis error. In addition to the other-axis error, the torque measurement value includes an offset disturbance caused by a zero point shift due to various factors, and a disturbance error caused by disturbances such as electrical noise.
[0019] The robot control device 2 has a other-axis error correction unit 21, a disturbance correction unit 22, a force control unit 23, a position control unit 24, an adder unit 25, and a drive control unit 26. The other-axis error correction unit 21 acquires a force command value and an angle measurement value from the command value generation unit 1, and acquires a torque measurement value from a torque sensor 31. The other-axis error correction unit 21 corrects the torque measurement value based on the force command value, the angle measurement value, and the torque measurement value. In other words, the other-axis error correction unit 21 calculates a torque value after other-axis error correction by removing the other-axis error from the torque measurement value, based on the force command value, the angle measurement value, and the torque measurement value.
[0020] The disturbance correction unit 22 acquires the angle measurement value from the encoder 32, and acquires the other-axis error-corrected torque from the other-axis error correction unit 21. The disturbance correction unit 22 calculates a disturbance-corrected torque value in which the disturbance error is removed from the other-axis error-corrected torque value, based on the angle measurement value and the other-axis error-corrected torque. The force control unit 23 acquires a force command value from the command value generation unit 1, acquires the angle measurement value from the encoder 32, and acquires the disturbance-corrected torque value from the disturbance correction unit 22. The force control unit 23 calculates a force control amount, which is a control amount required for the robot arm 3 to operate in accordance with the force command value, based on the force command value, the angle measurement value, and the disturbance-corrected torque value.
[0021] The position control unit 24 acquires a position command value from the command value generation unit 1 and acquires an angle measurement value from the encoder 32. Based on the position command value and the angle measurement value, the position control unit 24 calculates a position control amount, which is a position control amount required for the robot arm 3 to operate according to the position command value. The adder 25 acquires a force control amount from the force control unit 23 and acquires a position control amount from the position control unit 24. The adder 25 combines (adds) the force control amount and the position control amount, and outputs the combined result to the drive control unit 26. The drive control unit 26 as a control unit acquires the combined result from the adder 25 and controls the motor 33 based on the combined result. For example, the drive control unit 26 outputs a current for driving the motor 33 based on the combined result acquired from the adder 25. Note that the drive control unit is not limited to one that outputs a current for driving the motor 33, and may be configured to output a control signal for controlling the motor to the motor.
[0022] Next, the hardware configuration of the robot control device 2 will be described with reference to Figs. 3 and 4. Fig. 3 is a block diagram showing an example of the hardware configuration of the robot control device 2 according to the first embodiment, and Fig. 4 is a block diagram showing an example of the hardware configuration of the robot control device 2 according to the first embodiment, which is different from that shown in Fig. 3. For example, as shown in Fig. 3, the robot control device 2 has a processor 2a, a memory 2b, and an I / O port 2c, and is configured so that the processor 2a reads and executes a program stored in the memory 2b. The memory 2b may be, for example, a non-volatile or volatile semiconductor memory such as a RAM, a ROM, a flash memory, an EPROM, or an EEPROM. The memory 2b may also be a magnetic disk, a flexible disk, an optical disk, a compact disk, a mini disk, a DVD, or the like. The memory 2b may also be an HDD or an SSD.
[0023] 4, the robot control device 2 has a processing circuit 2d, which is dedicated hardware, and an I / O port 2c. The processing circuit 2d is configured, for example, by a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, a system LSI (Large-Scale Integration), an ASIC (Application Specific Integrated Circuit), an FPGA (Field Programmable Gate Array), or a combination of these. Each function of the robot control device 2 is realized by the processor 2a or the processing circuit 2d, which is dedicated hardware, executing a program, which is software, firmware, or a combination of software and firmware.
[0024] Next, the configuration of the robot control device 2 according to the first embodiment will be described in detail with reference to Figs. 5 to 9. Fig. 5 is a block diagram showing the configuration of the other-axis error correction unit according to the first embodiment. As shown in Fig. 5, the other-axis error correction unit 21 has a other-axis force calculation unit 211, a other-axis error calculation unit 212, and a subtractor 213. The other-axis force calculation unit 211 as a command value acquisition unit acquires a force command value from the command value generation unit 1. In addition, the other-axis force calculation unit 211 acquires an angle measurement value, which is information related to the position of the end effector E1, from the encoder 32. In other words, the other-axis force calculation unit 211 as a position information acquisition unit acquires position information related to the position of the end effector E1 when the end effector E1 of the robot arm 3 is brought into contact with the workpiece W1.
[0025] The other-axis force calculation unit 211 calculates an estimate of the other-axis force based on the angle measurement value, the force command value, the robot kinematics model, and, if necessary, the robot dynamics model, the angular velocity measurement value calculated by differentially calculating the angle measurement value, and the angular acceleration measurement value. In the following description, the estimate of the other-axis force calculated by the other-axis force calculation unit 211 is also referred to as the other-axis force estimate value. The other-axis error calculation unit 212 calculates an estimate of the other-axis error based on the other-axis force estimate value. In other words, the other-axis error calculation unit 212 as an error estimator estimates the other-axis error, which is an error caused by the contact force in a state in which the end effector E1 and the workpiece W1 are in contact with each other, contained in the torque detected by the torque sensor 31, based on the position information acquired by the other-axis force calculation unit 211. In the following description, the estimate of the other-axis error calculated by the other-axis error calculation unit 212 is also referred to as the other-axis error estimate value.
[0026] The subtractor 213, which serves as a torque detection unit and correction unit, detects the torque acting on the joint J1 by acquiring a torque measurement value from the torque sensor 31. The subtractor 213 also subtracts the other-axis error estimated value from the acquired torque measurement value to calculate a other-axis error-corrected torque value, and outputs the calculated other-axis error-corrected torque value to the disturbance correction unit. In other words, the subtractor 213 corrects the torque measurement value acquired from the torque sensor 31 based on the error estimated by the other-axis error calculation unit 212.
[0027] 6 is a block diagram showing a configuration of the disturbance correction unit according to the first embodiment. As shown in FIG. 6, the disturbance correction unit 22 as an error estimation unit has a disturbance calculation unit 221 and a subtractor 222. The disturbance calculation unit 221 estimates (calculates) a disturbance estimation value based on the other-axis error-corrected torque value, the torque measurement value, known information on the offset disturbance, the robot dynamics model, the angle measurement value, and the angular velocity measurement value and the angular acceleration measurement value calculated by differentially calculating these values, as necessary. The subtractor 222 calculates a disturbance-corrected torque value by subtracting the disturbance estimation value from the other-axis error-corrected torque value, and outputs the calculated disturbance-corrected torque value to the force control unit 23.
[0028] FIG. 7 is a block diagram showing the configuration of the force control unit 23 according to the first embodiment. As shown in FIG. 7, the force control unit 23 as a contact force acquisition unit includes a force conversion unit 231, a force control amount calculation unit 232, and an angular velocity conversion unit 233. The force conversion unit 231 calculates an estimated value of the contact force that the robot arm 3 applies to the workpiece W1 based on the disturbance-corrected torque value, thereby acquiring the contact force. In the following description, the estimated value of the contact force calculated by the force conversion unit 231 is also referred to as a force estimated value. The force control amount calculation unit 232 performs a control calculation for making the force estimated value follow the force command value, and calculates a command value of a velocity related to the force point. In the following description, the command value of the velocity related to the force point calculated by the force control amount calculation unit 232 is also referred to as a velocity command value. The angular velocity conversion unit 233 calculates an angular velocity command value, which is a command value of the angular velocity between the links at the corresponding joint, based on the velocity command value and known geometric information of the robot arm 3. In other words, the angular velocity conversion unit 233 converts the velocity command value into an angular velocity command value. The angular velocity conversion unit 233 outputs the calculated angular velocity command value to the adder 25 as a force control amount.
[0029] FIG. 8 is a block diagram showing the configuration of the position control unit according to the first embodiment. As shown in FIG. 8, the position control unit 24 has a position conversion unit 241, a position control amount calculation unit 242, and an angular velocity conversion unit 243. The position conversion unit 241 calculates the position of the force point based on the angle measurement value. In the following description, the position of the force point calculated by the position conversion unit 241 is also referred to as a position measurement value. The position control amount calculation unit 242 performs a control calculation for making the position measurement value follow the position command value, and calculates a velocity command value that is a command value for the velocity of the force point. The angular velocity conversion unit 243 calculates an angular velocity command value based on the velocity command value. In other words, the angular velocity conversion unit 243 converts the velocity command value into the angular velocity command value. The angular velocity conversion unit 243 outputs the calculated angular velocity command value to the summing unit 25 as a position control amount. Addition unit 25 adds together the angular velocity command value as the force control amount output from force control unit 23 and the angular velocity command value as the position control amount output from the position control unit, into one angular velocity command value.
[0030] Fig. 9 is a block diagram showing a configuration of the drive control unit according to the first embodiment. As shown in Fig. 9, the drive control unit 26 has an angular velocity calculation unit 261 and an angular velocity control amount calculation unit 262. The angular velocity calculation unit 261 calculates an angular velocity measurement value based on an angle measurement value. For example, the angular velocity calculation unit 261 calculates an angular velocity measurement value by performing a differential calculation on the angle measurement value. The angular velocity control amount calculation unit 262 performs an angular velocity feedback control calculation based on the angular velocity command value output by the summing unit 25 and the angular velocity measurement value output by the angular velocity calculation unit 261, and outputs a current command value that is a command value of a current for driving the motor 33 as a calculation result.
[0031] Next, with reference to Figs. 10 to 14, the processing performed by the robot control device 2 according to the first embodiment will be described. Fig. 10 is a flowchart showing the processing performed by the robot control device 2 according to the first embodiment. Specifically, Fig. 10 is a flowchart showing a pressing control processing performed by the robot control device 2 according to the first embodiment, which controls the robot arm 3 to perform a pressing operation of pressing the end effector E1, which is the force point of the robot arm 3, against the workpiece W1. In the pressing control processing, the robot arm 3 is a six-axis vertical articulated robot, the force point is the end effector E1, which is the hand of the robot arm 3, and the work content of the pressing operation is a work of pressing the force point against the workpiece W1 with 10 N in the -Z direction (direction toward the ground) of the base coordinate system (the coordinate system to which the workpiece W1 and the base of the robot arm 3 are fixed) described in the robot program possessed by the command value generating unit 1. In addition, at the start of the pressing control processing, the force point is in a position sufficiently close to the workpiece W1, which is the pressing operation position, facing the -Z direction, and not in contact with the workpiece W1. In addition, in such a pressing operation, since the change in the position and posture of the robot arm 3 during the operation is small, the fluctuation in the torque measurement value caused by the mass of the robot arm 3 can be ignored. In the following description, the position of the force point at the start of the pressing control process is also referred to as the pressing start position.
[0032] In step ST1, the robot controller 2 calculates a disturbance estimation value in the disturbance calculation unit 221 of the disturbance correction unit 22. As described above, in this process, since the fluctuation in the torque measurement value caused by the mass of the robot arm 3 during work can be ignored, the calculation is performed assuming that the fluctuation in the torque measurement value occurs only due to the contact force. In addition, the robot controller 2 according to the first embodiment performs the pressing control process assuming that the disturbance estimation value is a constant value. For example, the robot controller 2 performs the pressing control process using the torque value after other-axis error correction in a state in which the robot arm 3 is stationary at the pressing start position as the disturbance estimation value. Note that in this state, since the robot arm 3 is not in contact with the workpiece W1, the torque value after other-axis error correction is the same value as the torque measurement value. The robot controller 2 can accurately grasp the amount of fluctuation in the torque measurement value caused by the contact force during the pressing operation by subtracting the disturbance estimation value from the torque measurement value. After performing the process of step ST1, the robot controller 2 starts the pressing operation by the robot arm 3 (step ST2).
[0033] In step ST3, the robot controller 2 calculates a torque value after other-axis error correction in the other-axis error correction unit 21. Fig. 11 is a flowchart showing the processing performed by the other-axis error correction unit 21 according to the first embodiment. As shown in Fig. 11, in step ST3-1, the robot controller 2 calculates an other-axis force estimation value for each torque sensor 31 in the other-axis force calculation unit 211 based on the following formula (1). TIFF2024164343000002.tif86166 Also, i is the joint number, with the joint closest to the base of the robot arm 3 being 1, and the numbers being 2, 3, 4, 5, and 6 as we move toward the end effector.
[0034] FIG. 12 is a conceptual diagram showing an example of the definition of the coordinate system of the torque sensor 31 according to the first embodiment. As shown in FIG. 12, the other-axis force calculation unit 211 calculates the other-axis force estimation value as a value in a coordinate system in which the center of the torque sensor 31 is the origin, the Z direction of the coordinate axis is the torque direction which is the rotation direction of the joint, and the X and Y directions are other-axis directions, i.e., directions other than the torque direction. In other words, the other-axis force calculation unit 211 calculates the other-axis force estimation value in the coordinate system, assuming that the translational forces in the X-, Y-, and Z-axis directions and the rotational forces around the X and Y-axes acting on the torque sensor 31 are the other-axis forces. In the following description, the coordinate system in which the other-axis force calculation unit 211 calculates the other-axis force estimation value is also referred to as a sensor coordinate system. In addition, it is assumed that the relative position of the sensor coordinate system with respect to the torque sensor 31 is fixed.
[0035] The other-axis force estimated value in the translational direction corresponds to the force command value in the translational direction in the sensor coordinate system. On the other hand, the other-axis force estimated value in the rotational direction is related to the force command value in the rotational direction in the sensor coordinate system, as well as the position of the force point in the sensor coordinate system and the result of cross product calculation of the force command value in the translational direction in the sensor coordinate system. Note that the definition of the sensor coordinate system when calculating the other-axis force estimated value is not limited to the above, and other definitions may be used. Also, although formula (1) is given as a value in the base coordinate system, it may also be given as a value in a coordinate system obtained by translating or rotating the base coordinate system.
[0036] The other axis force calculation unit 211 calculates the position of the torque sensor 31 required for calculating the formula (1) by forward kinematics calculation using the angle measurement values of the joints between the base of the robot arm and the torque sensor 31, based on the following formula (2). TIFF2024164343000003.tif12166Note that in formula (2), H i-1,i (θ i ), θ i , S i , h indicates the following values. H i-1,i (θ i): Homogeneous transformation matrix (4×4) from joint i-1 to i. *Joint 0 is the base of robot arm 3. θ i : Angle measurement value of joint i (1×1) S i : Homogeneous transformation matrix from joint i to sensor i (4×4) h: A function to extract the translation vector components of a homogeneous transformation matrix
[0037] The other axis force calculation unit 211 calculates the position of the force point required for calculating formula (1) by forward kinematics calculation using angle measurement values of the joints between the base of the robot arm 3 and the force point, as shown in the following formula (3). In the first embodiment, the force point is the end effector E1, which is the tip of the robot arm 3, and therefore the other axis force calculation unit 211 uses angle measurement values of all joints of the robot arm 3 in calculating the position of the force point. r con =h{H 0,1 (θ1) H i-1,i (θ i ) C i} ···(3) In addition, in formula (3), C i indicates the following value: C i : Homogeneous transformation matrix (4×4) from joint i to the force point on link i In addition, in the first embodiment, since the point of force is the hand tip, the value of i is 6. Note that the other axis force calculation unit may implement a calculation method other than the above as long as it can calculate the position of the point of force in the sensor coordinate system.
[0038] In step ST3-2, the other-axis error correction unit 21 calculates the other-axis error estimate value in the other-axis error calculation unit 212 based on the following formula (4). TIFF2024164343000004.tif20166Note that in formula (4), τ i err , s i,x ,s i,y ,s i,z,s i,a ,s i,b indicates the following value: τ i err : Other axis error estimate of sensor i s i,x ,s i,y ,s i,z ,s i,a ,s i,b : Estimated cross-axis sensitivity of sensor i
[0039] The other-axis error estimate is expressed, for example, as a weighted linear sum of the other-axis forces, and the other-axis sensitivity estimate, which corresponds to the weight, is a value obtained by estimating the other-axis sensitivity specific to the torque sensor 31. The other-axis sensitivity estimate may use a specification sheet value of the torque sensor 31, or may use a value estimated based on a response when the other-axis force is applied to the torque sensor 31 by some means. The other-axis error estimate may take a form other than the weighted linear sum. For example, the other-axis error estimate may be a nonlinear function related to the other-axis force, or may be a table lookup related to the other-axis force. In the following description, the other-axis error estimate calculated by the other-axis error calculation unit 212 using the other-axis force estimate caused by the contact force is also referred to as a contact-induced other-axis error estimate.
[0040] In step ST3-3, the other-axis error correction unit 21 subtracts the other-axis error estimated value from the torque measurement value in a subtractor to remove the other-axis error contained in the torque measurement value, calculates a torque value after other-axis error correction, and transmits it to the disturbance correction unit.
[0041] As shown in FIG. 10, in step ST4, the robot controller 2 causes the disturbance corrector 22 to subtract the disturbance estimated value calculated in step ST1 from the other-axis error-corrected torque value to calculate a disturbance-corrected torque value.
[0042] In step ST5, the robot control device 2 calculates, in force control unit 23, an angular velocity command value for making the force estimated value follow the force command value. FIG. 13 is a flowchart showing the processing performed by force control unit 23 according to the first embodiment. In step ST5-1, force control unit 23 acquires the force command value calculated by the command value generation unit in accordance with the contents of the robot program. In the first embodiment, the Z-axis translation direction is maintained at -10N, and the X- and Y-axis translation directions and the X-, Y-, and Z-axis rotation directions are maintained at 0N. In step ST5-2, force control unit 23 calculates, in force conversion unit 231, a force estimated value based on the following formula (5). F est =J -T τ est (5) In addition, in formula (5), F est , J and τ est indicates the following value: F est : Force estimate from the base coordinate system (6×1) J: Jacobian from each joint to the force point as seen from the base coordinate system (6x6) τ est : Torque value after disturbance correction (6 x 1)
[0043] In step ST5-3, force control unit 23 performs force proportional feedback control calculation based on the following formula (6) in force control amount calculation unit 232 to calculate a velocity command value for the force point. In the first embodiment, force control unit 23 sets the force gain in the Z-axis translation direction to a positive value that ensures the desired force control performance in accordance with the contents of the robot program, and maintains the force gain in other directions at 0 since no force control is performed in those directions. Note that the force control unit may be configured to perform force control in directions other than the Z-axis translation direction in order to improve the accuracy of correction. V F cmd =diag(K F )(F cmd -F cmp ) ···(6) In addition, in formula (6), VF cmd , K F , F cmd and diag indicate the following values: V F cmd : Speed command value seen from the base coordinate system (6×1) K F : Force proportional gain seen from the base coordinate system (6×1) F cmd : Force command value seen from the base coordinate system (6×1) diag: A function to convert a vector into a diagonal matrix
[0044] In step ST5-4, the force control unit 23 converts the velocity command value into an angular velocity command value in the angular velocity conversion unit based on the following formula (7). TIFF2024164343000005.tif33166
[0045] As shown in Fig. 10, in step ST6, the robot control device 2 calculates, in the position control unit 24, an angular velocity command value for making the position measurement value follow the position command value. Fig. 14 is a flowchart showing the processing performed by the position control unit 24 according to the first embodiment. As shown in Fig. 14, in step ST6-1, the position control unit 24 acquires the position command value generated in the command value generating unit according to the contents of the robot program. In the first embodiment, the position measurement value at the start of pressing is maintained.
[0046] In step ST6-2, position control unit 24 performs a forward kinematics calculation in position conversion unit 241 to calculate a position measurement value. In step ST6-3, position control unit 24 performs a position proportional feedback control calculation in position control amount calculation unit 242 based on the following formula (8) to calculate a velocity command value for the point of effort. In embodiment 1, position control unit 24 maintains the position gain in the translation Z direction as 0 since no position control is performed, and maintains positive values in other directions that can ensure the desired position control performance, in accordance with the contents of the robot program. VP cmd =diag(K P )(P cmd -P mes ) ···(8) In addition, in formula (8), V P cmd , K P , P cmd and P mes indicates the following value: V P cmd : Speed command value seen from the base coordinate system (6×1) K P : Position proportional gain seen from the base coordinate system (6×1) P cmd : Position command value as seen from the base coordinate system (6×1) P mes : Position measurement value seen from the base coordinate system (6×1) It should be noted that the position difference value in the rotational direction is a difference value of the Euler angles and is not a simple subtraction.
[0047] In step ST6-4, the position control unit 24 converts the velocity command value into an angular velocity command value in the angular velocity conversion unit 243 based on the following equation (9). TIFF2024164343000006.tif39166
[0048] 10, in step ST7, the robot control device 2 calculates the sum of the angular velocity command values calculated by the force control unit 23 and the position control unit 24 in the adder unit 25, and transmits the sum to the drive control unit 26. In step ST8, the drive control unit 26 first calculates an angular velocity measurement value by differentiating the angle measurement value in the angular velocity calculation unit 261. Next, the drive control unit 26 performs an angular velocity proportional integral feedback control calculation in the angular velocity control amount calculation unit 262 based on the following formula (10), and calculates a current command value for the motor. TIFF2024164343000007.tif68166
[0049] In step ST9, the robot control device 2 operates the motor 33 according to the current command value, thereby performing a pressing operation by the robot arm 3. In the pressing operation process shown in Fig. 10, the robot control device 2 performs the process of step ST1 only once before the pressing operation, and performs the processes of steps ST2 to ST9 for each control cycle of the robot arm 3 during the pressing operation.
[0050] As described above, the robot control system 1A according to the first embodiment includes a subtractor 213 that detects the torque acting on the joint J1 of the robot arm 3, a other-axis force calculation unit 211 that acquires position information on the position of the end effector E1 when a specific portion of the robot arm is brought into contact with an object and a command value of the contact force when the specific portion of the robot arm is brought into contact with an object, a other-axis error calculation unit 212 that estimates an error caused by the contact force, included in the torque detected by the subtractor 213, based on the position information acquired by the other-axis force calculation unit 211 and the command value acquired by the command value acquisition unit, and a drive control unit 26 that controls the robot arm 3 so that the end effector E1 contacts the workpiece W1, based on the torque detected by the subtractor 213 and the error estimated by the other-axis error calculation unit 212. With this configuration, the robot control system 1A estimates the other axis error of the torque caused by the force that the robot arm 3 receives from the workpiece W1 based on the contact force command value when the end effector E1 of the robot arm 3 contacts the workpiece W1, and controls the robot arm 3 based on the estimation result, so that it is possible to correct the other axis error that occurs in the torque detection result due to the force that the robot arm 3 receives from the workpiece W1. This makes it possible for the robot control system 1A to control the operation of the robot arm 3 with higher accuracy than ever before.
[0051] Furthermore, the robot control system 1A performs force control of the robot arm 3 using a value obtained by removing other-axis errors resulting from the contact force between the robot arm 3 and the workpiece W1 from the torque measurement value, so the robot arm 3 can apply an accurate force to the workpiece W1, which is the target of the operation. As a result, for example, the robot control system 1A can improve the machining quality when the robot arm 3 machines the workpiece W1.
[0052] Generally, in force work, the force command value (10 N in the -Z direction of the base coordinate system in this embodiment) and the point of force (the tip of the robot arm in this embodiment) are determined as in the first embodiment. If the actual contact force occurs according to the force command value, it is possible to calculate the other-axis force applied to each torque sensor using the force command value and the position of the force point in the sensor coordinate system, as shown in formula (1). Then, using the relationship between the other-axis force and the other-axis error found in advance, it is possible to correct the torque measurement value, as shown in formula (4).
[0053] If there is a difference between the actual contact force and the force command value, the calculated other-axis force will also differ from the actual value, resulting in a compensation error; however, if force control based on the compensated torque measurement value is simultaneously executed in a state where the relationship between the other-axis force and the other-axis error is accurately determined, the difference between the actual contact force and the force command value will gradually decrease due to the control, and the compensation error will also decrease. Then, in the final steady state, the actual contact force and the force command value will match, and it is expected that the compensation error will be sufficiently small. Compensation errors remain in the transient state of control, but since the transient state is a state in which the actual contact force is in the process of approaching the force command value and there is a difference between the actual contact force and the force command value, the compensation error here does not pose a major problem.
[0054] In the first embodiment, the other-axis error correction unit corrects the other-axis error first, and then the disturbance correction unit corrects it. This order of correction is preferable, but the order of processing of the other-axis error correction unit and the disturbance correction unit can be reversed. However, care must be taken not to correct the other-axis error twice. If the order is simply reversed, the disturbance correction unit cannot take the other-axis error estimated value into consideration when calculating the disturbance estimated value (step ST1), and the disturbance estimated value includes the other-axis error estimated value at the time of estimation. In order to avoid this, for example, the disturbance correction unit may have a function of holding the previous other-axis error estimated value or the torque value after the other-axis error correction. In addition, a mechanism for removing the double correction amount from the torque value after the other-axis error correction may be provided.
[0055] In addition, in the first embodiment, the force control unit and the position control unit calculate the angular velocity command value, and the drive control unit controls each joint according to the angular velocity command value obtained by adding them up. However, the present invention is not limited to this. The position control unit may calculate a position command value, the force control unit may calculate a position command correction value, and the drive control unit may control each joint according to the corrected position command value obtained by adding them up. In addition, the drive control unit may receive and control current or torque command values.
[0056] In addition, in embodiment 1, the point of force is the end effector E1, which is the tip of the robot arm 3, but it may be a part of the robot arm other than the tip, it may be detected by a pressure sensor or the like installed on the robot arm, or it may be measured by a camera or the like installed around the robot or on the robot.
[0057] In addition, in the first embodiment, it is assumed that all joints are equipped with torque sensors. However, even if at least one joint is equipped with a torque sensor, other axis error correction caused by contact force can be performed using a similar procedure.
[0058] In addition, although the first embodiment is based on the premise that torque detection is performed using a torque sensor, detection may be performed by other means. For example, torque detection may be performed using measurement values of encoders provided on the input and output sides of the reducer, or a torque observer using angle measurement values or motor current measurement values may be used.
[0059] In addition, in the first embodiment, it is assumed that the angle measurement values of all joints are used, but there are cases where the angle measurement values of some joints are sufficient. For example, when a force command value is given in a coordinate system that does not depend on joint angles, such as a base coordinate system, it is sufficient to use the angle measurement values of the joints passing from the base of the robot arm to the force point. Note that, since the other-axis force caused by the contact force is not applied to the joints on the hand side of the robot arm 3 from the force point, the other-axis force estimated value may be considered to be 0. On the other hand, when a force command value is given in a coordinate system that depends on joint angles, such as a tool coordinate system (a coordinate system fixed to the hand of the robot arm 3), it is sufficient to use the angle measurement values of the joints passing at least one of the paths from the sensor to the force point and the path from the sensor to the coordinate system.
[0060] Embodiment 2 Next, a robot control system according to embodiment 2 will be described. The robot control system according to embodiment 2 differs from the robot control system 1A according to embodiment 1 in the configuration related to the processing performed by the other axis error correction unit, but other configurations are similar to the robot control system 1A according to embodiment 1. Therefore, the same names or symbols are used for the same configurations as the robot control system 1A according to embodiment 1, and the description thereof will be omitted.
[0061] In the first embodiment, the other-axis error correction unit 21 of the robot control device 2 corrects the other-axis error caused by the contact force. Moreover, the disturbance correction unit 22 corrects the disturbance estimated value as a constant value. However, in this method, in the case of a task of moving the hand of the robot arm 3, the other-axis error may vary because the other-axis force caused by the mass of the robot arm changes according to the movement of the hand of the robot arm 3, and there is a problem that the correction performance by the other-axis error correction unit 21 decreases. For this reason, it becomes difficult for the robot arm to apply an accurate force to the work target. Therefore, the other-axis error correction unit of the robot control device according to the second embodiment corrects the other-axis error caused by the mass of the robot arm in addition to the other-axis error caused by the contact force. Moreover, the disturbance correction unit of the robot control device according to the second embodiment also performs correction regarding the torque caused by the robot mass in addition to the constant value.
[0062] The difference from the first embodiment in terms of the other-axis error correction unit will be described below. The other-axis error correction unit according to the second embodiment considers a component caused by the robot mass in addition to a component caused by the contact force when calculating the other-axis force estimate, in order to suppress a measurement value fluctuation caused by the other-axis force caused by the robot mass applied to the torque sensor. Specifically, the other-axis error correction unit according to the second embodiment calculates the other-axis force estimate as the x, y, z, a, and b components of the following formula (11). TIFF2024164343000008.tif52166
[0063] The translational force and rotational force (derived from gravity, inertial force, and centrifugal force) due to the mass of the robot arm 3 applied to the torque sensor in the base coordinate system, which are included in equation (11), can be calculated using, for example, the Recursive Newton Euler Method, which is a known technique described in Non-Patent Document 1.
[0064] [Non-Patent Document 1] Armstrong WW, 1979. Recursive solution to the equation of motion of an N-links manipulator. In Proc. 5th World Congress on Theory of Machines and Mechanisms, p. 1343-1346.
[0065] In the above calculation, the other-axis error correction unit according to the second embodiment uses a dynamics model of the robot, angle measurement values, and angular velocity measurement values and angular acceleration measurement values obtained by differentiating the angle measurement values. If only correction related to the other-axis force caused by gravity is required, the angular velocity measurement values and angular acceleration measurement values are not required. Generally, during force work, the robot operates at low speed and low acceleration, so that there are cases where only correction related to gravity is sufficient.
[0066] The robot control system according to the second embodiment calculates the other-axis error-corrected torque value using the other-axis force estimated value calculated by the above formula (11), thereby reducing the influence of the other-axis error fluctuations caused by the movement of the tip of the robot arm 3, which are included in the disturbance-corrected torque value, and can calculate the measurement value caused by the contact force with high accuracy. Note that the other-axis error estimated value calculated using the other-axis force estimated value caused by the mass of the robot arm is also called the mass-induced other-axis error estimated value.
[0067] Moreover, in order to suppress fluctuations in the measurement value due to torque caused by the mass of the robot arm applied to the torque sensor, the disturbance correction unit according to the second embodiment adds a constant value to the c component of equation (11) as the calculation result of the disturbance estimate value. This constant value is, for example, a value obtained by subtracting the c component from the other-axis error-corrected torque value in a state in which the robot arm is stationary at the pressing start position. The robot control system according to the second embodiment calculates the disturbance-corrected torque value using this disturbance estimate value, thereby reducing the influence of torque fluctuations caused by the movement of the hand of the robot arm, which are included in the disturbance-corrected torque value, and can accurately calculate the measurement value caused by the contact force.
[0068] As described above, the robot control system according to embodiment 2 performs force control using a value obtained by removing from the torque measurement value other-axis error caused by contact force and other-axis error caused by the mass of the robot arm. Therefore, even in the case of a task in which the posture of the robot arm changes significantly during the task (for example, a task of chamfering a metal plate by following the edge of a cutter attached to the end of the robot arm), the robot arm can apply an accurate force to the work object, thereby improving the processing quality.
[0069] In addition, the present disclosure allows free combinations of the respective embodiments, or modifications of any of the components of the respective embodiments, or omission of any of the components of the respective embodiments. [Explanation of symbols]
[0070] 1: Command value generator 1A: Robot control system 2: Robot control device 3: Robot arm 21: Other axis error correction section 22: Disturbance correction section (error estimation section) 23: Force control section 24: Position control section 25: Addition section 26: Drive control unit (control unit) 31: Torque sensor 32: Encoder 33: Motor 211: Other axis force calculation unit (position information acquisition unit, command value acquisition unit) 212: Other axis error calculation unit (error estimation unit) 213: Subtractor (torque detection unit, correction unit) 221: Disturbance calculation section 222: Subtractor 231: Force conversion section 232: Force control amount calculation unit 233: Angular velocity conversion section 241 :Position substitution calculation part 242: Position control amount calculation unit 243: Angular velocity conversion section 261: Angular velocity calculation section 262: Angular velocity control amount calculation unit E1: End effector J1: Joint L1, L2: Link W1: Work Z: translation
Claims
1. a torque detection unit that detects a torque acting on a joint of the robot arm; a position information acquiring unit that acquires position information regarding a position of a specific portion of the robot arm when the specific portion is brought into contact with an object; a command value acquisition unit that acquires a command value of a contact force when the specific portion is brought into contact with the object; an error estimating unit that estimates a other axis error caused by a contact force in a state in which the specific portion and the object are in contact with each other, the other axis error being included in the torque detected by the torque detecting unit, based on the position information acquired by the position information acquiring unit and the command value acquired by the command value acquiring unit; a control unit that controls the robot arm so that the specific portion comes into contact with the object based on the torque detected by the torque detection unit and the other axis error estimated by the error estimating unit. A robot control device comprising:
2. a correction unit that obtains a corrected torque by subtracting the other axis error estimated by the error estimator from the torque detected by the torque detector, The control unit controls the robot arm so that the specific portion comes into contact with the object based on the corrected torque acquired by the correction unit.
2. The robot control device according to claim 1.
3. The error estimating unit estimates a different axis error caused by at least one of gravity and inertia force of the robot arm, the different axis error being included in the torque detected by the torque detecting unit.
2. The robot control device according to claim 1.
4. The error estimation unit estimates a different axis error caused by at least one of gravity and inertia force of the robot arm based on a dynamic model of the robot arm and at least one of an angle measurement value, an angular velocity measurement value, and an angular acceleration measurement value.
4. The robot control device according to claim 3.
5. A robot control device according to any one of claims 1 to 4, The robot arm and A robot control system comprising:
6. A robot control method performed by an apparatus including a torque detection unit, a position information acquisition unit, a command value acquisition unit, an error estimation unit, and a control unit, comprising: The torque detection unit detects a torque acting on a joint of a robot arm; a step of acquiring position information regarding a position of a specific portion of the robot arm when the specific portion is brought into contact with an object by the position information acquisition unit; a step of acquiring a command value of a contact force when the specific portion is brought into contact with the object by the command value acquisition unit; a step in which the error estimating unit estimates a other-axis error caused by a contact force in a state in which the specific portion is in contact with the object, the other-axis error being included in the torque detected by the torque detection unit, based on the position information acquired by the position information acquiring unit and the command value acquired by the command value acquiring unit; and controlling the robot arm so that the specific portion comes into contact with the object based on the torque detected by the torque detection unit and the other axis error estimated by the error estimation unit. A robot control method comprising:
Citation Information
Patent Citations
Robot
JP2020037172A
