External force estimation device, external force estimation method, and external force estimation program
The external force estimation device improves motor control accuracy by calculating torque and correcting for temperature-induced friction torque fluctuations, reducing estimation errors and enabling smooth load operation.
Patent Information
- Application Number
- JP2021107631
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-06-29
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-06-29
AI Technical Summary
Existing methods for estimating external forces on motors, such as those using motor temperature information, struggle to accurately account for fluctuations in friction torque due to temperature changes, leading to errors in external force estimation.
An external force estimation device and method that calculates output torque, estimates inertia and friction torque using rotational position information, and performs temperature correction on friction torque to improve accuracy.
Reduces errors in estimated external forces by correcting for friction torque fluctuations, enhancing the accuracy of motor control and enabling smooth operation of loads.
Smart Images

Figure 0007589654000003 
Figure 0007589654000004 
Figure 0007589654000005
Abstract
Description
[Technical field]
[0001] The present invention relates to an external force estimation device, an external force estimation method, and an external force estimation program. [Background technology]
[0002] In a feedback control system, a disturbance observer is used to suppress the effect of disturbances and stabilize the control system. For example, Patent Document 1 discloses a disturbance observer that calculates a torque constant based on temperature information of a motor and estimates friction torque and inertia torque due to Coulomb friction and viscous resistance based on position information of the motor to estimate disturbances. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2020-035394 A Summary of the Invention [Problem to be solved by the invention]
[0004] In order to operate a load smoothly using a motor, it is necessary to improve the accuracy of motor control. To achieve this, it is necessary to accurately estimate the external force acting on the motor. In addition, for adaptive and soft control according to the external force, it is also necessary to accurately estimate the external force acting on the motor. However, since the value of friction torque due to Coulomb friction, viscous friction, etc. varies depending on temperature, it is difficult to accurately estimate the external force using the method of Patent Document 1, which uses temperature information only to calculate the torque constant.
[0005] The present invention has been made to solve such problems, and has an object to provide an external force estimation device, an external force estimation method, and an external force estimation program that are capable of reducing errors in estimated external forces. [Means for solving the problem]
[0006] An external force estimation device according to one aspect of the present invention comprises: An external force estimation device that estimates an external force acting on a motor, comprising: a torque calculation unit that calculates an output torque of the motor using a current value supplied to the motor; an inertia torque estimating unit that estimates an inertia torque of the motor by using rotational position information of the motor; a friction torque estimating unit that estimates a friction torque of the motor by using rotational position information of the motor; a temperature correction unit that performs temperature correction on the friction torque by using temperature information of the motor; The torque calculator further includes an external force estimator that estimates the external force by subtracting the inertia torque and the temperature-corrected friction torque from the output torque calculated by the torque calculator.
[0007] An external force estimation method according to one aspect of the present invention includes the steps of: An external force estimation method for estimating an external force acting on a motor, comprising: Calculating an output torque of the motor using a current value supplied to the motor; estimating an inertia torque of the motor and a friction torque of the motor using rotational position information of the motor; performing temperature correction on the estimated friction torque using temperature information of the motor; The external force is estimated by subtracting the inertia torque and the temperature-corrected friction torque from the calculated output torque.
[0008] An external force estimation program according to one aspect of the present invention includes: An external force estimation program for estimating an external force acting on a motor, comprising: Calculating an output torque of the motor using a current value supplied to the motor; estimating an inertia torque of the motor and a friction torque of the motor using rotational position information of the motor; performing temperature correction on the estimated friction torque using temperature information of the motor; The external force is estimated by subtracting the inertia torque and the temperature-corrected friction torque from the calculated output torque. This is an external force estimation program for causing a computer to execute the process.
[0009] The external force estimation device according to one aspect of the present invention performs temperature correction on the friction torque by using temperature information of the motor. As a result, the external force estimation device according to one aspect of the present invention can correct the fluctuation in friction torque caused by temperature changes and reduce errors in the estimated external force. Effect of the Invention
[0010] According to the present invention, it is possible to provide an external force estimation device, an external force estimation method, and an external force estimation program capable of reducing an error in an estimated external force. [Brief description of the drawings]
[0011] [Figure 1] FIG. 2 is a schematic diagram showing the configuration of a motor and a load according to the first embodiment. [Diagram 2] FIG. 2 is a diagram illustrating an example of an overall configuration of a control system according to the first embodiment. [Diagram 3] FIG. 2 is a diagram illustrating an example of an overall configuration of a control system according to the first embodiment. [Figure 4] 1 is a diagram illustrating a configuration of an external force estimation device according to a first embodiment. [Diagram 5] 4 is a flowchart showing the operation of the external force estimation device according to the first embodiment. [Figure 6] FIG. 11 is a schematic diagram showing the configuration of a motor and a load according to a second embodiment. [Figure 7] FIG. 11 is a diagram illustrating a configuration of an external force estimation device according to a second embodiment. [Figure 8] 10 is a flowchart showing the operation of the external force estimation device according to the second embodiment. [Figure 9] FIG. 2 is a diagram illustrating an example of a hardware configuration of a control unit according to the first and second embodiments. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] Hereinafter, specific embodiments to which the present invention is applied will be described in detail with reference to the drawings. However, the present invention is not limited to the following embodiments. In addition, the following description and drawings are appropriately simplified for clarity of explanation. Note that the right-handed xyz Cartesian coordinate system shown in FIG. 1 and FIG. 6 is for convenience in explaining the positional relationship of each component. Usually, the positive direction of the z axis is vertically upward, and the xy plane is a horizontal plane.
[0013] <First embodiment> FIG. 1 is a schematic diagram showing a configuration of a motor and a load according to a first embodiment. The configuration of a motor and a load is used, for example, in a joint of a robot. In FIG. 1, a motor 1 is connected to a load 3 via a gear 2. The motor 1 can operate the load 3 via the gear 2. The motor 1 is also provided on a fixed portion 4.
[0014] The load 3 and the fixed part 4 are, for example, frames constituting the arms and legs of a robot. The load 3 is, for example, a frame provided on the tip side of the robot, and the fixed part 4 is, for example, a frame connected to the main body side of the robot. The motor 1 operates under the control of a control part 21 of a control unit 20, which will be described later. The motor 1 is, for example, a servo motor.
[0015] The rotational motion of the motor 1 is transmitted to a load 3 via a gear 2. For simplicity, the following description will be given assuming that the position of the fixed part 4 is fixed. Note that the position of the fixed part 4 may be changed in accordance with the operation of the robot.
[0016] The load 3 rotates on the yz plane. When the rotation direction of the motor 1 is changed, the movement direction (rotation direction) of the load 3 is changed. In addition, by changing the number and size of the gears 2, the load 3 can be operated in any direction and at any rotation speed (angular velocity). The movement speed of the load 3 changes depending on the rotation speed of the motor 1. Specifically, as the rotation speed of the motor 1 increases, the movement speed of the load 3 also increases. Similarly, as the rotation speed of the motor 1 decreases, the movement speed of the load 3 also decreases.
[0017] FIG. 2 is a diagram showing the overall configuration of a control system 100 according to the first embodiment. The control system 100 shown in FIG. 2 is used to control the motor 1. The control system 100 has a command section 10 and a control unit 20. The command section 10 and the control unit 20 are, for example, computer devices. Note that each process related to the command section 10 and the control unit 20 may be executed by a different computer device. As described in FIG. 1, the motor 1 operates the load 3 via the gear 2. The motor 1 is provided with a current detection section 11, a position detection section 12, and a temperature detection section 13. Note that the control system 100 may have other components necessary for operation.
[0018] The command unit 10 issues a command to the control unit 20 to control the motor 1. The control unit 20 controls the motor 1 based on the command from the command unit 10. There may be multiple control units 20, and each may be provided at each joint of the robot's arms, legs, etc., for example. That is, a control unit 20 may be provided for each motor that operates each joint. In this case, the command unit 10 can control the operation of each of the robot's multiple joints by issuing commands to the multiple control units 20 to control the motors.
[0019] The control unit 20 has a control unit 21 and an external force estimation device 22. The control unit 21 controls the motor 1 based on a command to control the motor 1 from the command unit 10. The external force estimation device 22 is a device that estimates an external force acting on the motor. The control unit 21 and the external force estimation device 22 are, for example, computer devices. Note that each process related to the control unit 21 and the external force estimation device 22 may be executed by a separate computer device.
[0020] The external force estimation device 22 is connected to the current detection unit 11, the position detection unit 12, and the temperature detection unit 13. The external force estimation device 22 estimates an external force acting on the motor 1 using a current value of the motor 1 acquired from the current detection unit 11, rotational position information of the motor 1 acquired from the position detection unit 12, and temperature information of the motor 1 acquired from the temperature detection unit 13. Here, the external force refers to a force (reaction force) related to the load 3, and acts on the motor 1 via the load 3. The external force estimation device 22 outputs the estimated external force to the command unit 10. When a plurality of control units 20 are provided, the plurality of external force estimation devices 22 output the external forces estimated by each of them to the command unit 10. A detailed configuration of the external force estimation device 22 will be described later.
[0021] The current detection unit 11 is a device that detects the value of a current supplied to the motor 1. The current detection unit 11 is, for example, a current sensor. The current detection unit 11 can be provided at any position where the current of the motor 1 can be detected. The current value acquired by the current detection unit 11 is input to the external force estimation device 22.
[0022] The position detection unit 12 is a device that detects the rotational position of the motor 1. The position detection unit 12 is, for example, an encoder provided in the motor 1. From the rotational position information of the motor 1, the angular velocity of the motor 1, the angular acceleration of the motor 1, and the rotational angle of the motor 1 can be calculated. The rotational position information acquired by the position detection unit 12 is input to the external force estimation device 22.
[0023] The temperature detection unit 13 is a device that detects the temperature of the motor 1. The temperature detection unit 13 is, for example, a temperature sensor. The temperature detection unit 13 can be provided at any position where the temperature of the motor 1 can be detected. Temperature information acquired by the temperature detection unit 13 is input to the external force estimation device 22.
[0024] The command unit 10 controls the motor 1 via the control unit 21 using the external force estimated by the external force estimation device 22. This allows the command unit 10 to improve the accuracy of motor control and to operate the load 3 smoothly. For example, the command unit 10 can realize smooth movement of the load 3 by operating the load 3 in a direction that cancels the effect of the external force using the direction of the external force estimated by the external force estimation device 22. In addition, the command unit 10 can realize adaptive soft movement of the load 3 according to the external force by increasing the moving speed or moving acceleration of the load 3 in the direction of the external force based on the magnitude of the external force estimated by the external force estimation device 22. The command unit 10 can also control multiple motors so that the entire load moves smoothly by using multiple external forces estimated by multiple external force estimation devices 22 provided in multiple control units 20.
[0025] 3, the external force estimation device 22 may output the estimated external force to the control unit 21. The control unit 21 may acquire the external force estimated by the external force estimation device 22, and based on a command from the command unit 10, may operate the load 3 in a direction that cancels the effect of the external force using the direction of the acquired external force, thereby realizing a smooth movement of the load 3. Furthermore, the control unit 21 may increase the moving speed or moving acceleration of the load 3 in the direction of the external force based on the magnitude of the external force acquired from the external force estimation device 22, thereby realizing an adaptive and soft movement of the load 3 according to the external force. Furthermore, the external force estimation device 22 may be configured to output the estimated external force to both the command unit 10 and the control unit 21.
[0026] <Configuration of the external force estimation device> 4 is a block diagram showing the configuration of the external force estimation device 22 according to the first embodiment. The external force estimation device 22 includes a torque calculation unit 23, an inertia torque estimation unit 24, a friction torque estimation unit 25, a temperature correction unit 26, and an external force estimation unit 27. Note that the external force estimation device 22 may include other components necessary for operation.
[0027] The torque calculation unit 23 calculates the output torque of the motor 1 by using the value of the current supplied to the motor 1. The torque calculation unit 23 acquires the value of the current detected by the current detection unit 11, and calculates the output torque of the motor 1 by obtaining the product of the current value and the torque constant of the motor 1.
[0028] The inertia torque estimation unit 24 estimates the inertia torque of the motor 1 using the rotational position information of the motor 1. Specifically, the inertia torque estimation unit 24 derives the angular acceleration of the motor 1 from the rotational position information of the motor 1, and estimates the inertia torque by calculating the product of the angular acceleration and the moment of inertia of the motor 1. Note that the moment of inertia can be calculated by measuring the output torque of the motor 1 when the motor 1 is rotating at a constant angular acceleration for a plurality of angular accelerations, and deriving the proportional relationship between the angular acceleration and the output torque. Alternatively, the moment of inertia may be calculated using a value calculated from a design drawing of the load.
[0029] The inertia torque estimation unit 24 may use the result of the inverse dynamics calculation to estimate the inertia torque of the motor 1. The inverse dynamics calculation is a method of calculating the torque required to operate a load from the angular velocity and angular acceleration.
[0030] The friction torque estimation unit 25 estimates the friction torque of the motor 1 using the rotational position information of the motor 1. The following describes a method of estimating the friction torque. First, when the angular velocity of the motor 1 is constant, the motor output torque and the friction torque are equal if no external force is applied. In addition, the friction torque varies depending on the rotational speed of the motor 1. Therefore, the motor output torque at a predetermined rotational speed of the motor 1, that is, the friction torque, can be derived by calculating the average value of the current value for one rotation of the load 3 rotated at a constant speed and multiplying the current value by a torque constant. By acquiring the current value while changing the rotational speed of the motor 1, a friction torque value according to the speed change can be obtained. The friction torque estimation unit 25 can estimate the friction torque at the rotational speed of the motor 1 based on the rotational speed calculated from the rotational position information of the motor 1 and the correspondence relationship between the rotational speed of the motor 1 and the friction torque derived in advance.
[0031] The friction torque may include at least one of Coulomb friction torque and viscous friction torque. The friction torque estimation unit 25 can estimate the Coulomb friction torque and the viscous friction torque using the angular velocity calculated from the rotational position information of the motor 1. Specifically, the friction torque estimation unit 25 can derive the Coulomb friction torque and the viscous friction coefficient from two steady states, and multiply the viscous friction coefficient by the angular velocity of the target motor 1 to derive the Coulomb friction torque and the viscous friction torque, respectively. Here, the steady state refers to a state in which the angular velocity of the motor 1 is constant.
[0032] The temperature correction unit 26 performs temperature correction on the friction torque using temperature information of the motor 1. The temperature correction unit 26 derives a correspondence relationship between a predetermined temperature and the friction torque. The temperature correction unit 26 performs temperature correction on the friction torque estimated by the friction torque estimation unit 25 using the correspondence relationship and the temperature indicated by the temperature information acquired by the temperature detection unit 13.
[0033] For example, the motor 1 is rotated at a first rotation speed under no load, and the current value is measured while changing the temperature, thereby deriving the correspondence relationship between the current value at the first rotation speed and the temperature change. Next, the motor 1 is rotated at a second rotation speed different from the first rotation speed, and the current value is measured while changing the temperature, thereby deriving the correspondence relationship between the current value at the second rotation speed and the temperature change.
[0034] Since two points, the relationship between the first rotation speed and the current value and the relationship between the second rotation speed and the current value, are obtained at a predetermined temperature, the corresponding relationship between the rotation speed and the current value of the motor 1 at the predetermined temperature can be obtained using these two points. Here, the friction torque estimation unit 25 can estimate the friction torque before temperature correction from the rotation speed of the motor 1. Also, the product of the current value at the predetermined temperature and the torque constant of the motor 1 is the value of the friction torque taking into account the temperature change.
[0035] From the above, the temperature correction unit 26 can perform temperature correction using the following equation, which is a linear approximation of the relationship between the friction torque before temperature correction at a predetermined temperature and the friction torque after temperature correction.
[0036] [Number 1] y=ax+b y: Friction torque after temperature correction x: Friction torque before temperature compensation a: coefficient at a given temperature b: coefficient at a given temperature
[0037] For example, when the temperature detected by the temperature detection unit 13 is a first temperature, the temperature correction unit 26 can estimate the friction torque after temperature correction by substituting the friction torque before temperature correction estimated by the friction torque estimation unit 25 for x in the equation y=a1x+b1 (a1 and b1 are coefficients at the first temperature) at the first temperature.
[0038] Similarly, when the temperature detected by the temperature detection unit 13 is the second temperature, the temperature correction unit 26 can estimate the friction torque after temperature correction by substituting the friction torque before temperature correction estimated by the friction torque estimation unit 25 into x for the correspondence relationship y=a2x+b2 (a2 and b2 are coefficients at the second temperature) at the second temperature. Even at temperatures other than the first temperature and the second temperature, the coefficient can be obtained, for example, by polynomial interpolation from the correspondence relationship between the current value measured while changing the temperature as described above and the temperature change. Note that the temperature correction unit 26 described so far corrects the friction torque by temperature, but the effect of the temperature correction may be included in the friction torque estimation unit 25 to calculate and use the friction torque that changes with temperature. This is because when the friction torque is expressed as Coulomb friction torque and viscous friction torque, the Coulomb friction and the viscosity coefficient change with temperature.
[0039] In this manner, the temperature correction unit 26 can use the temperature information acquired by the temperature detection unit 13 to perform temperature correction of the friction torque.
[0040] The external force estimation unit 27 estimates the external force by subtracting the inertia torque and the temperature-corrected friction torque from the output torque calculated by the torque calculation unit 23. The external force estimation unit 27 outputs the estimated external force to the command unit 10.
[0041] As described above, the external force estimation device 22 according to the first embodiment can correct the fluctuation in friction torque due to temperature change and can reduce the error in the estimated external force. According to the external force estimation device 22 according to the first embodiment, the accuracy of motor control can be improved.
[0042] 2, an external force estimation device 22 according to the first embodiment outputs an estimated external force to a command section 10 that is higher in level than a control section 21. The command section 10 can control the motor 1 via a control unit 20 in accordance with the direction and magnitude of the external force, and can operate the load 3 smoothly.
[0043] In addition, when the acceleration of the load 3 operates close to zero and when the inertia of the load 3 is sufficiently small, the influence of the inertia torque becomes extremely small, so the external force estimation unit 27 may estimate the external force by setting the value of the inertia torque to zero.
[0044] <External force estimation method> The external force estimation method according to the first embodiment will be described with reference to Fig. 5. Fig. 5 is a flowchart showing the operation of the external force estimation device 22 according to the first embodiment.
[0045] The torque calculation unit 23 calculates the output torque of the motor 1 using the current value of the motor 1 acquired by the current detection unit 11 (step S1). The inertia torque estimation unit 24 estimates the inertia torque of the motor 1 using the rotational position information of the motor 1 acquired by the position detection unit 12 (step S2). As described above, the inertia torque estimation unit 24 may estimate the inertia torque of the motor 1 using the inverse dynamics calculation result. This makes it possible to take into account the effects of gravity, centrifugal force, and Coriolis force, further improving accuracy.
[0046] The friction torque estimation unit 25 estimates the friction torque from the rotational position information acquired from the position detection unit 12 (step S3). The temperature correction unit 26 performs temperature correction on the friction torque estimated by the friction torque estimation unit 25 using the temperature information acquired by the temperature detection unit 13 (step S4). The temperature correction can be performed by the method described above.
[0047] The external force estimation unit 27 estimates the external force by subtracting the inertia torque estimated by the inertia torque estimation unit 24 and the temperature-corrected friction torque from the output torque calculated by the torque calculation unit 23 (step S5). After that, the external force estimation unit 27 outputs the estimated external force to the command unit 10. Note that the order of steps S1 to S3 is not limited to this, and any order can be used.
[0048] As described above, the external force estimation device 22 according to the first embodiment can correct the fluctuation in friction torque due to temperature change and reduce the error in the estimated external force. The external force estimation device 22 according to the first embodiment can improve the accuracy of motor control and can operate the load smoothly.
[0049] <Second embodiment> Fig. 6 is a schematic diagram showing the configuration of a motor and a load according to the second embodiment. The gear configuration is shown in more detail than in Fig. 1. The motor 1 operates the load 3 via a gear 5 and a gear 6. Note that, for simplicity of explanation, the number of gears is two in Fig. 6, but any number and size of gears 5 and gears 6 may be provided.
[0050] The rotation angle Θ1 of the motor 1 is the angle in the rotation direction of the motor 1. The rotation angle Θ2 of the load 3 is the angle in the rotation direction of the load 3. The rotation angle Θ1 of the motor 1 is detected by a position detection unit 12 provided on the motor 1. The rotation angle Θ2 of the load 3 can be obtained from the rotation angle Θ1 of the motor 1 detected by the position detection unit 12 and the gear ratio. Note that a position detection unit may be further provided on the load 3 side to detect the rotation angle Θ2 of the load 3. <Configuration of the external force estimation device> 7 is a block diagram showing a configuration of an external force estimation device 30 according to a second embodiment. The external force estimation device 30 according to the second embodiment includes a torque calculation unit 23, an inertia torque estimation unit 24, a friction torque estimation unit 25, a temperature correction unit 26, an external force estimation unit 27, a motor angle-friction variation table 28, and a load angle-friction variation table 29. The external force estimation device 30 according to the second embodiment is additionally provided with the motor angle-friction variation table 28 and the load angle-friction variation table 29 compared to the external force estimation device 22 according to the first embodiment. In the external force estimation device 30 according to the second embodiment, the same components as those in the external force estimation device 22 according to the first embodiment are denoted by the same reference numerals, and detailed description thereof will be omitted as appropriate.
[0051] The motor angle-friction fluctuation table 28 is a table that stores the correspondence between the rotation angle Θ1 of the motor 1 and the friction torque that fluctuates according to the rotation angle Θ1. That is, the motor angle-friction fluctuation table 28 stores values of the fluctuation of the friction torque according to the rotation angle Θ1 of the motor 1.
[0052] The motor angle-friction fluctuation table 28 can be created by obtaining the current value when motor 1 rotates once, dividing the intervals according to the rotation angle Θ1 of motor 1, averaging the current values of the divided intervals and the current value for one entire rotation, and multiplying the result by the torque constant after subtracting the average current value for one entire rotation from the average current value for the divided intervals.
[0053] Table 1 is an example of the motor angle-friction fluctuation table 28.
[0054] [Table 1]
[0055] By using the motor angle-friction variation table 28, the friction torque corresponding to the rotation angle Θ1 of the motor 1 is estimated. The external force estimation unit 27 can estimate the external force by subtracting the inertia torque, the friction torque after temperature correction, and the friction torque estimated using the motor angle-friction variation table 28 from the output torque calculated by the torque calculation unit 23. By using the motor angle-friction variation table 28, the external force estimation device 30 can compensate for the influence of the friction torque corresponding to the rotation angle Θ1 of the motor 1 and reduce the estimation error of the external force.
[0056] The load angle-friction variation table 29 is a table that stores the correspondence relationship between the rotation angle Θ2 of the load 3 and the friction torque that varies according to the rotation angle Θ2. That is, the load angle-friction variation table 29 stores values of the variation in friction torque according to the rotation angle Θ2 of the load 3.
[0057] The load angle-friction fluctuation table 29 can be created by obtaining the current value when the load 3 is rotated once, dividing the intervals according to the rotation angle Θ2 of the load 3, averaging the current values of the divided intervals and the current value over one entire rotation, subtracting the average over one entire rotation from the average current value in the divided intervals, and multiplying the result by the torque constant.
[0058] Table 2 is an example of the load angle-friction variation table 29.
[0059] [Table 2]
[0060] The external force estimation device 30 can estimate the friction torque corresponding to the rotation angle Θ2 of the load 3 by using the load angle-friction variation table 29. The external force estimation unit 27 can estimate the external force by subtracting the inertia torque, the friction torque after temperature correction, and the friction torque estimated by using the load angle-friction variation table 29 from the output torque calculated by the torque calculation unit 23. By using the load angle-friction variation table 29, the external force estimation device 30 can compensate for the influence of the friction torque corresponding to the rotation angle Θ2 of the load 3 and reduce the estimation error of the external force.
[0061] Furthermore, external force estimation unit 27 may estimate the external force by subtracting, from the output torque calculated by torque calculation unit 23, the inertia torque, the friction torque after temperature correction, the friction torque estimated using motor angle-friction fluctuation table 28, and the friction torque estimated using load angle-friction fluctuation table 29. By using motor angle-friction fluctuation table 28 and load angle-friction fluctuation table 29, external force estimation device 30 can compensate for the influence of the friction torque corresponding to the rotation angle Θ1 of motor 1 and the friction torque corresponding to the rotation angle Θ2 of load 3, and can further reduce the estimation error of the external force.
[0062] <External force estimation method> An external force estimation method according to the second embodiment will be described with reference to Fig. 8. Fig. 8 is a flowchart showing the operation of the external force estimation device 30 according to the second embodiment. Note that steps S11 to S14 in Fig. 8 are similar to steps S1 to S4 in Fig. 5, and therefore description thereof will be omitted.
[0063] The friction torque is estimated using the rotation angle Θ1 of the motor 1 acquired by the position detection unit 12 and the motor angle-friction fluctuation table 28 (step S15). The friction torque is estimated using the rotation angle Θ2 of the load 3 calculated from the rotation angle Θ1 of the motor 1 and the gear ratio and the load angle-friction fluctuation table 29 (step S16). Note that the order of steps S15 and S16 is not limited to this, and may be any order.
[0064] The external force estimation unit 27 estimates the external force by subtracting the inertia torque, the temperature-corrected friction torque, the friction torque estimated using the motor angle-friction fluctuation table 28, and the friction torque estimated using the load angle-friction fluctuation table 29 from the output torque calculated by the torque calculation unit 23 (step S17). The external force estimation unit 27 outputs the estimated external force to the command unit 10.
[0065] As described above, the external force estimation device 30 according to the second embodiment not only corrects the fluctuation in friction torque due to temperature change, but also estimates the external force taking into account the influence of the friction torque according to the rotation angle Θ1 of the motor 1 and the rotation angle Θ2 of the load 3. As a result, the external force estimation device 30 according to the second embodiment can reduce errors in the estimated external force and increase the accuracy of the estimated value of the external force acting on the motor 1. The external force estimation device 30 according to the second embodiment can improve the accuracy of motor control and operate the load smoothly.
[0066] Incidentally, the external force estimation device 30 according to the second embodiment uses the motor angle-friction fluctuation table 28 to reduce the effect of the cogging torque due to the rotation angle Θ1 of the motor 1, and can also collectively compensate for the cogging torque, which generally accounts for about 5% of the rated output torque of the motor.
[0067] An example of the hardware configuration of the control unit 20 according to the first and second embodiments will be described with reference to FIG. 9. The command unit 10 may have the same hardware configuration as the control unit 20. The control unit 21, the external force estimation device 22, and the external force estimation device 30 may have the hardware configuration shown in FIG. 9. In FIG. 9, the control unit 20 has a processor 101 and a memory 102. The processor 101 may be, for example, a microprocessor, an MPU (Micro Processing Unit), or a CPU (Central Processing Unit). The processor 101 may include a plurality of processors. The memory 102 is configured by a combination of a volatile memory and a non-volatile memory. The memory 102 may include a storage located away from the processor 101. In this case, the processor 101 may access the memory 102 via an input / output interface not shown.
[0068] Furthermore, each device in the above-described embodiments may be configured with hardware or software, or both, and may be configured with one piece of hardware or software, or may be configured with multiple pieces of hardware or software. The functions (processing) of each device in the above-described embodiments may be realized by a computer. For example, a program for performing the operations in the embodiments may be stored in memory 102, and each function may be realized by executing the program stored in memory 102 by processor 101.
[0069] The program according to this embodiment is an external force estimation program for estimating an external force acting on a motor, and causes a computer to execute a process of calculating the output torque of the motor using a current value supplied to the motor, estimating the inertia torque and friction torque of the motor using rotational position information of the motor, temperature-correcting the estimated friction torque using temperature information of the motor, and estimating the external force by subtracting the inertia torque and the friction torque after temperature correction from the calculated output torque.
[0070] The program includes a set of instructions (or software code) that, when loaded into a computer, causes the computer to perform one or more functions described in the embodiments. The program may be stored in a non-transitory computer-readable medium or a tangible storage medium. By way of example and not limitation, the computer-readable medium or tangible storage medium includes random-access memory (RAM), read-only memory (ROM), flash memory, solid-state drive (SSD) or other memory technology, CD-ROM, digital versatile disk (DVD), Blu-ray® disk or other optical disk storage, magnetic cassette, magnetic tape, magnetic disk storage or other magnetic storage device. The program may be transmitted on a transitory computer-readable medium or communication medium. By way of example and not limitation, the transitory computer-readable medium or communication medium includes electrical, optical, acoustic, or other forms of propagated signals.
[0071] The external force estimation device 22 and the external force estimation device 30 according to the present embodiment can be applied not only to robots such as partner robots, collaborative robots, assist robots, and service robots, but also to sensorless power steering technology in automobiles, automatic opening and closing doors, and the like.
[0072] The present invention is not limited to the above-described embodiment, and can be modified as appropriate without departing from the spirit and scope of the present invention. [Explanation of symbols]
[0073] 1 Motor 2 Gear 3. Load 4 Fixed part 5 Gear 6 Gear 10 Command Department 11 Current detection section 12 Position detection unit 13 Temperature detection section 20 Control Unit 21 Control section 22 External force estimation device 23 Torque calculation section 24 Inertia torque estimation section 25 Friction torque estimation unit 26 Temperature correction section 27 External force estimation section 28 Motor angle-friction fluctuation table 29 Load angle-friction variation table 30 External force estimation device 100 Control System 101 Processor 102 Memory
Claims
1. An external force estimation device for estimating an external force acting on a motor that operates a load via a gear, comprising: a torque calculation unit that calculates an output torque of the motor using a current value supplied to the motor; an inertia torque estimating unit that estimates an inertia torque of the motor by using rotational position information of the motor; a friction torque estimating unit that estimates a friction torque of the motor by using rotational position information of the motor; a temperature correction unit that performs temperature correction on the friction torque by using temperature information of the motor; a motor angle-friction variation table that stores a correspondence relationship between a rotation angle of the motor and a friction torque that varies according to the rotation angle; an external force estimation unit that estimates the external force by subtracting the inertia torque, the friction torque after temperature correction, and a friction torque estimated using the motor angle-friction variation table from the output torque calculated by the torque calculation unit; External force estimation device.
2. An external force estimation device for estimating an external force acting on a motor that operates a load via a gear, comprising: a torque calculation unit that calculates an output torque of the motor using a current value supplied to the motor; an inertia torque estimating unit that estimates an inertia torque of the motor by using rotational position information of the motor; a friction torque estimating unit that estimates a friction torque of the motor by using rotational position information of the motor; a temperature correction unit that performs temperature correction on the friction torque by using temperature information of the motor; a load angle-friction variation table that stores a correspondence relationship between a rotation angle of the load and a friction torque that varies according to the rotation angle; an external force estimation unit that estimates the external force by subtracting the inertia torque, the temperature-corrected friction torque, and a friction torque estimated using the load angle-friction variation table from the output torque calculated by the torque calculation unit. External force estimation device.
3. An external force estimation device for estimating an external force acting on a motor that operates a load via a gear, comprising: a torque calculation unit that calculates an output torque of the motor using a current value supplied to the motor; an inertia torque estimating unit that estimates an inertia torque of the motor by using rotational position information of the motor; a friction torque estimating unit that estimates a friction torque of the motor by using rotational position information of the motor; a temperature correction unit that performs temperature correction on the friction torque by using temperature information of the motor; a motor angle-friction variation table that stores a correspondence relationship between a rotation angle of the motor and a friction torque that varies according to the rotation angle; a load angle-friction variation table that stores a correspondence relationship between a rotation angle of the load and a friction torque that varies according to the rotation angle; an external force estimation unit that estimates the external force by subtracting, from the output torque calculated by the torque calculation unit, the inertia torque, the friction torque after temperature correction, the friction torque estimated using the motor angle-friction fluctuation table, and the friction torque estimated using the load angle-friction fluctuation table. External force estimation device.
4. The friction torque includes at least one of a Coulomb friction torque and a viscous friction torque. The external force estimation device according to any one of claims 1 to 3.
5. The inertia torque estimation unit estimates the inertia torque of the motor by using a result of the inverse dynamics calculation. The external force estimation device according to any one of claims 1 to 4.
6. An external force estimation method for estimating an external force acting on a motor that operates a load via a gear, comprising: Calculating an output torque of the motor using a current value supplied to the motor; estimating an inertia torque of the motor and a friction torque of the motor using rotational position information of the motor; performing temperature correction on the estimated friction torque using temperature information of the motor; estimating a friction torque corresponding to a rotation angle of the motor using a motor angle-friction variation table that stores a correspondence relationship between a rotation angle of the motor and a friction torque that varies according to the rotation angle; The external force is estimated by subtracting from the calculated output torque the inertia torque, the friction torque after temperature correction, and the friction torque estimated using the motor angle-friction fluctuation table. External force estimation method.
7. An external force estimation program for estimating an external force acting on a motor that operates a load via a gear, comprising: Calculating an output torque of the motor using a current value supplied to the motor; estimating an inertia torque of the motor and a friction torque of the motor using rotational position information of the motor; performing temperature correction on the estimated friction torque using temperature information of the motor; estimating a friction torque corresponding to a rotation angle of the motor using a motor angle-friction variation table that stores a correspondence relationship between a rotation angle of the motor and a friction torque that varies according to the rotation angle; The external force is estimated by subtracting from the calculated output torque the inertia torque, the friction torque after temperature correction, and the friction torque estimated using the motor angle-friction fluctuation table. An external force estimation program for causing a computer to execute the processing.
Citation Information
Patent Citations
Drive control device, drive control system, torque control device, and assistance control device
JP2018067284A
Disturbance observer, control device, machine tool and disturbance estimation method
JP2020035394A
