Motion control method of mechanical arm, electronic equipment and mechanical arm
By obtaining the working state parameters of the robot joint motor in real time and adjusting the motion parameters, the problems of excessive torque and excessive load rate of the robot during acceleration and deceleration are solved, and operating efficiency and stability are improved.
Patent Information
- Application Number
- CN202411177543.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-08-26
AI Technical Summary
The robotic arm cannot meet the actual working conditions during acceleration and deceleration, resulting in the joint motor torque exceeding the limit or the load rate is too high, affecting the operating efficiency and stability.
By obtaining the working state parameters of the joint motor in real time, such as instantaneous load rate and real-time bus voltage, comparing with the threshold, adjusting the motion parameters according to the motion adjustment strategy, and updating the acceleration and deceleration plan to adapt to the actual working conditions.
It realizes flexible and real-time adjustment of the robotic arm acceleration and deceleration planning, avoids motor alarm shutdown, improves operating efficiency and stability, and meets the needs of complex working conditions.
Smart Images

Figure CN118952203A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robotic arms, and in particular to a motion control method for a robotic arm, an electronic device, and a robotic arm. Background Art
[0002] With the development of automation technology, the application of robotic arms is becoming more and more extensive. How to complete the operation efficiently and smoothly has become an important issue. In a motion operation, if the acceleration and deceleration curve that best meets its actual needs can be selected during the acceleration and deceleration process, the efficiency and stability of the robotic arm / robot operation will be greatly improved.
[0003] Usually, the trajectory planning algorithm for the robot arm only considers the kinematic constraints of the robot arm such as speed and acceleration. This may cause the joint motor torque to exceed the limit when the robot arm runs the predetermined trajectory, or the load rate of the joint motor of the robot arm is too high, or even the motor alarm stops.
[0004] An invention has proposed a robot trajectory optimization method based on dynamics, which adds the dynamic constraints of the robot to the trajectory optimization algorithm to optimize the kinematic and dynamic parameters such as the robot joint speed, acceleration, and torque to avoid the problem of excessive torque of the joint motor. However, this aspect is based on the premise of accurate dynamic models and parameters, and it only solves the problem of excessive torque of the instantaneous joint motor, and still cannot meet the actual working conditions. Summary of the invention
[0005] The embodiments of the present application provide a motion control method for a robotic arm, an electronic device, and a robotic arm, so as to at least solve the technical problem that the robotic arm is difficult to meet the requirements of actual working conditions.
[0006] According to a first aspect of an embodiment of the present application, a motion control method for a robotic arm is provided, comprising:
[0007] During the movement of the robotic arm based on the acceleration and deceleration planning, the value of the working state parameter of the joint motor of the robotic arm is obtained in real time, and the working state parameter is used to reflect the real-time working state of the joint motor;
[0008] Comparing and judging the value of the working state parameter with the working state threshold, if the relationship between the two satisfies the motion parameter adjustment condition, adjusting the motion parameter of the robot arm according to the motion adjustment strategy, wherein the motion state adjustment strategy constrains the adjustment method of the motion parameter;
[0009] The acceleration and deceleration plan is updated according to the adjusted motion parameters.
[0010] By adopting this embodiment, the motion parameters of the robot arm can be adjusted in real time according to the real-time working state of the joint motor during the movement of the robot arm, so that the acceleration and deceleration planning of the robot arm meets the requirements of the actual working conditions. In other words, by adopting this embodiment, the acceleration and deceleration planning can be adjusted flexibly and in real time according to the real-time working conditions to meet the requirements of the actual working conditions.
[0011] In combination with the first aspect, in an optional implementation of the embodiment of the present application, the working state parameters of the joint motor include:
[0012] An instantaneous load rate reflecting the load condition of the joint motor; and / or,
[0013] The real-time bus voltage reflects the driving capability of the joint motor.
[0014] In combination with the first aspect, in an optional implementation of the embodiment of the present application, when the working state parameter is the instantaneous load rate, the real-time acquisition of the value of the working state parameter of the joint motor of the robotic arm includes:
[0015] Acquire in real time the instantaneous quadrature-axis current and the instantaneous direct-axis current of the joint motor during the movement of the robot arm;
[0016] The instantaneous load rate of the joint motor is calculated and determined according to the instantaneous quadrature-axis current, the instantaneous direct-axis current and the rated current of the joint motor.
[0017] In combination with the first aspect, in an optional implementation of the embodiment of the present application, when the working state parameter is the instantaneous load rate, the working state threshold is the instantaneous load rate threshold, and the motion parameter includes the acceleration of the joint motor;
[0018] If the relationship between the two satisfies the motion parameter adjustment condition, the motion parameters of the robot arm are adjusted according to the motion adjustment strategy, including:
[0019] If the instantaneous load rate exceeds the instantaneous load rate threshold, the relationship between the two satisfies the motion parameter adjustment condition, and the acceleration of the robot arm is adjusted in a decreasing direction.
[0020] In combination with the first aspect, in an optional implementation of the embodiment of the present application, if the instantaneous load rate exceeds the instantaneous load rate threshold, the relationship between the two satisfies the motion parameter adjustment condition, and the acceleration of the robotic arm is adjusted in a decreasing direction, including:
[0021] If N a >k1*N limit , then the relationship between the two satisfies the motion parameter adjustment condition, and adjust a a =k2*aa , where the N a represents the instantaneous load rate, the N limit Indicates the maximum limit of instantaneous load rate, k1*N limit represents the instantaneous load rate threshold, a a Indicates the current acceleration, k2*a a represents the acceleration after adjustment, k1 is a coefficient used to indicate at what level the acceleration is adjusted when the maximum limit of the instantaneous load rate is reached, k2 is a coefficient that can indicate the adjustment amplitude of the acceleration, and the larger k1 is, the smaller k2 is.
[0022] Among them, k1∈[0.85, 0.95], k2∈[0.8, 0.99]; or, k1=0.9, k2=0.9.
[0023] In combination with the first aspect, in an optional implementation of the embodiment of the present application, when the working state parameter is the real-time bus voltage, the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage;
[0024] The method further comprises:
[0025] Acquire the instantaneous quadrature-axis voltage and the instantaneous direct-axis voltage of the joint motor in real time during the movement of the robot arm,
[0026] The real-time theoretical bus voltage is calculated based on the instantaneous quadrature-axis voltage and the instantaneous direct-axis voltage.
[0027] In combination with the first aspect, in an optional implementation of the embodiment of the present application, when the working state parameter is the real-time bus voltage, the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage;
[0028] If the relationship between the two satisfies the motion parameter adjustment condition, the motion parameters of the robot arm are adjusted according to the motion adjustment strategy, including:
[0029] If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition, the acceleration in the motion parameter is adjusted in a decreasing direction,
[0030] If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition, the speed and acceleration of the motion parameters are adjusted simultaneously in a decreasing direction.
[0031] In combination with the first aspect, in an optional implementation of the embodiment of the present application, if the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition, adjusting the acceleration in the motion parameter in a decreasing direction includes:
[0032] If U a ≥U b >k3*U a , then the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition. At this time, adjust a b =k4*a b ;
[0033] Among them, U a Indicates the real-time bus voltage, U b represents the theoretical bus voltage, a b Indicates the current acceleration, k4*a b represents the acceleration after adjustment, k3 is a coefficient used to indicate at what level of the theoretical bus voltage the acceleration is adjusted, k4 is a coefficient that can indicate the adjustment amplitude of the acceleration, and the larger k3 is, the smaller k4 is.
[0034] Where, k3∈[0.92, 0.97], k4∈[0.9, 0.95]; or, k1=0.95, k2=1.95-U b / U a .
[0035] In combination with the first aspect, in an optional implementation of the embodiment of the present application, if the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition, the speed and acceleration in the motion parameter are adjusted simultaneously in a decreasing direction, including:
[0036] If U b >U a , then the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition. At this time, adjust a c =k5*a c , v c =k6*v c ;
[0037] Among them, U a Indicates the real-time bus voltage, U b represents the theoretical bus voltage, a c Indicates the current acceleration, k5*a c represents the acceleration after adjustment, v c Indicates the current speed, k6*v crepresents the speed after adjustment, k5 is a coefficient that can represent the adjustment range of the acceleration, and k6 is a coefficient that can represent the adjustment range of the current speed.
[0038] Where, k5∈[0.9, 0.95], k6∈[0.9, 0.95]; or, k5=1.95-U b / U a , k6=0.95.
[0039] In combination with the first aspect, in an optional implementation of an embodiment of the present application, the acceleration and deceleration plan is an acceleration and deceleration plan obtained by using a pre-interpolation method; or, the acceleration and deceleration plan is an acceleration and deceleration plan obtained by first using a pre-interpolation method and then performing dynamic constraints.
[0040] According to a second aspect of an embodiment of the present application, an electronic device is provided, the electronic device comprising:
[0041] a memory for storing one or more computer instructions;
[0042] The processor is used to call and execute the computer instructions to implement the motion control method described in the first aspect of the embodiment of the present application.
[0043] According to a third aspect of the embodiments of the present application, a robotic arm is provided, wherein the robotic arm adopts the motion control method of the first aspect of the embodiments of the present application, or the robotic arm has the electronic device of the second aspect of the embodiments of the present application.
[0044] The technical effects obtained by the above-mentioned second to third aspects are similar to the technical effects obtained by the technical scheme corresponding to the first aspect, and will not be repeated here. BRIEF DESCRIPTION OF THE DRAWINGS
[0045] Figure 1 is a flow chart of a motion control method of a robotic arm provided according to an embodiment of the present application;
[0046] Figure 2 is a flow chart of a motion control method of a robotic arm provided according to an embodiment of the present application;
[0047] Figure 3 It is a schematic diagram of a trapezoidal acceleration and deceleration planning provided according to an embodiment of the present application;
[0048] Figure 4 It is a schematic diagram of an electronic device applied to a robotic arm according to an embodiment of the present application. DETAILED DESCRIPTION
[0049] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present application.
[0050] It should be understood that the "plurality" mentioned in this article refers to two or more. In the description of the embodiments of the present application, unless otherwise specified, " / " means or, for example, A / B can mean A or B; "and / or" in this article is only a description of the association relationship of associated objects, indicating that there can be three relationships, for example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone. In addition, in order to facilitate the clear description of the technical solutions of the embodiments of the present application, in the embodiments of the present application, the words "first", "second" and so on are used to distinguish between the same items or similar items with basically the same functions and effects. Those skilled in the art can understand that the words "first", "second" and so on do not limit the quantity and execution order, and the words "first", "second" and so on do not limit certain different
[0051] In addition, the terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover non-exclusive inclusions. For example, a process, method, system, product, or apparatus that includes a series of steps or elements is not necessarily limited to those steps or elements explicitly listed, but may include other steps or elements not explicitly listed or inherent to such process, method, product, or apparatus.
[0052] First, the terms involved in the embodiments of the present application are introduced.
[0053] Joint motors: The joint motors of robots / robotic arms are key actuators in the robot drive system. They are responsible for converting electrical energy into mechanical energy to drive the movement of the robot joints. These motors play a vital role in robots, enabling them to perform a variety of complex movements and tasks. Common joint motors include AC servo motors, DC servo motors, stepper motors, and micro motors.
[0054] Torque control: Torque control of joint motors is an important aspect in robot control systems, which is directly related to the motion performance and accuracy of robot joints. In torque control mode, the motor controller adjusts the output torque of the motor according to the preset torque command or real-time feedback torque information, so that the robot joints can move in the desired manner. Torque control is widely used in various scenarios that require precise control of robot joint movement, for example, precision assembly: In precision assembly tasks, the torque of robot joints needs to be precisely controlled to ensure the accuracy and quality of assembly. Force feedback control: In scenarios of human-computer interaction or robot-environment interaction, force feedback control can be achieved through torque control to improve the safety and stability of the robot. Dynamic adjustment: When the robot performs complex dynamic tasks, such as walking, jumping, etc., it is necessary to adjust the torque of the joints in real time to maintain the balance and stability of the robot.
[0055] Acceleration and deceleration planning of the robot arm: Acceleration and deceleration planning refers to the process of pre-planning and controlling the acceleration and deceleration of the robot arm during movement according to the movement requirements of the robot arm. Its main purpose is to optimize the movement performance of the robot arm, reduce the impact and vibration during the movement, improve the movement accuracy and stability, and ensure that the robot arm can complete the task safely and reliably during the movement. There are many methods for acceleration and deceleration planning of the robot arm, the most common ones are S-type speed planning, polynomial planning, sinusoidal acceleration and deceleration planning, etc.
[0056] Pre-interpolation: In the robot motion control system, the planned path or trajectory is pre-calculated in a refined manner to generate a series of intermediate point sequences for actual control. These intermediate points contain information such as the position, speed, acceleration, etc. that the robot should reach during the motion process, ensuring that the robot can move smoothly and accurately along the predetermined trajectory. There are many ways to implement pre-interpolation, the most common of which are linear interpolation, circular interpolation, spline interpolation, etc. These interpolation methods have their own advantages and disadvantages and are suitable for different application scenarios. For example, linear interpolation is suitable for simple linear motion; circular interpolation is suitable for curved motion that requires smooth transition; and spline interpolation can generate smoother and more complex motion trajectories.
[0057] Dynamic constraints: Dynamic constraints mainly involve the restrictions on dynamic parameters such as force, torque, acceleration, and speed generated by the robot during movement. These constraints are usually determined by the physical properties of the robot (such as mass, inertia, stiffness, etc.), the performance of the drive system (such as the torque and speed range of the motor), and the requirements of the working environment. By setting dynamic constraints reasonably, the motion performance of the robot can be optimized, and production efficiency and product quality can be improved.
[0058] The above introduces the terms involved in the embodiments of the present application. Next, the application scenarios of robot arm acceleration and deceleration planning in some typical fields are exemplarily introduced.
[0059] Take an automated production line as an example. On an automated production line, the robot arm needs to frequently move materials, such as parts and finished products. In order to ensure the stability and safety of the materials during the handling process, the acceleration and deceleration of the robot arm needs to be accurately planned to prevent the materials from slipping or being damaged during acceleration or deceleration. During the assembly process, the robot arm needs to assemble the parts together according to the predetermined trajectory and speed. Acceleration and deceleration planning can ensure that the robot arm can decelerate smoothly when approaching the assembly point to accurately align and install the parts, while avoiding impact on the parts or the robot arm itself.
[0060] Take precision machining as an example. During the grinding and polishing of workpieces, the robot arm needs to control the contact force between the end effector and the workpiece according to the shape and material properties of the workpiece surface. Acceleration and deceleration planning can ensure that the robot arm can smoothly adjust the speed and force when contacting the workpiece, thereby ensuring the consistency of machining quality. During the cutting or engraving process, the robot arm needs to operate precisely according to the predetermined trajectory and speed. Acceleration and deceleration planning can ensure that the robot arm can smoothly change speed and direction during the cutting or engraving process, thereby avoiding unnecessary damage to the workpiece.
[0061] Taking medical devices as an example, during surgery, the robotic arm uses the planned trajectory to accurately carry and operate the surgical instruments. Acceleration and deceleration planning can ensure that the robotic arm can smoothly move and position the surgical instruments during surgery, reducing surgical risks and increasing the success rate of surgery.
[0062] Taking autonomous driving as an example, although autonomous vehicles themselves do not directly involve the acceleration and deceleration planning of the robotic arm, the application of robotic arms in the field of autonomous driving (such as cargo handling, vehicle maintenance, etc.) also requires precise acceleration and deceleration planning. This can ensure that the robotic arm can complete the task smoothly and accurately during operation.
[0063] The above exemplarily introduces the application scenario of the embodiment of the present application. In this application scenario or similar scenarios, there is a related technology. When the robot is accelerated and decelerated, a dynamics-based robot arm trajectory optimization method is proposed. The dynamic constraints of the robot arm are added to the trajectory optimization algorithm to optimize the kinematic and dynamic parameters such as the robot arm joint speed, acceleration, and torque to avoid the problem of excessive joint motor torque. However, this aspect is based on the premise that the dynamic model and parameters are accurate, and it only solves the problem of excessive instantaneous joint motor torque, and cannot meet the needs of complex actual working conditions. The inventor of the present application found through research that one reason why the prior art cannot meet the needs of actual working conditions is that it is impossible to update the acceleration and deceleration planning according to the real-time working state of the joint motor, and thus it is impossible to flexibly make real-time, adaptable, and meet the actual working conditions according to the real-time working conditions. Adjustment.
[0064] Based on this, the present application embodiment provides a torque control method applied to a robot joint motor, such as Figure 1 As shown, the method includes the following processing steps.
[0065] 100: During the movement of the robot arm based on the acceleration and deceleration planning, the values of the working state parameters of the joint motors of the robot arm are obtained in real time. The working state parameters are used to reflect the real-time working state of the joint motors.
[0066] Exemplarily, the working state parameters include parameters reflecting the load condition of the joint motor, such as the instantaneous load rate; or the working state parameters include parameters reflecting the driving ability of the joint motor, such as the real-time bus voltage. Or they include both the instantaneous load rate and the real-time bus voltage.
[0067] 102: Compare and judge the value of the working state parameter with the working state threshold, and if the relationship between the two satisfies the motion parameter adjustment condition, adjust the motion parameter of the robot arm according to the motion adjustment strategy. The motion state adjustment strategy constrains the adjustment method of the motion parameter.
[0068] It should be noted that the working status threshold mentioned in this embodiment is not necessarily a fixed value, but may also be a value that changes adaptively according to actual conditions.
[0069] 104: Update the acceleration and deceleration plan according to the adjusted motion parameters.
[0070] By adopting this embodiment, the motion parameters of the robot arm can be adjusted in real time according to the real-time working state of the joint motor during the movement of the robot arm, for example, the load condition and / or driving capacity of the joint motor, so that the acceleration and deceleration planning of the robot arm meets the requirements of the actual working condition. In other words, by adopting this embodiment, the acceleration and deceleration planning can be adjusted flexibly and in real time according to the real-time working condition to meet the requirements of the actual working condition.
[0071] Optionally, in an implementation of the present embodiment, the acceleration / deceleration plan mentioned in process 100 is an acceleration / deceleration plan obtained by using a pre-interpolation method, or, the acceleration / deceleration plan mentioned in process 100 is an acceleration / deceleration plan obtained by first using a pre-interpolation method and then performing dynamic constraints.
[0072] Optionally, in an implementation of an embodiment of the present application, the motion control method of the robot arm is described by taking the working state parameter as the instantaneous load rate as an example.
[0073] In this implementation, in processing 100, the values of the working state parameters of the joint motors of the robotic arm are obtained in real time, including: obtaining in real time the instantaneous quadrature-axis current and the instantaneous direct-axis current of the joint motors during the movement of the robotic arm; and calculating and determining the instantaneous load rate of the joint motors based on the instantaneous quadrature-axis current, the instantaneous direct-axis current and the rated current of the joint motors.
[0074] In this way, the instantaneous load rate reflecting the real-time load condition of the joint motor can be obtained.
[0075] In this implementation, in process 100, the working state parameter is the instantaneous load rate, the working state threshold is the instantaneous load rate threshold, and the motion parameter includes the acceleration of the manipulator. At this time, in process 102, if the relationship between the two meets the motion parameter adjustment condition, the motion parameter of the manipulator is adjusted according to the motion adjustment strategy, including: if the instantaneous load rate exceeds the instantaneous load rate threshold, the relationship between the two meets the motion parameter adjustment condition, and the acceleration of the manipulator is adjusted in a decreasing direction.
[0076] For example, if N a >k1*N limit , then the relationship between the two satisfies the motion parameter adjustment condition, and adjust a a =k2*a a , where N a Indicates the instantaneous load rate, N limit Indicates the maximum limit of the instantaneous load rate (i.e., the value that the instantaneous load rate cannot exceed), k1*N limit Indicates the instantaneous load rate threshold, a a Indicates the current acceleration, k2*a a represents the acceleration after adjustment, k1 is a coefficient used to indicate the degree to which the acceleration is adjusted when the maximum limit of the instantaneous load rate is reached, k2 is a coefficient that can represent the adjustment amplitude of the acceleration (for example, 1-k2 can represent the amplitude of the acceleration reduction), and the larger k1 is, the smaller k2 is. According to the inventor's research, when k1∈[0.85, 0.95] and k2∈[0.8, 0.99], the actual working condition requirements can be better met. In a specific application, k1=0.9 and k2=0.9.
[0077] This implementation method obtains the instantaneous load rate that reflects the real-time load condition of the joint motor, and adaptively adjusts the acceleration of the robot arm according to the relationship between the instantaneous load rate and the instantaneous load rate threshold, thereby meeting the needs of actual working conditions and avoiding alarms and shutdowns caused by excessive motor load rate during operation, which affects the operating efficiency of the robot arm.
[0078] Optionally, in an implementation of an embodiment of the present application, the motion control method of the robot arm is described by taking the working state parameter as the real-time bus voltage as an example.
[0079] In this implementation, the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage (or called the real-time theoretical required bus voltage). In this case, the motion control method of the robot arm also includes: obtaining the instantaneous quadrature axis voltage and instantaneous direct axis voltage of the joint motor in real time during the movement of the robot arm, and calculating the real-time theoretical bus voltage according to the instantaneous quadrature axis voltage and the instantaneous direct axis voltage. In this way, the implementation theoretical bus voltage can be calculated for subsequent comparison and judgment.
[0080] In this implementation, the working state parameter is the real-time bus voltage, and the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage. At this time, in process 102, if the relationship between the two meets the motion parameter adjustment condition, the motion parameters of the manipulator are adjusted according to the motion adjustment strategy, including: if the relationship between the real-time bus voltage and the theoretical bus voltage meets the first motion parameter adjustment condition, the acceleration in the motion parameter is adjusted in the direction of reduction; if the relationship between the real-time bus voltage and the theoretical bus voltage meets the second motion parameter adjustment condition, the speed and acceleration in the motion parameter are adjusted in the direction of reduction at the same time.
[0081] That is to say, in this implementation, different adjustment methods are selectively executed according to the magnitude relationship between the real-time bus voltage and the real-time theoretical bus voltage. This fully takes into account the different magnitude relationships between the real-time bus voltage and the real-time theoretical bus voltage, reflecting that the joint motor has different requirements for adjusting the motion parameters. Therefore, the adoption of this implementation can flexibly and in real time meet the actual working conditions.
[0082] As an example, if the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition, then adjusting the acceleration in the motion parameter in a decreasing direction includes:
[0083] If U a ≥U b >k3*U a , then the relationship between the real-time bus voltage and the theoretical bus voltage meets the first motion parameter adjustment condition. At this time, adjust ab =k4*a b Among them, U a Indicates the real-time bus voltage, U b Indicates the theoretical bus voltage, a b Indicates the current acceleration, k4*a b represents the acceleration after adjustment, k3 is a coefficient used to indicate at what level of the theoretical bus voltage the acceleration is adjusted, k4 is a coefficient that can indicate the adjustment amplitude of the acceleration, and the larger k3 is, the smaller k4 is.
[0084] For example, k3∈[0.92, 0.97], k4∈[0.9, 0.95] are more conducive to meeting the actual working condition requirements. In a more specific example, k1=0.95, k2=1.95-U b / U a .
[0085] As another example, if the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition, the speed and acceleration in the motion parameters are adjusted simultaneously in a decreasing direction, including:
[0086] If U b >U a , then the relationship between the real-time bus voltage and the theoretical bus voltage meets the second motion parameter adjustment condition. At this time, adjust a c =k5*a c , v c =k6*v c Among them, U a Indicates the real-time bus voltage, U b Indicates the theoretical bus voltage, a c Indicates the current acceleration, k5*a c represents the acceleration after adjustment, v c Indicates the current speed, k6*v c represents the speed after adjustment, k5 is a coefficient that can represent the adjustment range of the acceleration, and k6 is a coefficient that can represent the adjustment range of the current speed.
[0087] For example, k5∈[0.9, 0.95], k6∈[0.9, 0.95] are more conducive to meeting the actual working condition requirements. In a more specific example, k5=1.95-U b / U a , k6=0.95.
[0088] By adopting this implementation method, the real-time bus voltage reflecting the joint driving capability is obtained, and at least one of the acceleration and speed of the robot arm is adaptively adjusted according to the size relationship between the real-time bus voltage and the real-time theoretical bus voltage, so as to meet the needs of actual working conditions and avoid the situation where the robot arm cannot run according to the established trajectory or even has an alarm shutdown problem when the bus voltage is insufficient.
[0089] Figure 2 is a flow chart of a method for planning acceleration and deceleration of a robot arm according to an embodiment of the present application. Figure 2 ,The acceleration and deceleration planning method of the robot includes the following ,processing methods.
[0090] Since there are many acceleration and deceleration planning algorithms, robot arm types, and motion forms, in this embodiment, only the trapezoidal acceleration and deceleration planning method, the two-link robot arm, and the point-to-point motion are selected as examples for introduction.
[0091] In this embodiment, if Figure 2 As shown, pre-interpolation is first performed.
[0092] Pre-interpolation
[0093] Pre-interpolation is to plan acceleration and deceleration according to the preset speed, acceleration and displacement before sending position instructions to the robot arm. Figure 3 The figure shows a trapezoidal acceleration and deceleration planning schematic diagram according to an embodiment of the present application. Specifically, the acceleration and deceleration planning can be expressed by the following formula: Figure 3 The horizontal axis is time, and the vertical axes are displacement S, velocity V, and acceleration a respectively.
[0094]
[0095]
[0096] Then, if Figure 2 As shown, dynamic constraints are performed to obtain acceleration and deceleration planning with dynamic constraints.
[0097] Dynamic Constraints
[0098] The acceleration and deceleration planning algorithm of the robot in pre-interpolation only considers the kinematic constraints of the robot such as the speed and acceleration, but ignores the dynamic constraints of the robot. This may cause the joint motor torque to exceed the limit when the robot runs the predetermined trajectory, and the robot cannot accurately execute the planned trajectory. Therefore, after executing pre-interpolation, the acceleration and deceleration planning is further constrained according to dynamics.
[0099] For a two-joint robotic arm system, considering the influence of joint friction, its dynamic equation can be expressed as:
[0100]
[0101]
[0102]
[0103]
[0104] C1C 12 =-m2l1l b2 sinθ2
[0105] C1C 21 =m2l1l b2 sinθ2
[0106] C2C 11 =C2C 12 =-m2l1l b2 sinθ2
[0107] D 11 , D 22 is the effective inertia of the joint, the inertial force generated by the acceleration of the joint i due to its own axis
[0108] D 12 , D 21 is the coupling inertia between joints, the acceleration of joint 1 Will be generated on joint 2 The inertial force of joint 2, the acceleration of joint 2 Will be generated on joint 1 The inertial force;
[0109] C1C 12 、C1C 21 is the centrifugal acceleration coefficient, is the velocity of joint 1 The centrifugal force that will be generated on joint 2, is the velocity of joint 2 The centrifugal force that will be generated on joint 1;
[0110] C2C 11 、C2C 12 is the Coriolis acceleration coefficient, The speed of joints 1 and 2 and Coriolis force generated on joint 1;
[0111] Where: m1 is the mass of the first joint;
[0112] l b1 is the distance from the center of mass of the first joint to the center of rotation of the first joint;
[0113] Jc1 is the moment of inertia of the weight of the first joint itself;
[0114] m2 is the mass of the second joint;
[0115] l b2 is the distance from the center of mass of the second joint to the center of rotation of the second joint;
[0116] J c2 is the moment of inertia of the weight of the second joint itself;
[0117] l1 is the length of the first joint;
[0118] According to the acceleration and deceleration planning curve obtained by pre-interpolation and the above dynamic formula, it can be obtained that when the first joint and the second joint run according to the specified trajectory, the maximum output torque of the joint is T1; the maximum output torque of the joint motor itself is T limit , if T1>T limit Then the acceleration and speed need to be adjusted.
[0119] The acceleration and deceleration planning is re-performed according to the adjusted acceleration and speed by repeating the pre-interpolation operation, that is, a new acceleration and deceleration planning is obtained.
[0120] It should be noted that in other embodiments of the present application, dynamic constraints may not be performed, that is, the acceleration and deceleration planning is obtained only through pre-interpolation.
[0121] Afterwards, if Figure 2 As shown, the instantaneous load factor is calculated and judged.
[0122] Motor load factor
[0123] After the above two processes of pre-interpolation and dynamic constraint, motion instructions are sent to the joint motors, and the instantaneous load rate of the motors is calculated in real time during the movement of the joint motors.
[0124] Specifically, when the motor is running, the instantaneous quadrature-axis current and instantaneous direct-axis current of the motor can be obtained according to the preset sampling frequency; the square sum operation is performed on the instantaneous quadrature-axis current and the instantaneous direct-axis current, and the instantaneous root mean square current is obtained; and the instantaneous load rate is determined based on the ratio of the instantaneous root mean square current and the rated current of the motor.
[0125] In addition, the instantaneous load rate can be multiplied by different coefficients and then accumulated to obtain the motor load rate. This coefficient is the ratio of the inverse of the preset sampling frequency to the motor operating time under each load of the motor's overload curve.
[0126] When the instantaneous load rate N a Greater than the set load rate N limit , will trigger the motor overload protection. Therefore, when the load rate N is detected a>k1*N limit When the acceleration decreases to a a =k2*a a , re-plan the acceleration and deceleration according to the new acceleration. For example, taking no dynamic constraints as an example, re-planning the acceleration and deceleration according to the new acceleration can be understood as updating the acceleration according to the new acceleration Figure 3 Formulas associated with the acceleration and deceleration planning diagram shown.
[0127] In order to give full play to the capacity of the joint motor, k1 is between 0.85 and 0.95; k2 is negatively correlated with k1, that is, the larger k1 is, the smaller k2 is. k2 is generally between 0.8 and 0.99, and the specific value can be selected according to actual conditions.
[0128] Afterwards, if Figure 2 As shown, the real-time bus voltage is obtained and judged.
[0129] Real-time bus voltage
[0130] During the operation of the joint motor, the real-time bus voltage U is detected in real time. a , and calculate the theoretical required bus voltage (i.e., real-time theoretical bus voltage) based on the instantaneous direct axis (d-axis) voltage and instantaneous quadrature axis (q-axis) voltage
[0131] When it is detected that the real-time bus voltage meets the theoretical required voltage: U a ≥U b >k3*U a , where is the full controller capacity and k3 is between 0.92 and 0.97.
[0132] At this time, adjust the acceleration to: a a =k4*a a k4 is negatively correlated with k3, that is, the larger k3 is, the smaller k4 is. k4 is generally between 0.9 and 0.95, and the specific value can be selected according to actual conditions.
[0133]
[0134] When the bus voltage is detected and the required theoretical voltage meets: U b >U a
[0135] Adjust the acceleration and speed to: a a =k5*a a , v a =k6*v a
[0136] The values of k5 and k6 are generally between 0.9 and 0.95, and the specific values can be selected according to actual conditions.
[0137] After the acceleration and speed are adjusted, the acceleration and deceleration planning is re-performed to obtain a new acceleration and deceleration planning.
[0138] Before the planning of this segment of trajectory is completed, the relevant operations of motor load rate and real-time bus voltage are repeated at a preset frequency (selected according to actual needs). After the planning is completed, exit and wait for the next segment of trajectory planning instructions. The planning of this segment of trajectory is completed when the robot arm has moved to the specified position of this segment of trajectory.
[0139] By adopting this implementation method, during the movement of the robotic arm, the instantaneous motor load rate and the real-time bus voltage are detected simultaneously, and at least one of the acceleration and speed is adjusted in real time according to the instantaneous motor load rate and the real-time bus voltage, thereby being able to update the acceleration and deceleration plan according to the actual working conditions.
[0140] The above is a detailed description of the motion control method of the robotic arm according to an embodiment of the present application. It should be noted that an embodiment of the present application also provides an electronic device, including a memory and a processor, wherein the memory stores one or more computer instructions, and the processor is used to call and execute one or more computer instructions to implement the motion control method of the robotic arm or its implementation method as described above.
[0141] Specifically, Figure 4 As shown, the electronic device includes a processor 510, at least one communication bus 520, a user interface 530, at least one external communication interface 540 and a memory 550. The communication bus 520 is configured to realize the connection and communication between these components. The user interface 530 may include a display screen, and the external communication interface 540 may include a standard wired interface and a wireless interface. The memory 550 stores computer instructions to implement the torque control method described above. The processor 510 is used to implement the torque control method described above when executing the computer instructions stored in the memory 500.
[0142] An embodiment of the present application also provides a computer program product, which includes one or more computer instructions, and when the computer instructions are executed, the motion control method of the robotic arm described above is implemented.
[0143] The embodiment of the present application also provides a computer-readable storage medium, which stores the aforementioned computer program product and can be read, called and executed by a processor.
[0144] An embodiment of the present application also provides a robotic arm, which adopts the motion control method of the robotic arm joint motor provided by the embodiment of the present application, or the robotic arm adopts the electronic device provided by the embodiment of the present application.
[0145] The description of the above computer program product, computer-readable storage medium, and electronic device is similar to the description of the above method embodiment, and has similar beneficial effects as the method embodiment. For technical details not disclosed in the computer program product, computer-readable storage medium, and electronic device of this application, please refer to the description of the method embodiment of this application for understanding.
[0146] In the above-mentioned embodiments of the present application, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, please refer to the relevant description of other embodiments. The steps shown in the relevant flow chart can be executed in a computer system such as a set of computer executable instructions, and although the logical order is shown in the flow chart, in some cases, the steps shown or described can be executed in an order different from that here. In other words, the order of steps described in the foregoing embodiments is only an example, and it is also within the scope of protection of the embodiments of the present application to reasonably adjust the order of steps based on the content of the embodiments of the present application.
[0147] The serial numbers or the order of introduction of the embodiments of the present application are for description only and do not represent the advantages or disadvantages of the embodiments.
[0148] In the several embodiments provided in this application, it should be understood that the disclosed technical content can be implemented in other ways. Among them, the device embodiments described above are only schematic. For example, the division of the units can be a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.
[0149] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple units. Some or all of the units may be selected according to actual needs to achieve the purpose of the present embodiment.
[0150] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.
[0151] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented using software, it can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When the computer instructions are loaded and executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The computer can be a general-purpose computer, a special-purpose computer, a computer network or other programmable device. The computer instructions can be stored in a computer-readable storage medium, or transmitted from one computer-readable storage medium to another computer-readable storage medium. For example, the computer instructions can be transmitted from a website site, computer, server or data center by wired (e.g., coaxial cable, optical fiber, digital subscriber line (DSL)) or wireless (e.g., infrared, wireless, microwave, etc.) mode to another website site, computer, server or data center. The computer-readable storage medium can be any available medium that a computer can access, or a data storage device such as a server or data center that includes one or more available media integrated. The available medium may be a magnetic medium (e.g., a floppy disk, a hard disk, a magnetic tape), an optical medium (e.g., a digital versatile disc (DVD)), or a semiconductor medium (e.g., a solid state disk (SSD)). It is worth noting that the computer-readable storage medium mentioned in the embodiment of the present application may be a non-volatile storage medium, in other words, a non-transient storage medium.
[0152] It should be noted that the information (including but not limited to user device information, user personal information, etc.), data (including but not limited to data for analysis, stored data, displayed data, etc.) and signals involved in the embodiments of this application are all authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with the relevant laws, regulations and standards of the relevant countries and regions. For example, the scene data of the current frame in the three-dimensional virtual scene, the device information of the client, and the scene interaction information involved in the embodiments of this application are all obtained with full authorization.
[0153] The above is only a preferred implementation of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.
Claims
1. A motion control method for a robotic arm, characterized in that: The method comprises: During the movement of the robotic arm based on the acceleration and deceleration planning, the value of the working state parameter of the joint motor of the robotic arm is obtained in real time, and the working state parameter is used to reflect the real-time working state of the joint motor; Comparing and judging the value of the working state parameter with the working state threshold, if the relationship between the two satisfies the motion parameter adjustment condition, adjusting the motion parameter of the robot arm according to the motion adjustment strategy, wherein the motion state adjustment strategy constrains the adjustment method of the motion parameter; The acceleration and deceleration plan is updated according to the adjusted motion parameters.
2. The motion control method according to claim 1, characterized in that: The working state parameters of the joint motor include: An instantaneous load rate reflecting the load condition of the joint motor; and / or, The real-time bus voltage reflects the driving capability of the joint motor.
3. The motion control method according to claim 2, characterized in that: In the case where the working state parameter is the instantaneous load rate, the step of acquiring the value of the working state parameter of the joint motor of the robotic arm in real time includes: Acquire in real time the instantaneous quadrature-axis current and the instantaneous direct-axis current of the joint motor during the movement of the robot arm; The instantaneous load rate of the joint motor is calculated and determined according to the instantaneous quadrature-axis current, the instantaneous direct-axis current and the rated current of the joint motor.
4. The motion control method according to claim 2, characterized in that: In the case where the working state parameter is the instantaneous load rate, the working state threshold is the instantaneous load rate threshold, and the motion parameter includes the acceleration of the joint motor; If the relationship between the two satisfies the motion parameter adjustment condition, the motion parameters of the robot arm are adjusted according to the motion adjustment strategy, including: If the instantaneous load rate exceeds the instantaneous load rate threshold, the relationship between the two satisfies the motion parameter adjustment condition, and the acceleration of the robot arm is adjusted in a decreasing direction.
5. The motion control method according to claim 4, characterized in that: If the instantaneous load rate exceeds the instantaneous load rate threshold, the relationship between the two satisfies the motion parameter adjustment condition, and the acceleration of the robotic arm is adjusted in a decreasing direction, including: If N a >k1*N limit , then the relationship between the two satisfies the motion parameter adjustment condition, and adjust a a =k2*a a , where the N a represents the instantaneous load rate, the N limit Indicates the maximum limit of instantaneous load rate, k1*N limit represents the instantaneous load rate threshold, a a Indicates the current acceleration, k2*a a represents the acceleration after adjustment, k1 is a coefficient used to indicate at what level the acceleration is adjusted when the maximum limit of the instantaneous load rate is reached, k2 is a coefficient that can indicate the adjustment amplitude of the acceleration, and the larger k1 is, the smaller k2 is.
6. The motion control method according to claim 5, characterized in that: k1∈[0.85, 0.95], k2∈[0.8, 0.99].
7. The motion control method according to any one of claims 2 to 6, characterized in that: In the case where the working state parameter includes the real-time bus voltage, the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage; The method further comprises: Acquire the instantaneous quadrature-axis voltage and the instantaneous direct-axis voltage of the joint motor in real time during the movement of the robot arm, The real-time theoretical bus voltage is calculated based on the instantaneous quadrature-axis voltage and the instantaneous direct-axis voltage.
8. The motion control method according to any one of claims 2 to 6, characterized in that: When the working state parameter is the real-time bus voltage, the working state threshold is the real-time theoretical bus voltage corresponding to the real-time bus voltage; If the relationship between the two satisfies the motion parameter adjustment condition, the motion parameters of the robot arm are adjusted according to the motion adjustment strategy, including: If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition, the acceleration in the motion parameter is adjusted in a decreasing direction, If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition, the speed and acceleration of the motion parameters are adjusted simultaneously in a decreasing direction.
9. The motion control method according to claim 8, characterized in that: If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition, adjusting the acceleration in the motion parameter in a decreasing direction includes: If U a ≥U b >k3*U a , then the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the first motion parameter adjustment condition. At this time, adjust a b =k4*a b ; Among them, U a Indicates the real-time bus voltage, U b represents the theoretical bus voltage, a b Indicates the current acceleration, k4*a b It represents the acceleration after adjustment, k3 is a coefficient used to indicate at what level of the theoretical bus voltage the acceleration is adjusted, k4 is a coefficient that can indicate the adjustment amplitude of the acceleration, and the larger k3 is, the smaller k4 is.
10. The motion control method according to claim 9, characterized in that: k3∈[0.92, 0.97], k4∈[0.9, 0.95].
11. The motion control method according to claim 8, characterized in that: If the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition, the speed and acceleration in the motion parameters are adjusted simultaneously in a decreasing direction, including: If U b >U a , then the relationship between the real-time bus voltage and the theoretical bus voltage satisfies the second motion parameter adjustment condition. At this time, adjust a c =k5*a c , v c =k6*v c ; Among them, U a Indicates the real-time bus voltage, U b represents the theoretical bus voltage, a c Indicates the current acceleration, k5*a c represents the acceleration after adjustment, v c Indicates the current speed, k6*v c represents the speed after adjustment, k5 is a coefficient that can represent the adjustment range of the acceleration, and k6 is a coefficient that can represent the adjustment range of the current speed.
12. The motion control method according to claim 11, characterized in that: k5∈[0.9, 0.95], k6∈[0.9, 0.95].
13. The motion control method according to claim 1, characterized in that: The acceleration and deceleration plan is an acceleration and deceleration plan obtained by a pre-interpolation method; or, The acceleration and deceleration planning is an acceleration and deceleration planning obtained by first adopting a pre-interpolation method and then performing dynamic constraints.
14. An electronic device, characterized in that: The electronic device comprises: a memory for storing one or more computer instructions; A processor, configured to call and execute the computer instructions to implement the motion control method according to any one of claims 1 to 13.
15. A robotic arm, characterized in that: During the movement, the robotic arm uses the motion control method described in any one of claims 1 to 13 to perform motion control, or the robotic arm has the electronic device described in claim 14.
Citation Information
Patent Citations
Acceleration adjustment device and acceleration adjustment program
CN112262026A
Acceleration correction method and device and computer readable storage medium
CN112769369A
Brake control method and device, electronic equipment and storage medium
CN114421815A
Overload protection method and device for servo motor and readable storage medium
CN117895429A
Controller for industrial robot
JP1993080833A
Cited By
Cantilever crane linkage control method and system and engineering machinery
CN121325974A
