Track planning method and device based on direct-current driving mechanical arm and medium

By establishing a composite power supply system and energy consumption calculation model in industrial robots, using particle optimization algorithm and B-spline fitting technology, the integration problem of robot motion planning and regenerative energy utilization is solved, and the energy consumption is significantly reduced and energy utilization is achieved. Improved efficiency.

CN119057781APending Publication Date: 2024-12-03CHONGQING COLLEGE OF ELECTRONICS ENG

Patent Information

Application Number
CN202411242736.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-05
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

The existing technology has failed to effectively integrate robot motion planning and the collection and utilization of regenerative energy, resulting in limitations in the optimization of energy consumption of industrial robots.

Method used

The trajectory planning method based on DC-driven robot arm is adopted, and the recycling and utilization of regenerated energy is achieved by establishing a composite power supply system of the robot arm, building an energy consumption calculation model, using particle optimization algorithms and real-number coding, and combining with B-spline tool fitting.

Benefits of technology

It significantly reduces the energy consumption of industrial robots, ensures that while meeting production efficiency, it greatly reduces energy consumption and improves energy utilization efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119057781A_ABST
    Figure CN119057781A_ABST
Patent Text Reader

Abstract

The invention provides a trajectory planning method and device based on a direct-current driving mechanical arm and a medium. The method comprises the steps that S1, a mechanical arm composite power supply system is established, the mechanical arm composite power supply system comprises a direct-current power source, a super capacitor and a joint motor, and the super capacitor provides electric energy for the joint motor; the direct-current power supply is used for charging the super capacitor; s2, a mechanical arm energy consumption calculation model is constructed, mechanical arm energy consumption is calculated, and an energy consumption optimization target is constructed; s3, solving the energy consumption optimization target by adopting a particle optimization algorithm to obtain a lowest energy consumption trajectory plan; and S4, real number coding is adopted, the initial position and the final position are determined according to the lowest energy consumption trajectory planning and the robot task, and the industrial robot joint trajectory is obtained through fitting of a B spline tool. The technical problem that in the prior art, an existing robot energy-saving technology cannot effectively integrate robot motion planning and collection and utilization of regenerated energy, and consequently limitation exists in energy consumption optimization is solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of robot equipment, and in particular to a trajectory planning method, equipment and medium based on a direct current driven mechanical arm. Background Art

[0002] Industrial robots are key components of automated production lines due to their wide application and huge energy-saving potential. Their energy efficiency is directly related to production costs and environmental impact. The energy consumption of industrial robots mainly comes from the drive of their joint motors. During the movement, joint motors frequently decelerate or brake, which generates a large amount of regenerative energy. This regenerative energy is often not effectively collected and reused, resulting in energy waste.

[0003] Traditional industrial robot power supply systems usually rely on a single DC power supply and do not fully utilize the regenerative energy generated by the joint motor during braking. In addition, existing robot energy-saving technologies have also failed to effectively integrate robot motion planning with the collection and utilization of regenerative energy, resulting in limitations in the robot's energy consumption optimization.

[0004] In view of this, the inventor proposes a trajectory planning method, device and medium based on a DC-driven robotic arm. Summary of the invention

[0005] In view of the shortcomings of the prior art, on the first aspect, the present invention proposes a trajectory planning method based on a DC-driven robotic arm to solve the technical problem that the existing robot energy-saving technology in the prior art fails to effectively integrate robot motion planning with the collection and utilization of renewable energy, resulting in limitations in the robot's energy consumption optimization.

[0006] The technical solution adopted by the present invention is, in the first aspect, a trajectory planning method based on a DC-driven manipulator, comprising:

[0007] S1. Establishing a composite power supply system for a robotic arm, wherein the composite power supply system for the robotic arm comprises a DC power supply, a super capacitor and a joint motor, wherein the super capacitor provides electrical energy to the joint motor, and the DC power supply is used to charge the super capacitor;

[0008] S2. Construct a robot arm energy consumption calculation model, calculate the robot arm energy consumption, and establish an energy consumption optimization target;

[0009] S3, using particle optimization algorithm to solve the energy consumption optimization target and obtain the minimum energy consumption trajectory planning;

[0010] S4, using real number coding, determine the starting and ending positions according to the minimum energy consumption trajectory planning and robot tasks, and obtain the industrial robot joint trajectory through B-spline tool fitting.

[0011] Furthermore, the construction process of the mechanical arm energy consumption calculation model includes:

[0012] S21. Use Lagrangian dynamics equation to establish the driving torque equation of the robot arm joint;

[0013] S22. Construct the differential equation of the driving circuit at the joint of the robot arm based on the bond graph theory;

[0014] S23. Substitute the driving torque equation of the robot arm joint into the differential equation of the driving circuit at the robot arm joint, construct an augmented model of the robot system dynamics, and deduce the energy consumption calculation model of the robot arm.

[0015] Furthermore, the specific expression of the driving torque equation of the robot arm joint is as follows:

[0016]

[0017] in, are the vectors of generalized joint coordinate angle, velocity and acceleration, respectively. is the joint space inertia matrix, are the Coriolis and centripetal coupling matrices, is the friction force, is the gravity load, is the joint driving torque. is the external force and torque applied to the end effector. is the Jacobian matrix of the robot.

[0018] Furthermore, the specific expression of the differential equation of the driving circuit at the joint of the robot arm is as follows:

[0019]

[0020] Among them, τ i is the driving torque of the ith joint, t i is the i-th motor torque constant, U is the DC bus voltage, z i is the ratio of bus voltage to motor voltage, r i is the motor stator resistance, m i is the motor rotor moment of inertia, n i is the reduction ratio of the i-th reducer, is the angular acceleration of the i-th joint, b i is the equivalent viscous friction coefficient, e i is the motor back electromotive force constant, is the joint angular velocity.

[0021] Furthermore, the specific representation of the robot system dynamics augmented model is as follows:

[0022]

[0023] Among them, the i-th element of V is The off-diagonal elements are the same as M(q); The i-th diagonal element of is the i-th diagonal element of M(q) and Addition; The i-th element of The i-th element of The sum.

[0024] Furthermore, the specific representation of the energy consumption calculation model of the robot mechanical arm is as follows:

[0025]

[0026] Among them, E is the total power consumption value; is the current value on the stator during the motion of the i-th joint; n is the number of joints of the industrial robot.

[0027] Furthermore, the specific formula of the energy consumption optimization target is as follows:

[0028]

[0029] st-q i,max ≤q i (t)≤q i,max

[0030]

[0031] t≤t

[0032] max

[0033] Among them, q i,max , is the maximum allowable angle, angular velocity and angular acceleration of each joint; is the angular velocity and angular acceleration of each joint at time 0; t max is the maximum allowed running time.

[0034] Furthermore, in the particle optimization algorithm, the following formula is used to update the inertia weight and learning factor:

[0035]

[0036] Among them, ω max and ω min is the maximum inertia weight and the minimum inertia weight; α and β are the steepness and midpoint position hyperparameters of the inertia weight curve; c 1max and c2max is the maximum value of individual and group learning factors; c 1min and c 2min Learn factor minima for individuals and groups.

[0037] In a second aspect, the present invention proposes an electronic device, comprising a processor and a memory that is communicatively connected to the processor and is used to store executable instructions of the processor, wherein the processor is used to execute the trajectory planning method based on a DC-driven robotic arm proposed in the first aspect.

[0038] In a third aspect, the present invention proposes a computer-readable storage medium storing a computer program, characterized in that when the computer program is executed by a processor, the trajectory planning method based on a DC-driven robotic arm proposed in the first aspect is implemented.

[0039] It can be seen from the above technical solution that the beneficial technical effects of the present invention are as follows:

[0040] The present invention proposes a trajectory planning method based on a DC-driven robotic arm. First, a composite power supply system is constructed, and a DC power supply and a supercapacitor are used to realize the recovery and utilization of the regenerated energy generated by the robotic arm during the movement. In addition, an energy consumption calculation model is constructed by combining Lagrangian dynamics and bond graph theory. The motion trajectory of the robotic arm is optimized by a particle optimization algorithm, ensuring that the energy consumption is greatly reduced while meeting the industrial production efficiency. In addition, the present invention adopts real number coding and B-spline tool fitting technology to plan the joint trajectory of the industrial robot, and the operation is simple and fast, thereby solving the technical problem that the existing robot energy-saving technology in the prior art fails to effectively integrate the robot motion planning with the collection and utilization of regenerated energy, resulting in limitations in the energy consumption optimization of the robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] In order to more clearly illustrate the specific embodiments of the present invention or the technical solutions in the prior art, the following is a brief introduction to the drawings required for the specific embodiments or the prior art description. In all the drawings, similar elements or parts are generally identified by similar reference numerals. In the drawings, the elements or parts are not necessarily drawn according to the actual scale.

[0042] Figure 1 A schematic diagram of the overall process of providing a trajectory planning method based on a DC-driven robotic arm according to Embodiment 1 of the present invention;

[0043] Figure 2 A schematic diagram of the process of constructing a mechanical arm energy consumption calculation model provided by a trajectory planning method based on a DC-driven mechanical arm according to Embodiment 1 of the present invention;

[0044] Figure 3A schematic diagram of a composite power supply system for a robotic arm provided for a trajectory planning method based on a DC-driven robotic arm according to Example 1 of the present invention. DETAILED DESCRIPTION

[0045] The following embodiments of the technical solution of the present invention are described in detail in conjunction with the accompanying drawings. The following embodiments are only used to more clearly illustrate the technical solution of the present invention, and are therefore only used as examples, and cannot be used to limit the protection scope of the present invention.

[0046] It should be noted that, unless otherwise specified, the technical terms or scientific terms used in this application should have the common meanings understood by those skilled in the art to which the present invention belongs.

[0047] In order to solve the existing problems in the prior art, the existing robot energy-saving technology has also failed to effectively integrate robot motion planning with the collection and utilization of renewable energy, resulting in the limitation of robot energy consumption optimization, such as Figure 1 As shown, this embodiment provides a trajectory planning method based on a DC-driven robotic arm, comprising:

[0048] S1. Establish a composite power supply system for a manipulator, wherein the composite power supply system for the manipulator includes a DC power supply, a super capacitor and a joint motor, wherein the super capacitor provides electrical energy to the joint motor, and the DC power supply is used to charge the super capacitor. Specifically, in this embodiment, the composite power supply system for the manipulator is as follows: Figure 3 As shown, the supercapacitor provides electrical energy to the joint motor. The function of the DC power supply and the controller is to charge the supercapacitor when the power supply capacity of the supercapacitor is insufficient to supplement the electrical energy and ensure the stable operation of the robotic arm. When the joint motor is in the regenerative braking state, the DC / DC converter feeds back the regenerated electrical energy to the DC bus, and transfers the excess electrical energy to other joint motors in the energy consumption state through the DC bus, which not only reduces the energy loss, but also transfers the excess electrical energy to other joint motors in the energy consumption state through the DC bus, thereby optimizing the energy efficiency of the entire robotic arm system. If the regenerated energy is greater than the total energy consumption of all joint motors, the excess regenerated energy is absorbed by the supercapacitor, and the supercapacitor is in a charging state at this time, thereby further improving the energy utilization efficiency and reducing the dependence on the external power supply.

[0049] S2. Construct a mechanical arm energy consumption calculation model, calculate the mechanical arm energy consumption, and construct an energy consumption optimization target. In this embodiment, the construction process includes:

[0050] S21. Use the Lagrangian dynamics equation to establish the driving torque equation of the robot joint. The specific expression of the driving torque equation of the robot joint is as follows:

[0051]

[0052] in, are the vectors of generalized joint coordinate angle, velocity and acceleration, respectively. is the joint space inertia matrix, are the Coriolis and centripetal coupling matrices, is the friction force, is the gravity load, is the joint driving torque. is the external force and torque applied to the end effector, It is the Jacobian matrix of the robot. By considering the dynamic characteristics of the robot arm, including the inertia force of the joints, friction force, external load and other factors, it ensures the accurate prediction and control of the motion state of the robot arm, and can provide a basis for subsequent energy consumption calculation and optimization, making the energy consumption model closer to the actual working situation and improving the accuracy of energy consumption prediction.

[0053] S22. Based on the bond graph theory, a differential equation for the driving circuit at the joint of the robot arm is constructed. As a preferred solution of this embodiment, the specific expression form of the differential equation for the driving circuit at the joint of the robot arm is as follows:

[0054]

[0055] Among them, τ i is the driving torque of the ith joint, t i is the i-th motor torque constant, U is the DC bus voltage, z i is the ratio of bus voltage to motor voltage, r i is the motor stator resistance, m i is the motor rotor moment of inertia, n i is the reduction ratio of the i-th reducer, is the angular acceleration of the i-th joint, b i is the equivalent viscous friction coefficient, e i is the motor back electromotive force constant, The bond graph theory, as an efficient system modeling tool, can clearly express the energy conversion and transfer relationship within the system, including the torque, current, voltage and other parameters of the motor, so that the dynamic characteristics of the drive circuit are accurately quantified, providing detailed electrical data for the energy consumption calculation model, which is helpful to further optimize the energy consumption of the robot arm.

[0056] S23, the mechanical arm joint driving torque equation is brought into the differential equation of the driving circuit at the mechanical arm joint, the robot system dynamics augmented model is constructed, and the robot mechanical arm energy consumption calculation model is inferred. In this embodiment, the specific representation form of the robot system dynamics augmented model is as follows:

[0057]

[0058] Among them, the i-th element of V is The off-diagonal elements are the same as M(q); The i-th diagonal element of is the i-th diagonal element of M(q) and Addition; The i-th element of The i-th element of The sum.

[0059] The specific representation of the energy consumption calculation model of the robot manipulator is as follows:

[0060]

[0061] Among them, E is the total power consumption value; is the current value on the stator during the movement of the ith joint; n is the number of joints of the industrial robot; this model not only covers the mechanical dynamics characteristics of the robot arm, but also integrates the electrical dynamics behavior, realizing a comprehensive analysis of the overall energy consumption of the robot arm, thereby being able to accurately predict and calculate the energy consumption of the robot arm under different working conditions, providing reliable data support for energy consumption optimization, and helping to develop more energy-saving and efficient industrial robot operation strategies.

[0062] S3. Use the particle optimization algorithm to solve the energy consumption optimization target and obtain the minimum energy consumption trajectory planning. This embodiment is preferred. The specific formula of the energy consumption optimization target is as follows:

[0063]

[0064] st-q i,max ≤q i (t)≤q i,max

[0065]

[0066] t≤t

[0067] max

[0068] Among them, q i,max , is the maximum allowable angle, angular velocity and angular acceleration of each joint; is the angular velocity and angular acceleration of each joint at time 0; t max is the maximum allowed running time.

[0069] In the particle optimization algorithm, specifically, first set the number of particles to n p, initialize the position and speed of all particles, set the individual's optimal solution to the current position, and set the group's optimal individual to the optimal solution of the current group. Calculate the fitness function of each particle in each iteration. If the current fitness function value is lower than the individual's historical minimum energy consumption, update the individual's historical minimum value; if the current fitness function value is lower than the global historical minimum value, update the global historical minimum energy consumption value; when the number of iterations reaches the maximum set value or the global historical minimum energy consumption value does not change within a certain number of iterations, the particle swarm algorithm stops; at this time, the corresponding global optimal solution is the minimum energy consumption trajectory for completing the industrial robot task while making full use of regenerative energy.

[0070] S4, using real number coding, according to the minimum energy consumption trajectory planning and the robot task to determine the starting and end positions, through the B-spline tool fitting to obtain the industrial robot joint trajectory, specifically, using real number coding, according to the robot task to determine the starting and end positions and the minimum energy consumption trajectory planning to obtain the intermediate moment shutdown position sequence, through the B-spline tool fitting to obtain the industrial robot joint trajectory; this embodiment is preferred, because the industrial robot controls the trajectory through discrete position points, the particle swarm algorithm particle position uses real number coding, the industrial robot starting position and end position are usually determined by the robot task, so the particle position vector is set to where t f is the total execution time of the trajectory, From t1 to t f-1 The joint position vector of the industrial robot at time t, f is the number of control points, q and t f The selection of needs to follow the constraints in the formula; during the iterative process of the particle swarm algorithm, after completing the particle position vector selection or iterative update, the industrial robot joint path of the jth particle can be obtained Combined trajectory total execution time t f , using the B-spline tool to j (t) The joint trajectory q of the industrial robot of the jth particle can be obtained by fitting j (t), Substituting it into the fitness function, the energy consumption value corresponding to the particle position vector can be calculated to complete the iteration. In order to enhance the optimization ability of the particle swarm algorithm, the inertia weight and learning factor are updated using the following formula:

[0071]

[0072] Among them, ω max and ω min is the maximum inertia weight and the minimum inertia weight; α and β are the steepness and midpoint position hyperparameters of the inertia weight curve; c 1max and c 2max is the maximum value of individual and group learning factors; c 1min and c2min The minimum energy consumption trajectory planning obtained by the particle optimization algorithm for the minimum learning factor of individuals and groups can significantly reduce the energy consumption of industrial robots in the process of performing tasks, while ensuring the high efficiency of robot movement and the smooth completion of tasks.

[0073] That is, this embodiment proposes a trajectory planning method based on a DC-driven robotic arm. First, a composite power supply system is constructed, and a DC power supply and a supercapacitor are used to realize the recovery and utilization of the regenerated energy generated by the robotic arm during the movement. In addition, an energy consumption calculation model is constructed by combining Lagrangian dynamics and bond graph theory. The motion trajectory of the robotic arm is optimized by a particle optimization algorithm, ensuring that while meeting industrial production efficiency, energy consumption is greatly reduced. In addition, the present invention adopts real number coding and B-spline tool fitting technology to plan the joint trajectory of the industrial robot, and the operation is simple and fast, thereby solving the technical problem that the existing robot energy-saving technology in the prior art has failed to effectively integrate the robot motion planning with the collection and utilization of regenerated energy, resulting in limitations in the energy consumption optimization of the robot.

[0074] In a second aspect, the present invention proposes an electronic device, comprising a processor and a memory that is communicatively connected to the processor and is used to store executable instructions of the processor, wherein the processor is used to execute the above-mentioned trajectory planning method based on a DC-driven robotic arm.

[0075] In a third aspect, the present invention proposes a computer-readable storage medium storing a computer program, which, when executed by a processor, implements the above-mentioned trajectory planning method based on a DC-driven robotic arm.

[0076] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention 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 replace some or all of the technical features therein by equivalents. These modifications or replacements do not make the essence of the corresponding technical solutions deviate from the scope of the technical solutions of the embodiments of the present invention, and they should all be included in the scope of the claims and specification of the present invention.

Claims

1. A trajectory planning method based on a DC-driven robotic arm, characterized in that: include: S1. Establishing a composite power supply system for a robotic arm, wherein the composite power supply system for the robotic arm comprises a DC power supply, a super capacitor and a joint motor, wherein the super capacitor provides electrical energy to the joint motor, and the DC power supply is used to charge the super capacitor; S2. Construct a robot arm energy consumption calculation model, calculate the robot arm energy consumption, and establish an energy consumption optimization target; S3, using particle optimization algorithm to solve the energy consumption optimization target and obtain the minimum energy consumption trajectory planning; S4, using real number coding, determine the starting and ending positions according to the minimum energy consumption trajectory planning and robot tasks, and obtain the industrial robot joint trajectory through B-spline tool fitting.

2. The trajectory planning method based on a DC-driven robotic arm according to claim 1, characterized in that: The construction process of the robotic arm energy consumption calculation model includes: S21. Use Lagrangian dynamics equation to establish the driving torque equation of the robot arm joint; S22. Construct the differential equation of the driving circuit at the joint of the robot arm based on the bond graph theory; S23. Substitute the driving torque equation of the robot arm joint into the differential equation of the driving circuit at the robot arm joint, construct an augmented model of the robot system dynamics, and deduce the energy consumption calculation model of the robot arm.

3. The trajectory planning method based on a DC-driven robotic arm according to claim 2, characterized in that: The specific expression of the driving torque equation of the robot arm joint is as follows: in, are the vectors of generalized joint coordinate angle, velocity and acceleration, M∈i n×n is the joint space inertia matrix, C∈i n×n is the Coriolis and centripetal coupling matrix, F∈i n is the friction force, G∈i n is the gravity load, τ∈i n is the joint driving torque. W∈i 6 is the external force and torque applied to the end effector, J∈i 6×n is the Jacobian matrix of the robot.

4. The trajectory planning method based on a DC-driven robotic arm according to claim 2, characterized in that: The specific expression of the differential equation of the driving circuit at the joint of the robot arm is as follows: Among them, τ i is the driving torque of the ith joint, t i is the i-th motor torque constant, U is the DC bus voltage, zi is the ratio of bus voltage to motor voltage, ri is the motor stator resistance, mi is the motor rotor inertia, n i is the reduction ratio of the i-th reducer, is the angular acceleration of the i-th joint, b i is the equivalent viscous friction coefficient, e i is the motor back electromotive force constant, is the joint angular velocity.

5. The trajectory planning method based on a DC-driven robotic arm according to claim 2, characterized in that: The specific representation of the robot system dynamics augmented model is as follows: Among them, the i-th element of V is The off-diagonal elements are the same as M(q); The i-th diagonal element of is the i-th diagonal element of M(q) and Addition; The i-th element of The i-th element of The sum.

6. The trajectory planning method based on a DC-driven manipulator according to claim 2, characterized in that: The specific representation of the energy consumption calculation model of the robot manipulator is as follows: Among them, E is the total power consumption value; is the current value on the stator during the motion of the i-th joint; n is the number of joints of the industrial robot.

7. The trajectory planning method based on a DC-driven robotic arm according to claim 1, characterized in that: The specific formula of the energy consumption optimization target is as follows: s.t.-q i,max ≤q i (t)≤q i,max t≤t max Among them, q i,max , is the maximum allowable angle, angular velocity and angular acceleration of each joint; is the angular velocity and angular acceleration of each joint at time 0; t max is the maximum allowed running time.

8. According to the trajectory planning method based on a DC-driven manipulator according to claim 1, in the particle optimization algorithm, the inertia weight and the learning factor are updated using the following formula: in, ω max and ω min is the maximum inertia weight and the minimum inertia weight; α and β are the steepness and midpoint position hyperparameters of the inertia weight curve; c 1max and c 2max is the maximum value of individual and group learning factors; c 1min and c 2min Learn factor minima for individuals and groups.

9. An electronic device, comprising a processor and a memory connected to the processor for storing instructions executable by the processor, characterized in that: The processor is used to execute the trajectory planning method based on a DC-driven robotic arm as described in any one of claims 1-7 above.

10. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the trajectory planning method based on a DC-driven robotic arm according to any one of claims 1 to 8 is implemented.

Citation Information

Patent Citations

  • Bond-graph-based movable mechanical arm system and modeling method thereof

    CN109176524A

  • Robot motion information planning method and related apparatus

    WO2023115784A1

Cited By

  • Robot energy consumption optimization method based on improved particle swarm optimization

    CN119347852A