Patent Application
20220276107
The present invention relates to a load torque detection technology, and more particularly, to a device and method for load torque detection.
In the aspect of robot system driving and safety, measuring a torque in each joint link of a robot is very important. The torque of an actuator refers to a force generated by the joints of the robot, and the entire robot can be controlled more quickly and stably through correct measurement of the force of each joint and appropriate feedbacks thereto. In addition, by detecting an unexpected external shock or load, it is possible to protect a user from a physical collision with a drive system or prevent deterioration of the system durability such as damage to the drive shaft and the like.
The background art of the present disclosure is disclosed in Korean Patent Laid-open No. 10-2005-0009001.
The present invention provides a load torque detection device and method for accurately detecting a load torque by compensating for an error in multi-revolution information generated by distortion information of an elastic body.
According to one aspect of the present invention, a load torque detection device is provided. According to an embodiment of the present disclosure, the load torque detection device may include a load torque measurement actuator comprising a first position sensor, an elastic body, a reducer, a second position sensor, and a motor assembled in series to a load link, and generating information for measuring a torque of the load link by using a torsion of the elastic body, and a load torque detection unit that indexes an output of the first position connected to the load link to utilize multi-revolution information of the second position sensor connected to a shaft of motor, and compensates an indexing error that may occur due to the torsion of the elastic body and a backlash of the reducer to detect the torque of the load link.
According to another aspect of the present invention, there may be provided a load torque detection method and a computer-readable recording medium recording a computer program executing the method. According to an embodiment of the present disclosure, the load torque detection method and the computer-readable recording medium may include calculating an indexing value for calculating a multi-revolution factor and the multi-revolution factor, by using a first rotational position value of a first position sensor and a reduction ratio, calculating a strain output by a backlash and an elastic body by subtracting a single-revolution factor including an error from a second rotational position value of a second position sensor, calculating a multi-revolution value of the motor that is error-compensated based on the second rotational position value of the second position sensor and the strain output by the backlash and the elastic body, calculating a compensated rotational position value of the motor by summing the second rotational position value of the second position sensor and the multi-revolution factor that is error-compensated, calculating the strain output by the elastic body by using the first rotational position value and the reduction ratio of the first position sensor, the strain output by the backlash, and the compensated rotational position value of the motor, and calculating a torque of a load link by using the strain output by the backlash, the strain output by the elastic body, and a spring coefficient.
According to an embodiment of the present invention, it is possible to accurately detect the load torque without requiring a position sensor included in a load torque measurement actuator to have a multi-revolution function or additional power supply.
Since the present disclosure can have various modifications and various embodiments, certain embodiments are illustrated in the drawings by way of examples and will be described in detail through detailed description. However, it should be understood that the disclosure is not to be limited to specific embodiments, but includes all modifications, equivalents, and alternatives falling within the spirit and scope of the disclosure. In describing the present disclosure, when it is determined that a detailed description of a related known technology may unnecessarily obscure the gist of the present disclosure, the detailed description thereof will be omitted. In addition, a singular expression used in the description and the claims should generally be construed to mean “one or more” unless stated otherwise.
Hereinafter, preferred embodiments of the present disclosure will be described in detail with reference to the accompanying drawings, and while describing the embodiments with reference to the accompanying drawings, the same or corresponding components are given the same reference numerals, and redundant descriptions thereof will be omitted.
Referring to
The load link 100 is in a state constrained by a link connected to the load.
The load torque measurement actuator 200 includes a first position sensor, an elastic body, a reducer, a second position sensor, and a motor assembled in series to the load link, and generates information for measuring a torque of the load link by using a torsion of the elastic body.
The load torque detection unit indexes an output of a first position sensor 210 connected to the load link to utilize this as multi-revolution information of a second position sensor 240 connected to the motor shaft, and compensates for an indexing error that may occur due to the torsion of the elastic body and a backlash of the reducer to thus detect the torque of the load link. The load torque detection unit 300 may detect the load torque by calculating the absolute position of the motor shaft using the information generated by the load torque measurement actuator 200 to which the absolute position sensor is attached, without itself having a multi-revolution function or additional power supply of the position sensor.
Referring to
The first position sensor 210 is positioned between the load link 100 and the elastic body 220 to measure a rotational position value of the load link 100. The first position sensor 210 is an absolute position sensor such as an optical or magnetic encoder or resolver, for example. In addition, the first position sensor 210 may be a rotation type or a linear type.
The elastic body 220 measures a force (torque) applied to both ends of the elastic body by the degree of distortion of both ends. When the first position sensor 210 and the second position sensor 240 are directly attached to both ends of the elastic body 220, it may be possible to simply compare the outputs of the two position sensors and multiply by a spring coefficient to detect the applied torque.
The reducer 230 reduces the rotational force of the motor according to a preset reduction ratio. The reducer 230 reduces the rotational force such that, even when the rotational force of the motor is increased beyond a certain level at which exceeding one rotation is possible, the load link 100 does not exceed one rotation under the influence of the speed reduction.
Referring to
The second position sensor 240 measures a rotational position value of the motor 250. Like the first position sensor 210, the second position sensor 240 is an absolute position sensor such as, for example, an optical or magnetic encoder or resolver. In addition, the second position sensor 240 may be a rotation type or a linear type.
The motor 250 provides rotational driving force.
Referring to
The position sensor output reception unit 310 receives a first rotational position value and a second rotational position value from the first position sensor 210 and the second position sensor 240.
The first position sensor 210 and the second position sensor 240 are rotary sensors, and may express an angle (position) of 0 to 360[°] as a unit of rotation, and have a rotational position value as a positive value between 0 and 1.
When the reduction ratio of the reducer 230 is an integer and the calculable multi-revolutions of the motor shaft is limited within the range of the reduction ratio, the absolute position of the motor shaft may be calculated by the following equations.
TI=θ1*RM [Equation 1]
TM=[TI] [Equation 2]
where, θ1 is a rotational position value of the first position sensor, RM is a reduction ratio of the reducer, TI is an indexing value for calculating the multi-revolutions, and TM is the calculated multi-revolution position value of the second position sensor.
The strain output calculation unit 320 calculates the strain output (θK) by the backlash and the elastic body by using the first rotational position value, the second rotational position value, and the preset reduction ratio.
θK=θ2−TS [Equation 3]
where, θ2 is the rotational position value of the second position sensor, θK is the strain by the backlash and the elastic body, TS is the single revolution including error, calculated by TI−TM by taking only the fractional part of TI.
The multi-revolution error compensation unit 330 compensates for a multi-revolution error generated by the strain caused by the backlash and the elastic body to calculate a compensated multi-revolution value of the motor and a compensated rotational position value of the motor. Here, when the deformable range (θK) by the backlash and the elastic body is physically limited to within one revolution of the primary side of the reducer at the time of calculation, since TI has an error within ±0.5 based on single revolution (θ2), compensation for the calculation of multi-revolutions is possible with the following equation.
TMcomp=([TI]−1)mod RM,0.5≤θK<1 and 0.55≤θ2<1 [Equation 4]
TMcomp=([TI]+1)mod RM,−1≤θK<−0.5 and 0≤θ2<0.5 [Equation 5]
where, TMcomp is the multi-revolution value of the motor after error compensation.
θMcomp=TMcomp+92 [Equation 6]
where, θMcomp is the rotational position value of the motor after error compensation.
The elastic body strain output calculation unit 340 calculates an output of the elastic body strain using the multi-revolution value of the motor and the rotational position value of the motor after multi-revolution error compensation.
θB+θS=(1+θ1)−θMcomp/RM (when IT=0 and TMcomp=RM−1) [Equation 7]
θB+θS=θ1−∂Mcomp/RM (otherwise) [Equation 8]
where, a discontinuity occurs in the value of θ1 in a section of exceeding one rotation of the load shaft, and substituting into the corresponding equation as it is in the condition of TI=0 and TMcomp=RM−1 will result in a large error in the calculation. Therefore, 1 should be added to θ1 to avoid this problem.
The load torque calculation unit 350 calculates the load torque by using the strain output by the elastic body, the spring coefficient, and the strain output by backlash.
By the spring equation of motion,
τEst=θB+KS*θS [Equation 9]
where, τEst is the load torque detected by the spring, in the unit of [Nm], KS is the spring coefficient (stiffness) of the elastic body, in the unit of [Nm/revolution], and θB is the intrinsic value of the strain output by backlash.
Referring to
Referring to
In step S720, the load torque detection device calculates the strain output by the backlash and the elastic body by subtracting the single-revolution factor (TS(=TI−TM)) including the error from the second rotational position value (θ2) of the second position sensor. Specifically, the load torque detection device may calculate the strain output (θK) by the backlash and the elastic body using Equation (3) described above.
Referring to
The strain by the backlash and the elastic body is expressed as θK, and the influence of θK on the calculation of the motor shaft position (θM) will be described. First, θK may have three cases: {circle around (1)} θK<0, {circle around (2)} θK>0, {circle around (3)} θK=0, in which case {circle around (3)} is the same as described above in
In case {circle around (1)}, the first rotational position value (θ1) of the first position sensor has an output in the form of a phase delayed by θK with respect to an increase in θA, and the zero point no longer coincides with θ2.
In this state, TM changes when θ2 is at an intermediate point between 0˜1 instead of it being at the time point of changing from 1 to 0, and this means that multiple revolutions are counted before the single revolution reaches its maximum (360[°]), and θM can cause a large computational error of +1 revolution or more before θ2 exceeds its maximum output and returns to 0.
In case {circle around (2)}, conversely, θ1 has an output with a phase ahead by θK, and θM causes an error of −1 rotation or less.
For example, when θK is −0.16, and when θ2 is between 0.5 and 1, TI has a value of 0.66˜1.16. TS is 0.66˜1 and 0˜0.16. Here, the multi-revolution error occurs only when TS is 0˜0.16, and in this section, θ2 has a value of 0.84˜1, and when θK is calculated with θ2−TS, a value of 0.84 is calculated instead of −0.16. Since it is in a range beyond ±0.5, it may be determined that an operation error occurs. A value greater than 0.5 means that an operation error occurs in the state θK<0, and a value less than −0.5 means an operation error occurs in the state θK>0. As a result, it is necessary to satisfy the condition of Equation (4) and to apply −1 to the multi-revolution operation by Equations (1) and (2) to avoid calculation errors. At this time, when TI is changed to −0.66˜0.16 which is the situation before one motor revolution, when −1 is applied for TI, since the indexing value for calculating multi-revolution is negative, it has a value from 0 to less than RM.
In step S730, the load torque detection device calculates a multi-revolution value TMcomp of the motor after the compensation of the error based on the second rotational position value (θ2) of the second position sensor and the strain output (θK) by the backlash and the elastic body. Specifically, the load torque detection device may calculate the multi-revolution value (TMcomp) of the motor after the compensation of the error with Equations (4) and (5) described above.
In step S740, the load torque detection device calculates a compensated motor rotational position value (θMComp) by summing the second rotational position value (θ2) of the second position sensor and the multi-revolution factor (TMComp) after error compensation. Specifically, the load torque detection device may calculate the compensated rotational position value of the motor by using Equation (6) described above.
In step S750, the load torque detection device calculates the strain output θS by the elastic body by using the output (θ1) of the first position sensor and the reduction ratio (RM), the strain output (θB) by the backlash, and the compensated rotational position value (θMComp) of the motor. Specifically, the load torque detection device may calculate the strain output (θS) by the elastic body by using Equations (7) and (8) described above.
In step S760, the load torque detection device calculates the torque of the load link by using the strain output (θB) by the backlash, the strain output (θS) by the elastic body, and the spring coefficient. Specifically, the load torque detection device may calculate the torque (τEst) of the load link by using Equation (9) described above.
The method for detecting the load torque described above may be implemented as a computer-readable code on a computer-readable medium. The computer-readable recording medium may be a removable recording medium (CD, DVD, Blu-ray disk, USB storage device, removable hard disk) or a fixed recording medium (ROM, RAM, computer-equipped hard disk), for example. The computer program recorded on the computer-readable recording medium may be transmitted to the other computing devices through a network such as the Internet or the like and installed in the other computing devices, thereby being used in the other computing devices.
When it is described above that all components of the embodiment of the present disclosure are combined or operated as one body, the present disclosure is not necessarily limited to such an embodiment. That is, as long as it is within the scope of the present disclosure, one or more of those components may be selectively combined and operated.
Although operations are illustrated in a specific order in the drawings, it should not be understood as requiring that the operations be performed in the specific order or sequential order illustrated, or that all the illustrated operations be performed to obtain a desired result. In certain circumstances, multitasking and parallel processing may be advantageous. Moreover, separation of the various components in the embodiments described above should not be construed as necessarily requiring such separation, and it should be understood that the program components and systems described herein may generally be integrated together into a single software product or packaged into multiple software products.
The present disclosure has been mainly described above with respect to the embodiments thereof. Those of ordinary skill in the art to which the present disclosure pertains will understand that the present disclosure can be implemented in a modified form without departing from the essential characteristics of the present disclosure. Therefore, the disclosed embodiments should be considered in an illustrative rather than a restrictive sense. The scope of the present disclosure should be construed by the claims rather than the foregoing description, and all differences within the scope equivalent thereto should be construed to be included in the present disclosure.
| Number | Date | Country | Kind |
|---|---|---|---|
| 10-2019-0150559 | Nov 2019 | KR | national |
This application is a continuation of International Application No. PCT/KR2019/016287 filed on Nov. 25, 2019, which claims priority to Korean Patent Application No. 10-2019-0150559 filed on Nov. 21, 2019, the entire contents of which are herein incorporated by reference.
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/KR2019/016287 | Nov 2019 | US |
| Child | 17749242 | US |
