Robot operation regulation and control method, electronic equipment and robot

By acquiring robot parameters and operating condition information, and using a dynamic model to pre-regulate the torque information of the robot joints, the problem of lag in robot speed control was solved, and the safety protection of the motor and the improvement of operational stability were achieved.

CN118952207AActive Publication Date: 2024-11-15GREE ELECTRIC APPLIANCE INC OF ZHUHAI

Patent Information

Application Number
CN202411202810.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-29
Publication Date
2024-11-15
Estimated Expiration
2044-08-29

AI Technical Summary

Technical Problem

In existing technologies, the speed control of robots is lagging, which cannot meet the needs of pre-control, leading to unstable robot operation and the risk of motor overload.

Method used

By acquiring robot parameter information and operating condition information, torque information is pre-simulated and determined using a dynamic model, and the running speed and acceleration of the robot joints are adjusted according to the torque information to protect motor safety.

Benefits of technology

It enables precise pre-control of robot operating speed and acceleration, protects motor safety, and improves the stability of robot operation and the service life of motors.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118952207A_ABST
    Figure CN118952207A_ABST
Patent Text Reader

Abstract

The invention provides a robot operation regulation and control method, electronic equipment and a robot, and the method comprises the steps: obtaining the parameter information and working condition information of a target robot, the parameter information comprises the arm length of a target joint of the target robot, the reduction ratio, the motor rated torque corresponding to the target joint, and the motor torque limit value; the working condition information comprises the load mass and the motion trail of the load; torque information of a target joint in the process that the target robot executes the target task is determined on the basis of a kinetic model according to the parameter information and the working condition information, and the torque information comprises the maximum torque and / or the average torque; according to the torque information, the operation parameters of the target joint of the target robot are regulated and controlled, the operation parameters comprise the operation speed and / or the operation acceleration, and the operation speed and / or the operation acceleration of the target joint of the target robot can be regulated and controlled in advance so as to protect operation safety of a motor corresponding to the target joint; efficiency of the motor corresponding to the target joint is exerted.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of robots, and in particular to a robot operation control method, electronic equipment and a robot. Background Art

[0002] At present, robots have been widely used in various production and life fields for the purpose of improving production efficiency, reducing production costs, improving product quality and ensuring worker safety. As the application scenarios of robots are extremely complex and diverse, the demand for robot control accuracy has also increased.

[0003] Most of the related technologies use closed-loop control to regulate the speed of the robot. The above-mentioned regulation method has lag and cannot meet the demand for pre-regulation of the robot's running speed. Summary of the invention

[0004] The embodiment of the present application provides a robot operation control method, electronic device and robot. The present application can achieve the pre-simulation and determination of the torque information of the robot in the process of performing the task before the robot performs the task, and then pre-control the operation speed of the robot according to the torque information to protect the operation safety of the motor corresponding to the target joint and give full play to the efficiency of the motor corresponding to the target joint.

[0005] In a first aspect, the present application proposes a robot operation control method, comprising: obtaining parameter information and operating condition information of a target robot, wherein the parameter information includes: the arm length of a target joint of the target robot, the reduction ratio, the rated torque of the motor corresponding to the target joint, and the motor torque limit, and the operating condition information includes: the load mass and the motion trajectory of the load; based on a dynamic model, determining the torque information of the target joint during the target robot's execution of a target task according to the parameter information and the operating condition information, wherein the torque information includes: maximum torque and / or average torque; according to the torque information, regulating the operating parameters of the target joint of the target robot, wherein the operating parameters include: operating speed and / or operating acceleration.

[0006] In some feasible implementations, determining the torque information of the target joint when the target robot performs a target task based on the dynamic model according to the parameter information and the operating condition information includes: determining the moment of inertia, eccentricity and motion trajectory of the target joint according to the parameter information and the operating condition information; determining the torque information based on the load mass, moment of inertia, eccentricity and motion trajectory of the target joint according to the dynamic model.

[0007] In some feasible embodiments, according to the torque information, regulating the operating parameters of the target joint of the target robot includes: when the maximum torque is greater than the motor torque limit, reducing the operating speed and / or operating acceleration of the target joint according to the maximum torque and the motor torque limit so that the maximum torque is less than or equal to the motor torque limit.

[0008] In some feasible embodiments, the above method also includes: obtaining the target joint torque limit; determining the speed control ratio parameter and / or the acceleration control ratio parameter based on the maximum torque, the motor torque limit and the target joint torque limit; reducing the running speed of the target joint according to the speed control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; and / or, reducing the running acceleration of the target joint according to the acceleration control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; wherein the acceleration control ratio parameter is the square of the speed control ratio parameter.

[0009] In some feasible embodiments, regulating the operating parameters of the target joint of the target robot according to the torque information also includes: when the average torque is greater than the motor torque limit, reducing the operating speed and / or operating acceleration of the target joint according to the average torque and the motor torque limit so that the average torque is less than or equal to the motor torque limit.

[0010] In some feasible embodiments, the above method also includes: determining a speed control proportional parameter and / or an acceleration control proportional parameter based on the motor rated torque and the motor torque limit; reducing the operating speed of the target joint according to the speed control proportional parameter so that the average torque is less than or equal to the motor torque limit; and / or reducing the operating acceleration of the target joint according to the acceleration control proportional parameter so that the average torque is less than or equal to the motor torque limit; wherein the acceleration control proportional parameter is the square of the speed control proportional parameter.

[0011] In some feasible embodiments, the above method also includes: in the case where the maximum torque and / or average torque of at least two target joints is greater than the motor torque limit, reducing the running speed of at least two target joints according to the smaller value of the speed control proportional parameters corresponding to the at least two target joints; and / or reducing the running acceleration of at least two target joints according to the smaller value of the acceleration control proportional parameters corresponding to the at least two target joints.

[0012] In some feasible embodiments, regulating the operating parameters of the target joint of the target robot according to the torque information also includes: when the difference between the motor torque limit and the maximum torque is greater than a first preset threshold, increasing the operating speed and / or operating acceleration of the target joint according to the difference so that the difference is less than or equal to the first preset threshold.

[0013] In a second aspect, the present application proposes an electronic device, comprising a processor and a memory, wherein the memory stores computer program instructions, and the computer program instructions are used by the processor to execute the robot operation control method as described in any one of the above items when the processor is running.

[0014] In a third aspect, the present application proposes a robot, which adopts the robot operation control method as described in any of the above items, or has the electronic device as described above.

[0015] The robot operation control method, electronic device and robot proposed in the present application obtain parameter information and working condition information of the target robot, wherein the parameter information includes: the arm length of the target joint of the target robot, the reduction ratio, the rated torque of the motor corresponding to the target joint and the motor torque limit, and the working condition information includes: the load mass and the motion trajectory of the load; based on the dynamic model, according to the parameter information and the working condition information, determine the torque information of the target joint during the target robot's execution of the target task, wherein the torque information includes: the maximum torque and / or the average torque; according to the torque information, control the operation parameters of the target joint of the target robot, wherein the operation parameters include: the operation speed and / or the operation acceleration, so that the average torque information and / or the maximum torque information of each target joint during the target robot's execution of the target task can be accurately predicted according to the parameter information and the working condition information of the target robot, and then the operation speed and / or the operation acceleration of the target joint of the target robot can be accurately pre-controlled according to the average torque information and / or the maximum torque information, so as to give full play to the efficiency of the motor corresponding to the target joint while protecting the operation safety of the motor corresponding to the target joint.

[0016] Other advantages, objectives and features of the present application will be reflected in part through the following description, and in part will be understood by those skilled in the art through study and practice of the present application. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] Various other advantages and benefits will become apparent to those of ordinary skill in the art by reading the detailed description of the exemplary embodiments below. The accompanying drawings are only for the purpose of illustrating exemplary embodiments and are not to be considered as limiting the present application. Also, the same reference symbols are used throughout the accompanying drawings to represent the same components. In the accompanying drawings:

[0018] Figure 1 A schematic diagram of a process of a robot operation control method provided in an embodiment of the present application;

[0019] Figure 2 A schematic diagram of another process of a robot operation control method provided in an embodiment of the present application;

[0020] Figure 3A schematic diagram of a process of another robot operation control method provided in an embodiment of the present application;

[0021] Figure 4 A structural schematic diagram of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0022] In order to better understand the technical solutions provided by the embodiments of this specification, the technical solutions of the embodiments of this specification are described in detail below through the accompanying drawings and specific embodiments. It should be understood that the embodiments of this specification and the specific features in the embodiments are detailed descriptions of the technical solutions of the embodiments of this specification, rather than limitations on the technical solutions of this specification. In the absence of conflict, the embodiments of this specification and the technical features in the embodiments can be combined with each other.

[0023] In this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply that there is any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that the process, method, article or equipment including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or equipment. In the absence of more restrictions, the elements limited by the statement "comprise one..." do not exclude the existence of other identical elements in the process, method, article or equipment including the elements. The term "more than two" includes two or more than two situations.

[0024] At present, as industrial robots are widely used in various production fields, their importance in high-precision assembly application scenarios is becoming increasingly apparent. However, most related technologies use closed-loop control to control the speed of the robot. The above control method has lag and cannot meet the demand for pre-control of the robot's running speed.

[0025] In view of this, the embodiments of the present application provide a robot operation control method, an electronic device and a robot, which can pre-simulate and determine the torque information of the robot during the task execution before the robot performs the task, and then pre-control the operation speed of the robot according to the torque information to protect the operation safety of the motor corresponding to the target joint and give full play to the efficiency of the motor corresponding to the target joint.

[0026] According to the first aspect of the embodiments of the present application, the present application proposes a robot operation control method. Figure 1 The following is a flow chart of a robot operation control method 100 provided in an embodiment of the present application. Figure 1As shown, the method 100 may include the following steps:

[0027] Step S110, obtaining parameter information and working condition information of the target robot, wherein the parameter information includes: the arm length of the target joint of the target robot, the reduction ratio, the motor rated torque corresponding to the target joint and the motor torque limit, and the working condition information includes: the load mass and the motion trajectory of the load.

[0028] It should be noted that the above parameter information may also include model information, brand information, etc. of the target robot. The above working condition information may also include task type information of the target task, geometric shape information of the load, and mass distribution information of the load.

[0029] In some feasible implementations, the arm length, reduction ratio, rated torque of the motor corresponding to the target joint, and motor torque limit of the target robot's target joint can be determined by cloud-based query based on the model information, brand information, etc. of the target robot. Exemplarily, the arm length, reduction ratio, and model information and brand information of the motor corresponding to the target joint of the target robot can be determined based on the model information, brand information, etc. of the target robot, and then the rated torque of the motor corresponding to the target joint and the motor torque limit can be determined by cloud-based query based on the model information and brand information of the motor corresponding to the target joint. The above-mentioned load mass and the motion trajectory of the load can be determined based on the task type information of the target task.

[0030] In some feasible implementations, the above parameter information and operating condition information may also be determined by simulation based on a simulation model.

[0031] Step S120, determining the torque information of the target joint when the target robot performs the target task based on the dynamic model according to the parameter information and the working condition information, wherein the torque information includes: maximum torque and / or average torque.

[0032] In some feasible embodiments, the above-mentioned dynamic model can be established according to the dynamic equation based on the parameter information and the working condition information. The above-mentioned dynamic model can simulate and output the maximum torque and / or average torque required by the target joint of the target robot to perform the target task according to the arm length, reduction ratio, load mass and motion trajectory of the load of the target joint of the target robot. Exemplarily, the above-mentioned dynamic model can simulate and output the torque curve required by the target joint of the target robot to perform the target task, and then determine the above-mentioned maximum torque and / or average torque based on the torque curve.

[0033] Among them, the above-mentioned dynamic model can be stored in the interpolation module in the operating program of the target robot for automatic control of the target robot. The above-mentioned dynamic model can also be stored in the background control system of the target robot to facilitate technicians to view and correct the operation of the target robot in real time.

[0034] Step S130, regulating the operating parameters of the target joint of the target robot according to the torque information, wherein the operating parameters include: operating speed and / or operating acceleration.

[0035] In some feasible implementations, the above-mentioned running speed may include running linear speed and running angular speed, and the above-mentioned running acceleration may include running linear acceleration and running angular acceleration. Exemplarily, the maximum torque and / or average torque may be compared with the motor torque limit or the maximum torque and / or average torque may be compared with the motor rated torque, and the running speed and / or running acceleration of the target joint of the target robot may be increased or decreased according to the comparison result.

[0036] Based on this, the robot operation control method proposed in the present application obtains the parameter information and working condition information of the target robot, wherein the parameter information includes: the arm length of the target joint of the target robot, the reduction ratio, the rated torque of the motor corresponding to the target joint and the motor torque limit, and the working condition information includes: the load mass and the motion trajectory of the load; based on the dynamic model, according to the parameter information and the working condition information, the torque information of the target joint during the target robot's execution of the target task can be accurately predicted and determined, wherein the torque information includes: maximum torque and / or average torque; then, based on the torque information, without additionally changing the operating trajectory of the target joint of the target robot, the operating speed and / or operating acceleration of the target joint of the target robot is pre-regulated to protect the operating safety of the motor corresponding to the target joint and give full play to the efficiency of the motor corresponding to the target joint.

[0037] Figure 2 A schematic diagram of another process of a robot operation control method provided in an embodiment of the present application. Figure 2 As shown, in some feasible implementations, step S120, determining the torque information of the target joint during the target robot performing the target task based on the dynamic model according to the parameter information and the working condition information may include:

[0038] Step S121, determining the moment of inertia, eccentricity and motion trajectory of the target joint according to the parameter information and the working condition information.

[0039] Exemplarily, the working condition information may also include task type information of the target task, geometric shape information of the load, mass distribution information of the load, etc. The moment of inertia may be determined based on the mass of the load, the geometric shape of the load, the mass distribution of the load, and the distance from the rotation center line of the load to the target rotation axis of the target robot during the target robot's execution of the target task.

[0040] The above-mentioned eccentricity can be determined by establishing a coordinate system. Exemplarily, a coordinate system can be established according to the parameter information of the target robot, and the joint origin of the target robot with a smaller degree of freedom or the fixed end in the target robot joint is used as the origin of the coordinate system, and the horizontal movement direction of the target robot is used as the first coordinate axis direction, and the direction perpendicular to the ground is used as the third coordinate system direction. According to the first coordinate axis direction and the third coordinate axis direction based on the right-hand rule, the second coordinate axis direction is determined. Specifically, taking the SCARA robot as an example, when each target joint of the above-mentioned target robot is in zero position, that is, the SCARA robot is in a straight arm state, the straight arm origin is the coordinate axis origin, the end of the J4 axis of the SCARA robot along the straight arm direction is the first coordinate axis direction, and the direction perpendicular to the ground is the third coordinate axis direction. According to the first coordinate axis direction and the third coordinate axis direction based on the right-hand rule, the second coordinate axis direction is determined. After the robot completes the establishment of the coordinate system based on the preset program algorithm, the above eccentricity can be determined based on the eccentricity between the load rotation center and the first coordinate axis and the eccentricity between the load rotation center line and the second coordinate axis, wherein the above eccentricity is the composite of the eccentricity in the first coordinate axis and the eccentricity in the second coordinate axis. Specifically, the eccentricity in the first coordinate axis can be determined based on the first coordinate of the load rotation center, and the eccentricity in the second coordinate axis can be determined based on the second coordinate of the load rotation center. It should be noted that the above coordinate system establishment method can be determined based on the motion trajectory information of the load or the motion trajectory information of the target joint, and is not specifically limited here.

[0041] The motion trajectory information of the target joint can be determined based on the motion trajectory information of the load in the target task, the geometric shape information of the load, and the mass distribution information of the load.

[0042] Step S122, determining torque information based on a dynamic model according to load mass, moment of inertia, eccentricity, and motion trajectory of the target joint.

[0043] In some feasible embodiments, the maximum torque and / or average torque of the target joint during the execution of the target task can be predicted based on the dynamic model according to the load mass, moment of inertia, eccentricity and motion trajectory of the target joint, and then the operating speed and / or operating acceleration of the target joint of the target robot can be regulated according to the above maximum torque and / or average torque.

[0044] Based on this, the above method can accurately predict the moment of inertia, eccentricity and motion trajectory of the target joint according to parameter information and working condition information, and then based on the dynamic model, accurately predict the maximum torque and / or average torque of the target joint during the execution of the target task according to the load mass, moment of inertia, eccentricity and motion trajectory of the target joint, so as to provide accurate data support for regulating the operating speed and / or operating acceleration of each target joint in the process of the target robot performing the above target task according to the above maximum torque and / or average torque, thereby improving the control accuracy of the operating speed and / or operating acceleration of the target joint of the target robot while protecting the operating safety of the motor corresponding to the target joint and giving full play to the effectiveness of the motor corresponding to the target joint.

[0045] Figure 3 A schematic diagram of a process of another robot operation control method provided in an embodiment of the present application. Figure 3 As shown, in some feasible implementations, step S130, adjusting the operating parameters of the target joint of the target robot according to the torque information may include:

[0046] Step S131, when the maximum torque is greater than the motor torque limit, the operating speed and / or operating acceleration of the target joint is reduced according to the maximum torque and the motor torque limit so that the maximum torque is less than or equal to the motor torque limit.

[0047] Exemplarily, when the above-mentioned maximum torque is greater than the above-mentioned motor torque limit, the operating speed and / or operating acceleration of the target joint can be controlled to be reduced based on the torque output curve of the motor corresponding to the target joint according to the above-mentioned maximum torque and the above-mentioned motor torque limit, so that the above-mentioned maximum torque is less than or equal to the above-mentioned motor torque limit.

[0048] Based on this, the above method can avoid overloading of the motor corresponding to the target joint when the target robot is performing the target task by reducing the operating speed and / or operating acceleration of the target joint according to the maximum torque and the motor torque limit so that the maximum torque is less than or equal to the motor torque limit when the maximum torque is greater than the motor torque limit, thereby reducing the failure rate of the motor corresponding to each target joint of the target robot, extending the service life of the motor corresponding to each target joint of the target robot, and improving the safety of the target robot during operation.

[0049] In some feasible implementations, the speed of the target joint can be regulated when the maximum torque has not yet reached the motor torque limit, so as to achieve further pre-protection of the motor. Specifically, when the difference between the maximum torque required for the target joint to run to the target position or target moment and the motor torque limit is less than or equal to the motor torque preset threshold, the running speed and / or running acceleration of the above-mentioned target joint at the target position or target moment is reduced, so that the difference between the maximum torque required for the above-mentioned target joint to run to the target position or target moment and the motor torque limit is greater than the motor torque preset threshold, so as to further prevent the motor from being overloaded. Among them, the above-mentioned motor torque preset threshold can be determined according to the user's protection requirements for the motor corresponding to the target joint of the target robot. Specifically, the above-mentioned motor torque preset threshold is negatively correlated with the above-mentioned user's protection requirements for the target robot motor, that is, the higher the user's protection requirements for the target robot motor, the smaller the above-mentioned motor torque preset threshold.

[0050] In some feasible embodiments, the above method also includes: obtaining the target joint torque limit; determining the speed control ratio parameter and / or the acceleration control ratio parameter based on the maximum torque, the motor torque limit and the target joint torque limit; reducing the running speed of the target joint according to the speed control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; and / or, reducing the running acceleration of the target joint according to the acceleration control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; wherein the acceleration control ratio parameter is the square of the speed control ratio parameter.

[0051] In some feasible implementations, the above target joint torque limit may be determined based on the following formula:

[0052]

[0053] Where C is the target joint torque limit, Q N is the target joint torque, n N is the target joint reduction ratio, J Nm is the moment of inertia of the motor shaft component of the target joint, is the target joint acceleration limit.

[0054] For example, taking a SCARA robot as an example, when the target joint is the first joint, the target joint torque can be determined based on the following formula:

[0055]

[0056] Where Q1 is the first joint torque, I c1 is the moment of inertia at the center of mass of the first joint, I c2is the moment of inertia at the center of mass of the second joint, m1 is the mass of the first joint, l b1 is the distance between the center of mass of the axis corresponding to the first joint and the center point of the first joint, m2 is the mass of the second joint, l1 is the arm length of the first joint, l b2 is the distance between the center of mass of the axis corresponding to the second joint and the center point of the second target joint, θ2 is the angle of the second joint, is the acceleration of the first joint, is the acceleration of the second joint, is the velocity of the first joint, is the velocity of the second joint.

[0057] When the target joint is the second joint, the target joint torque can be determined based on the following formula:

[0058]

[0059] Where Q2 is the second joint torque, I c2 is the moment of inertia at the center of mass of the second joint, m2 is the mass of the second joint, l b2 is the distance between the center of mass of the axis corresponding to the second joint and the center point of the second joint, l1 is the arm length of the first joint, θ2 is the angle of the second joint, is the acceleration of the first joint, is the acceleration of the second joint, is the velocity of the first joint.

[0060] In some feasible implementations, the speed control ratio parameter may be determined based on the following formula:

[0061] K=sqrt(1-(Tmax-Tlim) / C) (4)

[0062] Among them, K is the speed control ratio parameter, Tmax is the maximum torque, Tlim is the motor torque limit, and C is the target joint torque limit.

[0063] In some feasible implementations, the acceleration control proportional parameter may be determined based on the following formula:

[0064] K a =1-(Tmax-Tlim) / C (5)

[0065] Among them, K a is the acceleration control proportional parameter, Tmax is the maximum torque, Tlim is the motor torque limit, and C is the target joint torque limit.

[0066] In some feasible embodiments, when the maximum torque is greater than the motor torque limit, the running speed of the target joint can be controlled to be reduced to a target speed, wherein the target speed is the product of the current speed and the speed control proportional parameter, and / or the running acceleration of the target joint can be controlled to be reduced to a target acceleration, wherein the target acceleration is the product of the current acceleration and the acceleration control proportional parameter.

[0067] Based on this, the present application accurately determines the speed control proportional parameters and / or acceleration control proportional parameters of the target joint according to the maximum torque, the motor torque limit and the target joint torque limit. When the maximum torque is greater than the motor torque limit, the speed of the target joint is accurately reduced to the target speed according to the above-mentioned speed control proportional parameters, and / or the acceleration of the target speed is accurately reduced to the target acceleration according to the above-mentioned acceleration control proportional parameters, so that the maximum torque is less than or equal to the motor torque limit. This can achieve pre-targeted control of the speed and / or acceleration of the target position or target time during the execution of the target task by the target robot, so as to ensure that the operating torque of the motor corresponding to the target joint of the target robot is less than or equal to the motor limit during the execution of the target task, thereby increasing the operating safety of the motor corresponding to the target joint.

[0068] In some feasible implementations, step S130, adjusting the operating parameters of the target joint of the target robot according to the torque information may also include:

[0069] Step S132, when the average torque is greater than the motor torque limit, reduce the running speed and / or running acceleration of the target joint according to the average torque and the motor torque limit so that the average torque is less than or equal to the motor torque limit.

[0070] Exemplarily, when the above-mentioned average torque is greater than the above-mentioned motor torque limit, the operating speed and / or operating acceleration of the target joint can be reduced based on the torque output curve of the motor corresponding to the above-mentioned target joint according to the above-mentioned average torque and the motor torque limit, so that the above-mentioned average torque is less than or equal to the above-mentioned motor torque limit.

[0071] Based on this, when the average torque is greater than the motor torque limit, the above method reduces the running speed and / or running acceleration of the target joint according to the average torque and the motor torque limit so that the average torque is less than or equal to the motor torque limit. This can avoid load damage, bumps, etc. caused by unstable motor operation at the target position or target time while ensuring the safe operation of the motor corresponding to the target joint, thereby improving the stability of the target joint in the process of executing the target task, ensuring the stable operation of the target robot, and improving the safety of the load during movement.

[0072] In some feasible implementations, in order to ensure the smooth operation of the target robot, the running speed of the target joint can be regulated based on the torque output curve of the motor corresponding to the above target joint according to the average torque, the rated torque of the motor and the motor torque limit, when the average torque has not yet reached the motor torque limit. Specifically, when the average torque is greater than the rated torque of the motor and less than or equal to the motor torque limit, the running speed and / or running acceleration of the above target joint at the target position or target time is reduced so that the above average torque is less than or equal to the rated torque of the motor, so as to improve the stable operation ability of the target joint of the target robot and improve the service life of the target joint of the target robot.

[0073] In some feasible embodiments, the above method also includes: determining a speed control proportional parameter and / or an acceleration control proportional parameter based on the motor rated torque and the motor torque limit; reducing the operating speed of the target joint according to the speed control proportional parameter so that the average torque is less than or equal to the motor torque limit; and / or reducing the operating acceleration of the target joint according to the acceleration control proportional parameter so that the average torque is less than or equal to the motor torque limit; wherein the acceleration control proportional parameter is the square of the speed control proportional parameter.

[0074] Exemplarily, the motor rated torque and the motor torque limit can be determined according to parameter information, based on cloud query such as model information of the target robot and brand information of the motor.

[0075] In some feasible implementations, the speed control ratio parameter may be determined based on the following formula:

[0076]

[0077] Among them, K is the speed control ratio parameter, K o is the first parameter, T mean is the preset multiple of the motor rated torque, T r is the motor torque limit, and A is the second parameter.

[0078] It should be noted that the motor torque limit is equal to the motor torque limit. The preset multiple can be customized by the user according to actual needs, and specifically, can be 1.15.

[0079] Among them, the first parameter K o It can be determined according to the following formula:

[0080]

[0081] Among them, K o is the first parameter, T mean is the preset multiple of the motor rated torque, T ris the motor torque limit, and A is the second parameter. It should be noted that the motor torque limit is equal to the motor torque limit. The preset multiple can be customized by the user according to actual needs, and specifically, can be 1.15.

[0082] The second parameter can be determined according to the following formula:

[0083]

[0084] Wherein, A is the second parameter, T(t) is the torque value at each instant, N is the discrete interpolation time, and i is the time node corresponding to the completion of interpolation from 0.

[0085] In some feasible implementations, the target running speed can be determined according to the speed control ratio parameter, wherein the target running speed is the product of the running speed at the target position or target moment and the speed control ratio parameter, and the running speed of the target joint at the target position or target moment is reduced to the target speed, so that the average torque is less than or equal to the motor torque limit. And / or, the target running acceleration is determined according to the acceleration control ratio parameter, wherein the target running acceleration is the product of the running acceleration at the target position or target moment and the acceleration control ratio parameter, and the running acceleration at the target position or target moment is reduced to the target acceleration, so that the average torque is less than or equal to the motor torque limit.

[0086] Based on this, the above method can accurately determine the speed control ratio parameter and / or the acceleration control ratio parameter according to the motor rated torque and the motor torque limit when the average torque is greater than the motor torque limit; accurately reduce the operating speed of the target joint to the target operating speed according to the speed control ratio parameter, so that the average torque is less than or equal to the motor torque limit; and / or reduce the operating acceleration of the target joint to the target acceleration according to the acceleration control ratio parameter, so that the average torque is less than or equal to the motor torque limit, thereby achieving pre-targeted control of the speed and / or acceleration corresponding to the target time or target position during the target robot's execution of the target task, improving the design accuracy of the target joint's operating speed and / or operating acceleration during the target robot's execution of the above-mentioned target task, avoiding motor overload during the target robot's execution of the task, reducing the probability of hardware damage to the target robot, extending the service life of the target robot, and ensuring the stable execution of subsequent target tasks.

[0087] In some feasible embodiments, the above method also includes: in the case where the maximum torque and / or average torque of at least two target joints is greater than the motor torque limit, reducing the running speed of at least two target joints according to the smaller value of the speed control proportional parameters corresponding to the at least two target joints; and / or reducing the running acceleration of at least two target joints according to the smaller value of the acceleration control proportional parameters corresponding to the at least two target joints.

[0088] Exemplarily, when the target robot is performing the above-mentioned target task and there is a physical connection or motion connection between the target joints, in order to improve the continuity of the mutual movement between the target joints and improve the smoothness of the target robot in performing the target task, when there are at least two target joints whose maximum torque is greater than the motor torque limit and / or whose average torque is greater than the motor rated torque, the operating speed of the at least two target joints is reduced according to the smaller value of the speed control proportional parameters corresponding to the at least two target joints, and / or the operating acceleration of the at least two target joints is reduced according to the smaller value of the acceleration control proportional parameters corresponding to the at least two target joints, so that the maximum torque of the at least two target joints is less than or equal to the motor torque limit, and the average torque is less than or equal to the motor torque limit.

[0089] Based on this, the above method reduces the running speed of at least two target joints according to the smaller value of the speed control proportional parameters corresponding to the at least two target joints when the maximum torque and / or average torque of at least two target joints is greater than the motor torque limit; and / or reduces the running acceleration of at least two target joints according to the smaller value of the acceleration control proportional parameters corresponding to the at least two target joints, which is beneficial to maintaining the consistency of the speed reduction gradients of the at least two target joints, reducing the probability of large relative friction between the at least two target joints due to large speed regulation differences, and improving the stability of the target robot in the process of performing the target task.

[0090] In some feasible implementations, step S130, regulating the operating parameters of the target joint of the target robot according to the torque information may also include:

[0091] Step S133, when the difference between the motor torque limit and the maximum torque is greater than the first preset threshold, the running speed and running acceleration of the target joint are increased according to the difference so that the difference is less than or equal to the first preset threshold.

[0092] Exemplarily, the first preset threshold can be determined based on the user's protection requirements for the motor corresponding to the target joint of the target robot. Specifically, the first preset threshold is positively correlated with the user's protection requirements for the target robot motor, that is, the higher the user's protection requirements for the target robot motor, the larger the first preset threshold. It is understandable that the first preset thresholds corresponding to different target joint motors can be set separately according to the user's protection requirements for different target joints or the probability that different joint motors are prone to overload.

[0093] In some feasible embodiments, during the operation of the target joint of the target robot, when the maximum torque determined by simulation is less than the motor torque limit, and the difference between the motor torque limit and the maximum torque is large, that is, when the difference between the motor torque limit and the maximum torque is greater than a first preset threshold, the operating speed and acceleration of the target joint can be increased according to the above difference so that the above difference is less than or equal to the first preset threshold, so as to give full play to the performance of the motor corresponding to the target joint and improve the efficiency of completing the target task.

[0094] Based on this, the above method can fully utilize the performance of the motor corresponding to the target joint and improve the efficiency of completing the target task by targetedly increasing the running speed and running acceleration of the target joint according to the difference between the motor torque limit and the maximum torque so that the difference is less than or equal to the first preset threshold when the difference between the motor torque limit and the maximum torque is greater than the first preset threshold.

[0095] According to a second aspect of the embodiments of the present application, the present application provides an electronic device. Figure 4 FIG. 1 is a structural diagram of an electronic device 300 provided in an embodiment of the present application. Figure 4 As shown, the electronic device 300 includes a processor 310 and a memory 320, wherein the memory 320 stores computer program instructions, and the computer program instructions are used by the processor 310 to execute the robot operation control method described in any one of the first aspects when the processor 310 is running.

[0096] According to a third aspect of an embodiment of the present application, the present application proposes a robot, which adopts the robot operation control method as described in any one of the above items, or has the electronic device as described above.

[0097] A person of ordinary skill in the art can understand the specific details and beneficial effects of the electronic device and the robot by reading the above description of the robot operation control method, which will not be elaborated here for the sake of brevity.

[0098] It should be noted that in the above embodiments, the description of each embodiment has its own emphasis, and for parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0099] The above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present application.

[0100] Although the preferred embodiments of this specification have been described, those skilled in the art may make additional changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications that fall within the scope of this specification.

[0101] Obviously, those skilled in the art can make various changes and modifications to this specification without departing from the spirit and scope of this specification. Thus, if these modifications and variations of this specification fall within the scope of the claims of this specification and their equivalents, this specification is also intended to include these modifications and variations.

Claims

1. A robot operation control method, characterized in that: include: Acquire parameter information and working condition information of the target robot, wherein the parameter information includes: arm length, reduction ratio, motor rated torque and motor torque limit corresponding to the target joint of the target robot, and the working condition information includes: load mass and motion trajectory of the load; Determine the torque information of the target joint during the target robot performing the target task based on the dynamic model according to the parameter information and the working condition information, wherein the torque information includes: maximum torque and / or average torque; According to the torque information, the operating parameters of the target joint of the target robot are adjusted, wherein the operating parameters include: operating speed and / or operating acceleration.

2. The robot operation control method according to claim 1, characterized in that: Determining the torque information of the target joint during the target robot performing the target task based on the dynamics model according to the parameter information and the working condition information includes: Determine the moment of inertia, eccentricity, and motion trajectory of the target joint according to the parameter information and the working condition information; The torque information is determined based on the dynamic model according to the load mass, the moment of inertia, the eccentricity and the motion trajectory of the target joint.

3. The robot operation control method according to claim 2, characterized in that: The step of regulating the operating parameters of the target joint of the target robot according to the torque information includes: When the maximum torque is greater than the motor torque limit, the operating speed and / or operating acceleration of the target joint is reduced according to the maximum torque and the motor torque limit so that the maximum torque is less than or equal to the motor torque limit.

4. The robot operation control method according to claim 3, characterized in that: Also includes: Get the target joint torque limit; Determining a speed control ratio parameter and / or an acceleration control ratio parameter according to the maximum torque, the motor torque limit and the target joint torque limit; reducing the operating speed of the target joint according to the speed control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; And / or, reducing the operating acceleration of the target joint according to the acceleration control ratio parameter so that the maximum torque is less than or equal to the motor torque limit; The acceleration control ratio parameter is the square of the speed control ratio parameter.

5. The robot operation control method according to claim 2, characterized in that: The step of regulating the operating parameters of the target joint of the target robot according to the torque information further includes: When the average torque is greater than the motor torque limit, the operating speed and / or operating acceleration of the target joint is reduced according to the average torque and the motor torque limit so that the average torque is less than or equal to the motor torque limit.

6. The robot operation control method according to claim 5, characterized in that: Also includes: Determining a speed control ratio parameter and / or an acceleration control ratio parameter according to the motor rated torque and the motor torque limit; reducing the operating speed of the target joint according to the speed control ratio parameter so that the average torque is less than or equal to the motor torque limit; and / or, reducing the operating acceleration of the target joint according to the acceleration control ratio parameter so that the average torque is less than or equal to the motor torque limit; The acceleration control ratio parameter is the square of the speed control ratio parameter.

7. The robot operation control method according to claim 6, characterized in that: Also includes: In the case where the maximum torque and / or the average torque of at least two target joints are greater than the motor torque limit, reducing the operating speeds of the at least two target joints according to the smaller value of the speed control ratio parameters corresponding to the at least two target joints; And / or, according to the smaller value of the acceleration control ratio parameters corresponding to the at least two target joints, the operating acceleration of the at least two target joints is reduced.

8. The robot operation control method according to any one of claims 3 to 7, characterized in that: The step of regulating the operating parameters of the target joint of the target robot according to the torque information further includes: When the difference between the motor torque limit and the maximum torque is greater than a first preset threshold, the operating speed and / or operating acceleration of the target joint is increased according to the difference so that the difference is less than or equal to the first preset threshold.

9. An electronic device, characterized in that: The electronic device includes a processor and a memory, wherein the memory stores computer program instructions, and the computer program instructions are used by the processor to execute the robot operation control method according to any one of claims 1 to 8 when the processor is running.

10. A robot, characterized in that: The robot adopts the robot operation control method as described in any one of claims 1 to 8, or has the electronic device as described in claim 9.

Citation Information

Patent Citations

  • Robot control method, robot control system and robot

    CN109732594A

  • Dynamic simulation method and device of mechanical arm, electronic equipment and storage medium

    CN112199827A

  • Collaborative robot system

    US20210114211A1

Cited By

  • Motion multiplying power adjusting method and device, robot and storage medium

    CN120572525A

  • Speed reducer performance comparison test method applied to humanoid robot

    CN121917221A