(19)
(11)EP 4 052 863 A1

(12)EUROPEAN PATENT APPLICATION
published in accordance with Art. 153(4) EPC

(43)Date of publication:
07.09.2022 Bulletin 2022/36

(21)Application number: 20883155.2

(22)Date of filing:  30.10.2020
(51)International Patent Classification (IPC): 
B25J 9/16(2006.01)
(52)Cooperative Patent Classification (CPC):
B25J 9/16
(86)International application number:
PCT/KR2020/015022
(87)International publication number:
WO 2021/086106 (06.05.2021 Gazette  2021/18)
(84)Designated Contracting States:
AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR
Designated Extension States:
BA ME
Designated Validation States:
KH MA MD TN

(30)Priority: 01.11.2019 KR 20190138394
01.11.2019 KR 20200131103

(71)Applicant: Neuromeka
Seoul 04782 (KR)

(72)Inventors:
  • PARK, Jong Hoon
    Namyangju-si Gyeonggi-do 12250 (KR)
  • LEE, Woong Yong
    Pohang-si Gyeongsangbuk-do 37673 (KR)
  • HEO, Young Jin
    Changwon-si Gyeongsangnam-do 51425 (KR)
  • KIM, Gwan Woo
    Pohang-si Gyeongsangbuk-do 37664 (KR)

(74)Representative: Michalski Hüttermann & Partner Patentanwälte mbB 
Kaistraße 16A
40221 Düsseldorf
40221 Düsseldorf (DE)

  


(54)METHOD FOR COMPENSATING FOR FRICTION OF MULTI-DEGREE-OF-FREEDOM COOPERATIVE ROBOT


(57) In a method for compensating for friction of a multi-degree-of-freedom cooperative robot including a plurality of joints, the method for compensating for friction of the multi-degree-of-freedom cooperative robot, according to an embodiment of the present invention, comprises the steps of: generating a motion of a cooperative robot for friction compensation; driving the plurality of joints on the basis of the generated motion of the cooperative robot; receiving friction identification data from the cooperative robot; and calculating a friction model function from the received friction identification data.




Description

BACKGROUND OF THE DISCLOSURE


Field of the disclosure



[0001] The present disclosure relates to a method for compensating for friction of a multi-degree-of-freedom cooperative robot, and more particularly, to a method for compensating for a frictional force acting on a cooperative robot with multiple degrees of freedom.

Related Art



[0002] Recently, collaborative robots that can work in the same space as humans have emerged. Collaborative robots are robots that operate in close proximity to humans and are smaller and slower than conventional industrial robots for human safety.

[0003] The cooperative robot has the advantage that the operator can directly teach and use it as needed.

[0004] However, due to the large frictional force generated by the gear mechanism in each joint of the cooperative robot, the agile interaction between the user and the cooperative robot is hindered in a situation where the user directly moves the cooperative robot to teach.

[0005] In addition, even if the setting according to the friction force compensation is completed during the initial setting of the cooperative robot, the friction characteristics change due to wear of the drive system depending on the period of use of the cooperative robot. It often happens that the driving precision is poor.

SUMMARY



[0006] The present disclosure provides a friction compensation method for a multi-degree-of-freedom cooperative robot in which the cooperative robot can measure friction by itself, collect a large amount of friction force data, and derive a friction model without user intervention.

[0007] The problems of the present invention are not limited to the problems mentioned above, and other problems not mentioned will be clearly understood by those skilled in the art from the following description.

[0008] According to an exemplary embodiment of the present disclosure, a method for compensating for friction of a multi-degree-of-freedom cooperative robot including a plurality of joints may include steps of: generating motion of the cooperative robot for friction compensation; driving the plurality of joints on the basis of the generated motion of the cooperative robot; receiving friction identification data from the cooperative robot; and calculating a friction model function from the received friction identification data.

[0009] The step of generating motion of the cooperative robot may include the step of generating a posture in which the effect of gravity is removed.

[0010] The step of generating motion of the cooperative robot may include the step of generating a motion for removing an inertial effect.

[0011] The step of generating motion of the cooperative robot may include the step of generating a motion for controlling the effect of a Coriolis force.

[0012] The friction identification data may include angle information of a plurality of joints, torque-related information acting on the plurality of joints, and temperature information of an actuator that drives the plurality of joints.

[0013] The step of calculating a friction model function may include the step of identifying static friction, kinetic friction, and viscous friction acting on the plurality of joints based on the friction identification data.

[0014] The method may include the step of: using real-time data of the friction identification data to identify the static friction and the kinetic friction; and using average data of the friction identification data to identify the viscous friction.

[0015] The variable of the friction model function may include a driving speed of the plurality of joints.

[0016] The friction identification data may include temperature information of an actuator that drives the plurality of joints, and the variable of the friction model function further comprises the temperature information.

[0017] The method may further include the steps of: driving the plurality of joints by applying the calculated friction model function; and evaluating the friction model function based on the position error of the cooperative robot.

[0018] The method may include the step of compensating the parameters of the friction model function based on the result of the step of evaluating the friction model function.

[0019] The method may further include correcting a parameter of the friction model function based on a result of the step of evaluating the friction model function.

[0020] Other specific details of the invention are included in the detailed description and drawings.

[0021] According to the embodiments of the present invention, there are at least the following effects.

[0022] Without user intervention, the collaborative robot measures friction by itself, collects a large amount of friction data, and derives a friction model.

[0023] In addition, since the friction model is automatically calculated and then the friction force is calculated and compensated by itself, agile direct teaching and force control performance can be maintained regardless of the period of use of the cooperative robot.

[0024] The effect according to the present invention is not limited by the contents exemplified above, and more various effects are included in the present specification.

BRIEF DESCRIPTION OF THE DRAWINGS



[0025] 

FIG. 1 is a perspective view illustrating a multi-degree-of-freedom cooperative robot.

FIG. 2 is a block diagram schematically illustrating a friction compensation system of a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention.

FIG. 3 is a flowchart illustrating a friction compensation method of a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention.

FIG. 4 is a flowchart illustrating a friction compensation method of a multi-degree-of-freedom cooperative robot according to another embodiment of the present invention.


DESCRIPTION OF EXEMPLARY EMBODIMENTS



[0026] Advantages and features of the present invention and methods of achieving them will become apparent with reference to the embodiments described below in detail in conjunction with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but may be implemented in various different forms, and only these embodiments are provided so that the disclosure of the present invention is complete, and to completely inform those of ordinary skill in the art to which the present invention belongs, the scope of the invention, and the present invention is only defined by the scope of the claims.

[0027] Further, the embodiments described herein will be described with reference to cross-sectional and/or schematic diagrams that are ideal illustrative views of the present invention. Accordingly, the shape of the illustrative drawing may be modified due to manufacturing technology and/or tolerance. In addition, in each of the drawings shown in the present invention, each component may be enlarged or reduced to some extent in consideration of convenience of description. The same reference numerals refer to the same component throughout the specification.

[0028] Hereinafter, the present invention will be described with reference to the drawings for explaining a friction compensation system for a multi-degree-of-freedom cooperative robot and a friction compensation method for a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention.

[0029] FIG. 1 is a perspective view illustrating a multi-degree-of-freedom cooperative robot.

[0030] The cooperative robot 10 includes a plurality of joints 12, 13, 14, 15, 16, and 17 to realize movement of multiple degrees of freedom. FIG. 1 illustrates a cooperative robot 10 configured to have six degrees of freedom using six joints 12, 13, 14, 15, 16, and 17 as an example of a multi-degree-of-freedom cooperative robot.

[0031] The first joint 12 is rotatably coupled to the upper portion of the base 11, and the first joint 12 rotates about the Z axis (vertical direction with respect to FIG. 1 ). One end surface (surface facing the base 11) and the other end surface (surface facing the second joint 13) of the first joint 12 are located on a plane perpendicular to each other.

[0032] The second joint 13 is rotatably coupled to the other end of the first joint 12. Since one end face and the other end face of the first joint 12 are positioned on a plane perpendicular to each other, the second joint 13 rotates about an axis in a direction perpendicular to the axis of rotation of the first joint 12. One end surface (surface facing the first joint 12) and the other end surface (surface facing the third joint 14) of the second joint 13 are located on a plane that is parallel or coincident with each other.

[0033] The third joint 14 is rotatably coupled to the other end of the second joint 13. Since the one end face and the other end face of the second joint 13 are located on a plane that is parallel or coincident with each other, the third joint 14 rotates about an axis parallel to the axis of rotation of the second joint 13. One end surface (surface facing the second joint 13) and the other end surface (surface facing the fourth joint 15) of the third joint 14 are located on a plane perpendicular to each other.

[0034] The fourth joint 15 is rotatably coupled to the other end of the third joint 14. Since one end face and the other end face of the third joint 14 are positioned on a plane perpendicular to each other, the fourth joint 15 rotates about an axis in a direction perpendicular to the axis of rotation of the third joint 14. One end face (the face facing the third joint 14) and the other end face (the face facing the fifth joint 16) of the fourth joint 15 are located on a plane perpendicular to each other.

[0035] The fifth joint 16 is rotatably coupled to the other end of the fourth joint 15. Since the one end face and the other end face of the fourth j oint 15 are positioned on a plane perpendicular to each other, the fifth joint 16 rotates about an axis in a direction perpendicular to the axis of rotation of the fourth joint 15. One end face (surface facing the fourth joint 15) and the other end face (surface facing the sixth joint 17) of the fifth joint 16 are located on a plane perpendicular to each other.

[0036] The sixth joint 17 is rotatably coupled to the other end of the fifth joint 16. Since the one end face and the other end face of the fifth joint 16 are located on a plane perpendicular to each other, the sixth joint 17 rotates about an axis in a direction perpendicular to the axis of rotation of the fifth joint 16. One end face (the face facing the fourth joint 15) and the other end face of the fifth joint 16 are located on a plane perpendicular to each other.

[0037] An end tool (not shown) is mounted on the other end of the sixth joint 17. Various types of end tools exist depending on the work performed by the cooperative robot 10, and the other end of the sixth joint 17 is configured to replace and mount various end tools.

[0038] Each joint 12, 13, 14, 15, 16, and 17 is provided with an actuator (not shown) for rotationally driving the joints 12, 13, 14, 15, 16, and 17.

[0039] In order to improve and maintain the driving precision and ease of use of the cooperative robot 10, it is necessary to identify the friction force acting on each joint 12, 13, 14, 15, 16, 17, etc. of the cooperative robot 10 and control the friction force compensation to control the actuator in consideration of the torque lost by the friction force.

[0040] FIG. 2 is a block diagram schematically illustrating a friction compensation system of a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention.

[0041] As shown in FIG. 2, a friction compensation system 1 of a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention includes a multi-degree-of-freedom cooperative robot 10 and a robot controller 20.

[0042] The cooperative robot 10 includes an actuator 11, an actuator control unit 12, an encoder 13, and a temperature sensor 14.

[0043] As described above, the actuator 11 is a driving source for rotationally driving the joints 12, 13, 14, 15, 16, and 17 of the cooperative robot 10. The actuator control unit 12 may measure the current value supplied to the actuator 11, and calculate the driving speed, position, etc. of the joints 12, 13, 14, 15, 16, and 17. The temperature sensor 14 measures the temperature of the actuator 11. The encoder 13 measures the angles of the joints 12, 13, 14, 15, 16, and 17.

[0044] The actuator 11, the actuator control unit 12, the encoder 1, and the temperature sensor 14 may be provided for each joint 12, 13, 14, 15, 16, and 17 of the cooperative robot 10.

[0045] The robot control unit 20 is communicatively connected to the cooperative robot 10, and includes the motion generating unit 21, the control unit 22, the communication unit 23, the data collection unit 24, the operation unit 25, the friction parameter storage unit 26, the friction model function evaluation unit 27, and the friction parameter correcting unit 28.

[0046] The motion generating unit 21 generates a motion required for the cooperative robot 10 in order to derive the frictional force of the cooperative robot 10.

[0047] The controller 22 is responsible for controlling the cooperative robot 10. The control unit 22 may control the actuator 11 of the cooperative robot 10 and perform strong position control on the cooperative robot 10 so that the cooperative robot 10 accurately complies with the motion trajectory of the cooperative robot 10 generated by the motion generation unit 21.

[0048] The communication unit 23 manages communication between the robot control unit 20 and the cooperative robot 10. The communication unit 23 may be based on Ethernet communication, and transmits a control command from the robot control unit 20 to the cooperative robot 10, and the cooperative robot 10 from the cooperative robot 10 to the robot control unit 20 and transmits information necessary for controlling the cooperative robot 10 from the cooperative robot 10 to the robot control unit 20. In addition, friction identification data including angle information of a plurality of joints, torque-related information, and temperature information of an actuator may be transmitted from the cooperative robot 10 to the robot controller 20.

[0049] The data collection unit 24 collects and classifies data related to the cooperative robot 10 (particularly, friction identification data) transmitted from the communication unit 23.

[0050] The operation unit 25 provides additional information (for example, speed information, position information, torque information, average value for specific information, etc.) can be calculated.

[0051] In addition, the operation unit 25 may identify static friction, kinetic friction, and viscous friction acting on a plurality of joints based on the data collected/classified by the data collection unit 24.

[0052] In addition, the operation unit 25 may calculate a friction model function based on the data collected/classified by the data collection unit 24.

[0053] The friction parameter storage unit 26 stores the friction model function or parameters of the friction model function calculated by the operation unit 25.

[0054] The friction model function evaluation unit 27 evaluates the appropriateness of the friction model function calculated by the operation unit 25, and the friction parameter correction unit 28 corrects the parameters of the friction model function when the friction model function evaluation unit 27 evaluates that the friction model function is not appropriate.

[0055] The components of the robot control unit 20 are the motion generation unit 21, the control unit 22, the communication unit 23, the data collection unit 24, the operation unit 25, the friction parameter storage unit 26, the friction model function evaluation unit 27, and the friction parameter correcting unit 28, and they will be described in detail in the description of the friction compensation method of the multi-degree-of-freedom cooperative robot to be described later.

[0056] The components of the robot control unit 20 are the motion generation unit 21, the control unit 22, the communication unit 23, the data collection unit 24, the operation unit 25, the friction parameter storage unit 26, the friction model function evaluation unit 27, the friction parameter correcting unit 28, and they are classified based on functions, a plurality of components may be integrated into one physical part and in an actual physical configuration. For example, the functions of the operation unit 25, the friction model function evaluation unit 27, and the friction parameter correcting unit 28 may be performed in one calculation device.

[0057] FIG. 3 is a flowchart illustrating a friction compensation method of a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention.

[0058] As shown in FIG. 3, a friction compensation method for a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention includes generating a motion of the cooperative robot S11, and driving the cooperative robot based on the generated motion S12, receiving friction identification data S13, calculating the friction model function S14, applying the friction model function to driving the cooperative robot S15, evaluating the friction model function S16, correcting the parameters of the friction model function S17, and updating the parameters of the friction model function S18.

[0059] In step S11 of generating the motion of the cooperative robot, the motion generating unit 21 generates the motion of the cooperative robot 10 for friction compensation.

[0060] The motion generating unit 21 generates the motion of the cooperative robot 10 based on the following robot dynamics equation (Formula 1) so that the cooperative robot 10 can measure friction by itself without user intervention.


q, , represents the rotation position, rotation speed, and rotation angular velocity of the robot 10, respectively. In addition, M(q) is the inertial force of the robot 10, C(q,) is the Coriolis force, g(q) represents gravity, and τ, τf represents the torque value input to the robot 10 and the frictional force acting on the robot 10, respectively.

[0061] The motion generating unit 21 generates a robot motion capable of removing the effects of the inertial force, the Coriolis force, and gravity so that the robot 10 can measure the friction force by itself as the torque input value τ.

[0062] First, a gravity-compensated motion capable of eliminating the effect of gravity will be described.

[0063] The motion generating unit 21 sets the posture of the cooperative robot 10 so that the joints 12, 13, 14, 15, 16, and 17 for which frictional force is to be measured are not affected by gravity. In this case, the overall posture of the cooperative robot 10 may be in a direction parallel to the direction in which gravity acts. For example, the rotation axis of each joint may be positioned parallel to the direction in which gravity acts to exclude the effect of gravity acting on each joint. However, a gravity compensation motion for a joint in which the axis of rotation cannot be parallel to gravity, such as the second joint 13 among the joints 12, 13, 14, 15, 16, and 17, will be described later.

[0064] When described with reference to the cooperative robot 10 shown in FIG. 1,

[0065] In the case of the first joint 12, the third joint 14, the fourth joint 15, and the sixth joint 17, all joints 12, 13, 14, 15, 16, and 17 have an angle of 0 degrees and measure the friction force in that posture.

[0066] In the case of the fifth joint 16, the first joint 12, the second joint 13, the fifth joint 16, and the sixth joint 17 have an angle of 0 degrees, and the third joint 14 and the fourth joint 15 measures the friction force in a posture having an angle of 90 degrees.

[0067] On the other hand, for joints that are inevitably affected by gravity in any posture, a symmetrical motion that can cancel the effect of gravity is created and frictional force is measured.

[0068] For example, the second joint 13 measures frictional force through a motion changing from 0 degrees to 90 degrees and a motion changing from 90 degrees to 0 degrees.

[0069] An inertia-compensated motion that can remove the inertial effect will be described.

[0070] The motion generating unit 21 generates the motion of the cooperative robot 10 so that the joints 12, 13, 14, 15, 16, and 17 for which frictional force is to be measured are not affected by inertia.

[0071] For example, the motion generation unit 21 may generate a position trajectory in which a linear trajectory and a parabolic trajectory are mixed to generate a robot motion including a linear velocity trajectory and a constant velocity trajectory. That is, the motion generating unit 21 continuously generates a motion including a constant velocity section that is not affected by the inertial force generated by the acceleration of each joint 12, 13, 14, 15, 16, and 17, thereby removing the influence of inertia acting on the joint 12, 13, 14, 15, 16, and 17.

[0072] A Coriolis force compensation motion that can eliminate the Coriolis force effect will be described.

[0073] The motion generating unit 21 establishes a motion plan of the cooperative robot 10 so that the joints 12, 13, 14, 15, 16, 17 for which frictional force is to be measured are not affected by the Coriolis force.

[0074] For example, the motion generation unit 21 may generate a motion for sequentially driving each joint 12, 13, 14, 15, 16, 17 in order to remove the Coriolis force generated by the nonlinear multi-degree-of-freedom robot motion.

[0075] Also, the motion generation unit 21 may generate a speed-based step-by-step motion to improve the accuracy of friction force measurement. The speed-based step-by-step motion increases the speed in steps of 0.05 degrees/sec until a speed of 1 degree/sec is reached in the first step, the speed in steps of 1 degree/sec until a speed of 10 degree/sec is reached in the second step, and the speed in steps of 10 degrees/sec until the maximum speed is reached in the third step.

[0076] In step S12 of driving the cooperative robot based on the generated motion, the controller 22 drives the cooperative robot 10 according to the motion generated by the motion generating unit 21 in step S11.

[0077] In order to precisely drive the cooperative robot 10 according to the motion, the control unit 22 may be configured to implement high-speed real-time control of a 4 kHz control cycle based on Ethernet communication.

[0078] In addition, the control unit 22 may improve the driving precision of the cooperative robot 10 through real-time robust position control. For example, the controller 22 may control each joint 12, 13, 14, 15, 16, and 17 of the cooperative robot 10 by combining the robot model-based front feed control method and the robot state variable-based feedback control method.

[0079] In step S13 of receiving the friction identification data, the communication unit 23 receives the friction identification data from the cooperative robot 10, and the data collection unit 24 collects and classifies the friction identification data from the communication unit 23. The reception of friction identification data may be made together with step S12, and friction identification data of each joint 12, 13, 14, 15, 16, and 17 is received.

[0080] The actuator control unit 12 of the cooperative robot 10 obtains information on the current value supplied to the actuator 11, information on the angle of each joint 12, 13, 14, 15, 16, and 17 obtained from the encoder 13, and information about the temperature of the actuator 11 obtained from the temperature sensor 14 is transmitted to the robot control unit 20.

[0081] The actuator control unit 12 acts on the position, speed, and torque of the joints 12, 13, 14, 15, 16, 17 based on the information obtained from the encoder 13 and the current value supplied to the actuator 11, etc. It is also possible to calculate the torque, etc., and transmit the calculation result to the robot control unit 20.

[0082] According to the embodiment, the cooperative robot 10 further includes a torque sensor (not shown) for measuring the torque acting on each joint 12, 13, 14, 15, 16, 17, and torque information output from the torque sensor may be transmitted to the robot control unit 20.

[0083] The friction identification data is data used to identify the friction force acting on each joint 12, 13, 14, 15, 16, and 17, which may include the angle information of the joint 12, 13, 14, 15, 16, and 17 measured by the encoder 13, the current value supplied to the actuator measured by the actuator control unit 12, temperature information of the actuator 11 measured by the temperature sensor 14, and position information and velocity information of the joint 12, 13, 14, 15, 16, 17 computed by the actuator control unit 12. In this case, since the current value supplied to the actuator is proportional to the torque required to operate the joint 12, 13, 14, 15, 16, and 17, the current value supplied to the actuator becomes torque-related information for estimating the torque acting on the joint 12, 13, 14, 15, 16, and 17. When the cooperative robot 10 is provided with a torque sensor, the measured value of the torque sensor becomes torque-related information.

[0084] The operation unit 25 provides additional information (for example, speed information, position information, torque information, an average value of specific information, etc.) may be calculated and transmitted to the data collection unit 24.

[0085] The data collection unit 24 may collect and store the average value and real-time data of friction identification data for each joint 12, 13, 14, 15, 16, 17 according to the speed-based step-by-step motion.

[0086] One motion unit may consist of a stop, a clockwise rotation, a stop, a counterclockwise rotation, and a stop. Alternatively, one motion unit may consist of a stop, a counterclockwise rotation, a stop, a clockwise rotation, and a stop. In addition, the clockwise rotation and the counterclockwise rotation may consist of a linear speed section and a constant speed section. In a certain speed section, the average data of friction identification data may be stored, and in a motion of a specific speed, real-time data of friction identification data may be collected and stored.

[0087] In the step of calculating the friction model function S14, the operation unit 25 may calculate the friction model function based on the data collected/classified by the data collection unit 24.

[0088] To this end, the operation unit 25 may identify static friction, kinetic friction, and viscous friction acting on each joint 12, 13, 14, 15, 16, 17 based on the data collected/classified by the data collection unit 24.

[0089] For example, the operation unit 25 may use real-time data of friction identification data to identify static friction and kinetic friction. Static friction can be identified using the maximum torque value that appears when the joint 12, 13, 14, 15, 16, and 17 starts moving, and kinetic friction can be identified using the torque value that appears in the low-speed section after the joint 12, 13, 14, 15, 16, and 17 starts moving.

[0090] Also, the operation unit 25 may use average data (average torque related information) of friction identification data to identify viscous friction.

[0091] The operation unit 25 may identify a friction model function of a joint expressing static friction, kinetic friction, and viscous friction. The form of the friction model function may be predefined. The operation unit 25 may identify the constant value of the friction model function by data fitting using the least squares method.

[0092] For example, the operation unit 25 derives a friction model function (f(x)=ax2 +bx+c) of a quadratic function based on the derived data, and three friction parameters (a, b and c) can be calculated. The variable (x) of the friction model function may be the driving speed of the joint.

[0093] The operation unit 25 may store or update the calculated friction model function or friction parameter in the friction parameter storage unit 26.

[0094] In the step S 15 of driving the cooperative robot by applying the friction model function, the control unit 22 applies the friction model function calculated by the operation unit 25 to each joint 12, 13, 14, 15, 16, and 17 of the cooperative robot 10 are driven. When the operation unit 25 stores the calculated friction model function or friction parameter in the friction parameter storage unit 26, the control unit 22 applies the newly updated friction model function or friction parameter to the friction parameter storage unit 26. The cooperative robot 10 is driven.

[0095] The controller 22 calculates the friction compensation force in real time by applying the parameters of the calculated friction model function. The control unit 22 receives the real-time speed and temperature values obtained through the communication unit 23 based on the following [Formula 2], calculates a friction compensation torque value, and based on this, the joints 12, 13, 14, 15, 16, and 17 can be controlled.


f() represents the nonlinear friction model, and τ̂f,,T represents the calculated friction force, joint velocity, and temperature, respectively. The method according to an embodiment of the present invention may utilize the following modified Lu-Gre friction model.








σ0, σ1 represent the stiffness constant and damping constant, respectively, Fc, Fs represent static friction and kinetic friction, σ2o,{p,n}, σ2T,{p,n}, σ3o,{p,n}, α3T,{p,n} represents the viscous friction constant values. qs is the velocity constant value, and T and L are the temperature and the weight attached to the cooperative robot, respectively.

[0096] In the step of evaluating the friction model function S16, the friction model function evaluation unit 27 evaluates the friction compensation performance of the friction model function based on the passivity and position error of the cooperative robot 10.

[0097] If the evaluation result is less than a predetermined criterion, a step S17 of correcting the parameters of the friction model function is performed.

[0098] In step S17 of correcting the parameters of the friction model function, the friction parameter correcting unit 28 adjusts the parameters of the friction model function. A rule for adjusting a parameter of the friction model function may be predefined. For example, the friction parameter correcting unit 28 may determine the adjustment range of the parameter of the friction model function based on the result of the position error measured in step S16.

[0099] In step S18 of updating the parameters of the friction model function, the friction parameter storage unit 26 stores the friction model function (or friction parameter) determined to be appropriate in step S16 or the friction model function whose parameters are corrected in step S17 (or corrected friction parameters) can be stored.

[0100] Then, the control unit 22 can use the positive feedback control method to use the frictional force (τ̂f) to compensate the frictional force effect in the direct teaching and force control mode of the cooperative robot 10.

[0101] For example, when the user moves the cooperative robot 10 in a situation where the user directly teaches, torque corresponding to the frictional force is applied to the joints, so that the user can move each joint of the cooperative robot 10 in a state similar to that almost no frictional force acts on each joint 12, 13, 14, 15, 16, and 17 in the cooperative robot 10.

[0102] In addition, according to the period of use of the cooperative robot 10, the friction characteristics change due to wear of the drive system, etc., even after completing the setting according to the friction force compensation during the initial setting of the cooperative robot 10, and the driving precision or ease of use of the cooperative robot 10 is often poor as the usage period of the cooperative robot 10 increases, according to the friction compensation system for a multi-degree-of-freedom cooperative robot and a friction compensation method for a multi-degree-of-freedom cooperative robot according to an embodiment of the present invention. According to the system for compensating for friction of multi-degree-of-freedom cooperative robot and the method for compensating for friction of multi-degree-of-freedom cooperative robot according to an embodiment of the present invention, since the friction compensation function (or friction parameter) of the cooperative robot 10 can be newly updated at any time, the driving precision and ease of use of the cooperative robot 10 can be continuously maintained.

[0103] FIG. 4 is a flowchart illustrating the method for compensating for friction of multi-degree-of-freedom cooperative robot according to another embodiment of the present invention.

[0104] The friction compensation method of the multiple degree of freedom cooperative robot according to another embodiment of the present invention is the same as the method for compensating for friction of multi-degree-of-freedom cooperative robot shown in FIG. 3 and the steps S11 to S18 are the same.

[0105] However, as shown in FIG. 4, in the method for compensating for friction of multi-degree-of-freedom cooperative robot according to another embodiment of the present invention, the friction parameter correction unit 28 adjusts the constant value of the friction model function in the step S17 of correcting the parameters of the friction model function, and proceeds to the step S15 of driving the cooperative robot by applying the friction model function again.

[0106] Accordingly, in step S15, the control unit 22 drives each joint 12, 13, 14, 15, 16, 17 of the cooperative robot 10 by applying the friction model function with the new constant value adjusted, and in step S16, the adequacy of the friction model function whose constant value is adjusted is determined based on the result. If the evaluation result of the friction model function in step S16 is less than a certain standard again, steps S15 and S16 are performed after step S17 is performed again, and these operations are repeated until the evaluation result of the friction model function whose constant value is adjusted exceeds a certain standard.

[0107] If it is determined in step S16 that the evaluation result of the friction model function is equal to or greater than a predetermined criterion, the process proceeds to step S18 and the friction parameter storage unit 26 finally stores the friction model function (or friction parameter).

[0108] Those of ordinary skill in the art to which the present invention pertains will understand that the present invention may be embodied in other specific forms without changing the technical spirit or essential features thereof. Therefore, it should be understood that the embodiments described above are illustrative in all respects and not restrictive. The scope of the present invention is indicated by the following claims rather than the above detailed description, and all changes or modifications derived from the meaning and scope of the claims and their equivalents should be construed as being included in the scope of the present invention.


Claims

1. A method for compensating for friction of a multi-degree-of-freedom cooperative robot including a plurality of joints, the method for compensating for friction of multi-degree-of-freedom cooperative robot comprising steps of:

generating motion of the cooperative robot for friction compensation;

driving the plurality of joints on the basis of the generated motion of the cooperative robot;

receiving friction identification data from the cooperative robot; and

calculating a friction model function from the received friction identification data.


 
2. The method according to claim 1, wherein the step of generating motion of the cooperative robot comprises the step of generating a posture in which the effect of gravity is removed.
 
3. The method according to claim 2, wherein the step of generating motion of the cooperative robot comprises the step of generating a motion for removing an inertial effect.
 
4. The method according to claim 1, wherein the step of generating motion of the cooperative robot comprises the step of generating a motion for controlling the effect of a Coriolis force.
 
5. The method according to claim 1, wherein the friction identification data comprises angle information of a plurality of joints, torque-related information acting on the plurality of joints, and temperature information of an actuator that drives the plurality of joints.
 
6. The method according to claim 1, wherein the step of calculating a friction model function comprises the step of identifying static friction, kinetic friction, and viscous friction acting on the plurality of joints based on the friction identification data.
 
7. The method according to claim 6, wherein the method comprises the step of:

using real-time data of the friction identification data to identify the static friction and the kinetic friction; and

using average data of the friction identification data to identify the viscous friction.


 
8. The method according to claim 1, wherein the variable of the friction model function comprises a driving speed of the plurality of joints.
 
9. The method according to claim 8,

wherein the friction identification data comprises temperature information of an actuator that drives the plurality of joints, and

wherein the variable of the friction model function further comprises the temperature information.


 
10. The method according to claim 1, wherein the method further comprises the steps of:

driving the plurality of joints by applying the calculated friction model function; and

evaluating the friction model function based on the position error of the cooperative robot.


 
11. The method according to claim 10, wherein the method comprises the step of compensating the parameters of the friction model function based on the result of the step of evaluating the friction model function.
 




Drawing
















Search report