Mechanical arm moving track optimization method and device, equipment, medium and product
The method optimizes robotic arm trajectories through segmentation and energy calculation to address high energy consumption, enhancing efficiency and performance by selecting low-energy consumption paths.
Patent Information
- Application Number
- CN202411242739.3
- 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
Existing robotic arm trajectory planning often overlooks energy consumption optimization, leading to high energy consumption and suboptimal performance.
A method involving trajectory segmentation, scaling, and energy consumption calculation to optimize the robotic arm's motion trajectory, ensuring compliance with kinematic constraints and minimizing energy use.
Achieves a robotic arm trajectory that reduces energy consumption and improves efficiency by selecting sub-target trajectories with the lowest energy consumption, thereby optimizing the operation.
Smart Images

Figure CN119057782A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot equipment technology, and in particular to a method, device, equipment, medium and product for optimizing the running trajectory of a robot arm. Background Art
[0002] In modern industrial production, robotic arms have become a key component of automated production lines. They are widely used in the field of picking up and placing objects. From simple object handling to complex assembly tasks, robotic arms have greatly improved production efficiency and quality with their precision and efficiency. With the development of technology, the application scope of robotic arms continues to expand. They not only play an important role in industries such as automobile manufacturing and electronic product assembly, but also show great potential in the fields of medical care and services.
[0003] However, the robot arm considers many factors when setting the trajectory, such as the speed, acceleration, stability and accuracy of the movement to ensure the successful completion of the task. Workers usually optimize the movement path of the robot arm according to the task requirements to reduce the movement time and improve production efficiency. However, although these factors are widely considered in the motion planning of the robot arm, energy consumption optimization often does not receive enough attention. In practical applications, the energy consumption of the robot arm is often overlooked, resulting in high energy consumption when performing tasks and failure to achieve optimal trajectory planning. This non-optimal trajectory planning not only increases production costs, but may also affect the service life and performance stability of the robot arm.
[0004] In view of this, the inventor proposes a method, device, equipment, medium and product for optimizing the operation trajectory of a robot arm. Summary of the invention
[0005] In view of the shortcomings of the prior art, the present invention proposes a method, device, equipment, medium and product for optimizing the operation trajectory of a robotic arm, so as to solve the technical problem that the energy consumption problem of the robotic arm in the prior art is often ignored, resulting in high energy consumption when performing tasks and the trajectory planning fails to achieve the optimal level.
[0006] In a first aspect, the present invention proposes a robot arm trajectory optimization method, which is applied to an industrial robot, comprising:
[0007] Obtain the reference motion trajectory of the industrial robot's manipulator arm;
[0008] Performing trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories;
[0009] Scaling each of the k sub-manipulator arm reference motion trajectories to obtain k sub-target manipulator arm motion trajectories, wherein the k sub-target manipulator arm motion trajectories satisfy the basic kinematics law;
[0010] The k sub-target robot arm motion trajectories are combined according to the time axis to obtain the target robot arm motion trajectory.
[0011] Further, each of the k sub-manipulator reference motion trajectories is scaled to obtain k sub-target manipulator motion trajectories, and the k sub-target manipulator motion trajectories satisfy the basic kinematics law, including:
[0012] Performing runtime scaling processing on the motion trajectory of the first sub-target robot arm to obtain m scaled reference runtimes, the motion trajectory of the first sub-target robot arm being any one of the k sub-target robot arm motion trajectories;
[0013] Energy consumption is calculated according to the m scaled reference running times to obtain energy consumption values corresponding to the m scaled reference running times;
[0014] Determine a target running time, wherein the energy consumption value corresponding to the target running time is the minimum value of the energy consumption values corresponding to the m scaled reference running times;
[0015] Determine the target running time as the running time corresponding to the sub-manipulator reference motion trajectory, and obtain the sub-target manipulator motion trajectory;
[0016] Repeat the above steps from scaling the running time of the first sub-target robotic arm motion trajectory to obtain m scaled reference running times, to determining the target running time as the running time corresponding to the sub-robotic arm reference motion trajectory to obtain the sub-target robotic arm motion trajectory, until k sub-target robotic arm motion trajectories are obtained.
[0017] Furthermore, the running time scaling process is performed on the motion trajectory of the first sub-target robot arm to obtain m scaled reference running times. The expression form of the running time scaling process calculation process is specifically as follows:
[0018] tr=u(t)
[0019] qs(t)=qr(tr)=qr(u(t))
[0020]
[0021] Among them, tr is the reference trajectory time, u(t) is the time scaling function, qr(tr) is the reference trajectory of the robot, and qs(t) is the scaling trajectory of the robot.
[0022] Furthermore, the basic kinematics law includes a spatial constraint condition, which is specifically expressed as follows:
[0023]
[0024] Wherein, hk=tk+1-tk, hk is the time interval of the control segment, tk is the trajectory execution time variable at the kth control time point, tk+1 is the trajectory execution time variable at the k+1th control time point; Δ is a time increment; is the adjustment factor associated with the time interval hk; is the first derivative of the variable time scale scaling function u(t) at time k; is the first-order derivative of the variable time scale scaling function u(t) at time k+1.
[0025] Furthermore, energy consumption is calculated according to the m scaled reference running times to obtain energy consumption values corresponding to the m scaled reference running times, including:
[0026] The energy consumption calculation model of the robot arm is used to sequentially calculate the energy consumption values corresponding to the m scaled reference running times, and the reference energy consumption corresponding to the m scaled reference running times is obtained;
[0027] According to the joint position, velocity, acceleration and execution time constraints, the reference energy consumptions corresponding to the m scaled reference running times are adjusted respectively to obtain the energy consumption values corresponding to the m scaled reference running times.
[0028] Furthermore, the energy consumption calculation model of the robotic arm is used to sequentially calculate the energy consumption values corresponding to the m scaled reference running times, and the reference energy consumption corresponding to the m scaled reference running times is obtained. The specific expression form of the energy consumption calculation model of the robotic arm is as follows:
[0029]
[0030] Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, is the current value on the stator during the motion of the i-th joint, and n is the number of joints of the industrial robot.
[0031] Further, according to the joint position, speed, acceleration and execution time constraints, the reference energy consumptions corresponding to the m scaled reference running times are adjusted respectively to obtain the energy consumption values corresponding to the m scaled reference running times. The specific expressions of the joint position, speed, acceleration and execution time constraints are as follows:
[0032]
[0033] st-qi,max≤qi(t)≤qi,max
[0034]
[0035] t≤tmax
[0036] Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, 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, qi,max is the maximum allowable angle of the i-th joint, is the maximum allowable angular velocity of the ith joint, is the maximum allowable angular acceleration of the ith joint, is the angular velocity of each joint at the initial moment, is the angular acceleration of each joint at the initial moment, tmax is the maximum allowed running time, and t is the time variable, which represents the current time during the robot's motion.
[0037] In a second aspect, a robot arm operation trajectory optimization device is provided, the device comprising:
[0038] An acquisition unit, used for acquiring a reference motion trajectory of a manipulator arm of an industrial robot;
[0039] A first processing unit, configured to perform trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories;
[0040] A second processing unit is used to perform scaling processing on each of the k sub-manipulator reference motion trajectories to obtain k sub-target manipulator motion trajectories;
[0041] The third processing unit is used to combine the k sub-target robotic arm motion trajectories according to the time axis to obtain the target robotic arm motion trajectory.
[0042] In a third aspect, the present invention provides 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 robot arm trajectory optimization method described in the first aspect.
[0043] In a fourth aspect, the present invention provides a computer program product, comprising a non-transitory computer-readable storage medium storing a computer program, wherein the computer program is operable to cause a computer to execute part or all of the steps of the robot arm trajectory optimization method described in the first aspect.
[0044] It can be seen from the above technical solution that the beneficial technical effects of the present invention are as follows:
[0045] The present invention proposes a method for optimizing the operation trajectory of a robot arm. First, a reference motion trajectory of a robot arm of an industrial robot is segmented. Then, k reference motion trajectories of the robot arm obtained after the segmentation are scaled under the restriction condition of satisfying the basic kinematic law to obtain k sub-target mechanical motion trajectories. During the scaling process, these sub-target mechanical motion trajectories are screened for power consumption. The sub-target mechanical motion trajectory with the lowest power consumption is selected for each segment. Finally, the k sub-target mechanical arm motion trajectories are combined according to a time axis to obtain a target mechanical arm motion trajectory with optimal energy consumption, so as to solve the technical problem that the energy consumption problem of the robot arm in the prior art is often ignored, resulting in high energy consumption when performing tasks and failure to achieve optimal trajectory planning. BRIEF DESCRIPTION OF THE DRAWINGS
[0046] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0047] Figure 1 A schematic diagram of a trajectory optimization process provided by a robot arm trajectory optimization method according to an embodiment of the present invention;
[0048] Figure 2 A schematic diagram of a specific process of scaling a reference mechanical motion trajectory to obtain a sub-target mechanical arm motion trajectory using a variable time scaling method provided in a method for optimizing a mechanical arm trajectory according to an embodiment of the present invention;
[0049] Figure 3 A schematic diagram of the structure of an electronic device provided for a robot arm trajectory optimization method according to an embodiment of the present invention;
[0050] Figure 4 A schematic structural diagram of a robot arm motion trajectory optimization device provided for a robot arm trajectory optimization method according to an embodiment of the present invention. DETAILED DESCRIPTION
[0051] 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.
[0052] 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.
[0053] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions 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 are within the scope of protection of this application.
[0054] The terms "first", "second", etc. in the specification and claims of this application and the above-mentioned drawings are used to distinguish different objects, rather than to describe a specific order. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally includes steps or units that are not listed, or optionally includes other steps or units inherent to these processes, methods, products or devices.
[0055] Reference to "embodiments" in this application means that a particular feature, structure, or characteristic described in conjunction with the embodiments may be included in at least one embodiment of the present application. The appearance of the phrase in various locations in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described in this application may be combined with other embodiments.
[0056] In order to better understand the robot arm operation trajectory optimization method provided by the embodiment of the present application, the following first briefly introduces the scenario of the robot arm operation trajectory optimization method. The robot working scenario involved in this embodiment is mainly in the process of the robot taking and placing objects through the robot arm. This embodiment takes taking objects as an example. Assuming that the initial position of the robot arm is at point A and the position of the object to be taken is at point B, the movement of the robot arm from point A to point B forms the robot arm's own motion trajectory. In this solution, the robot arm's own motion trajectory is determined, that is, it will not change. The application scenario of this solution is how to minimize the energy consumption of the robot arm when the robot arm's own motion trajectory does not change. Therefore, it is necessary to adjust the robot arm's motion trajectory strategy.
[0057] This embodiment provides a method for optimizing the trajectory of a robot arm, which is applied to an industrial robot, such as Figure 1 As shown, including:
[0058] S1. Obtain a reference motion trajectory of the manipulator arm of the industrial robot. It should be noted that the reference motion trajectory of the manipulator arm here is the determined motion trajectory of the manipulator arm itself mentioned above.
[0059] S2. Perform trajectory segmentation processing on the reference motion trajectory of the robotic arm to obtain k sub-robotic arm reference motion trajectories. This embodiment is preferred. The trajectory segmentation processing in this embodiment divides the reference robotic arm motion trajectory on the time axis and sets it to 1, 2, 3, 4, ..., k, k+1, with a total of k+1 time points and k time periods to form k sub-robotic arm reference motion trajectories.
[0060] S3, scaling each of the k sub-manipulator reference motion trajectories to obtain k sub-target manipulator motion trajectories, the k sub-target manipulator motion trajectories satisfying the basic kinematics law, as a preferred solution of this embodiment, Figure 2 As shown, the specific steps include:
[0061] S301. Perform running time scaling processing on the motion trajectory of the first sub-target robotic arm to obtain m scaled reference running times. The motion trajectory of the first sub-target robotic arm is any one of the k sub-target robotic arm motion trajectories. This embodiment adopts a variable time scaling processing method. First, perform running time scaling processing on any one of the k sub-target robotic arm motion trajectories to obtain m scaled reference running times. It should be noted that these m scaled reference running times may be larger or smaller than the previous reference running times, that is, the trajectory of the robotic arm within the corresponding time may become faster or slower after scaling, but the motion trajectory does not change.
[0062] S302: performing energy consumption calculations according to the m scaled reference running times to obtain energy consumption values corresponding to the m scaled reference running times. In this embodiment, preferably, performing energy consumption calculations according to the m scaled reference running times to obtain energy consumption values corresponding to the m scaled reference running times includes:
[0063] S3021, using a robot arm energy consumption calculation model to sequentially calculate energy consumption values corresponding to m scaled reference operating times, to obtain reference energy consumptions corresponding to the m scaled reference operating times;
[0064] In this embodiment, the specific expression form of the energy consumption calculation model of the robot arm is as follows:
[0065]
[0066] Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, is the current value on the stator during the motion of the i-th joint, and n is the number of joints of the industrial robot.
[0067] S3022. According to the joint position, speed, acceleration and execution time constraints, the reference energy consumptions corresponding to the m scaled reference running times are adjusted respectively to obtain the energy consumption values corresponding to the m scaled reference running times. When the above-mentioned mechanical arm energy consumption calculation model is used to calculate the energy consumption of the mechanical arm motion trajectory, the joint position, speed, acceleration and execution time constraints need to be met, that is, the premise that the mechanical arm trajectory does not change. The specific expression is as follows:
[0068]
[0069] st-qi,max≤qi(t)≤qi,max
[0070]
[0071] t≤tmax
[0072] Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, 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, qi,max is the maximum allowable angle of the i-th joint, is the maximum allowable angular velocity of the ith joint, is the maximum allowable angular acceleration of the ith joint, is the angular velocity of each joint at the initial moment, is the angular acceleration of each joint at the initial moment, tmax is the maximum allowed running time, and t is the time variable, which represents the current time during the robot's motion.
[0073] Therefore, when a result that does not meet the constraint condition is generated during the energy consumption calculation process, the reference running time that does not meet the constraint condition is adjusted according to the joint position, velocity, acceleration and execution time constraints, and finally m scaled reference running times that meet the constraint condition are obtained.
[0074] S303, determining a target operating time, wherein the energy consumption value corresponding to the target operating time is the minimum value of the energy consumption values corresponding to the m scaled reference operating times, and determining the scaled reference operating time with the lowest energy consumption as the target operating time.
[0075] S304, determining the target running time as the running time corresponding to the sub-robotic arm reference motion trajectory, and obtaining the sub-target robotic arm motion trajectory. This step makes the determined target running time correspond to the sub-robotic arm reference motion trajectory, so as to facilitate the subsequent splicing of the sub-mechanical trajectories and avoid the problem of incorrect corresponding time of the previous and next trajectories when the sequence is correct.
[0076] S305. Repeat the above steps from scaling the running time of the first sub-target robotic arm motion trajectory to obtain m scaled reference running times, to determining the target running time as the running time corresponding to the sub-robotic arm reference motion trajectory, and obtaining the sub-target robotic arm motion trajectory, until k sub-target robotic arm motion trajectories are obtained. By repeating this step, the corresponding target running times of all sub-target robotic arm motion trajectories with the lowest energy consumption can be obtained.
[0077] S4. Combine the k sub-target robotic arm motion trajectories according to the time axis to obtain the target robotic arm motion trajectory. Finally, splice and combine all the k sub-target robotic arm motion trajectories with the lowest energy consumption according to the corresponding target running time to obtain a complete robotic arm motion trajectory with the lowest energy consumption.
[0078] That is, this embodiment proposes a method for optimizing the operation trajectory of a robotic arm. First, the robotic arm reference motion trajectory of the industrial robot is segmented, and then the k robotic arm reference motion trajectories obtained after the segmentation are scaled under the restriction condition of satisfying the basic kinematic laws to obtain k sub-target robotic motion trajectories. In the scaling process, these sub-target robotic motion trajectories are screened for power consumption, and the sub-target robotic motion trajectory with the lowest power consumption is selected for each segment. Finally, the k sub-target robotic arm motion trajectories are combined according to the time axis to obtain the target robotic arm motion trajectory with the optimal energy consumption, so as to solve the technical problem that the energy consumption problem of the robotic arm in the prior art is often ignored, resulting in high energy consumption when performing tasks and the trajectory planning fails to achieve the optimal level.
[0079] For the above embodiments, please refer to Figure 3 , Figure 3A structural schematic diagram of an electronic device provided in an embodiment of the present application, as shown in the figure, includes a processor, an input device, an output device and a memory, the processor, the input device, the output device and the memory are interconnected, wherein the memory is used to store a computer program, the computer program includes program instructions, the processor is configured to call the program instructions, and the program includes instructions for executing the following steps;
[0080] Obtain the reference motion trajectory of the industrial robot's manipulator arm;
[0081] Performing trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories;
[0082] Scaling each of the k sub-manipulator arm reference motion trajectories to obtain k sub-target manipulator arm motion trajectories, wherein the k sub-target manipulator arm motion trajectories satisfy the basic kinematics law;
[0083] The k sub-target robot arm motion trajectories are combined according to the time axis to obtain the target robot arm motion trajectory.
[0084] The above mainly introduces the scheme of the embodiment of the present application from the perspective of the execution process on the method side. It is understandable that, in order to realize the above functions, the electronic device includes a hardware structure and / or software module corresponding to the execution of each function. It should be easily appreciated by those skilled in the art that, in combination with the units and algorithm steps of each example described in the embodiments provided herein, the present application can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present application.
[0085] The embodiment of the present application can divide the electronic device into functional units according to the above method example. For example, each functional unit can be divided according to each function, or two or more functions can be integrated into one processing unit. The above integrated unit can be implemented in the form of hardware or in the form of software functional units. It should be noted that the division of units in the embodiment of the present application is schematic and is only a logical function division. There may be other division methods in actual implementation.
[0086] In line with the above, see Figure 4 , Figure 4 A schematic diagram of the structure of a robot arm optimization device is provided for an embodiment of the present application. Figure 4 As shown, the device comprises:
[0087] An acquisition unit 401 is used to acquire a reference motion trajectory of a manipulator arm of an industrial robot;
[0088] A first processing unit 402 is used to perform trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories;
[0089] The second processing unit 403 is used to perform scaling processing on each of the k sub-manipulator reference motion trajectories to obtain k sub-target manipulator motion trajectories;
[0090] The third processing unit 404 is used to combine the k sub-target robotic arm motion trajectories according to the time axis to obtain the target robotic arm motion trajectory.
[0091] An embodiment of the present application also provides a computer storage medium, wherein the computer storage medium stores a computer program for electronic data exchange, and the computer program enables a computer to execute part or all of the steps of any one of the robot arm operation trajectory optimization methods recorded in the above method embodiments.
[0092] An embodiment of the present application also provides a computer program product, which includes a non-transitory computer-readable storage medium storing a computer program, and the computer program enables a computer to execute part or all of the steps of any one of the robot arm trajectory optimization methods recorded in the above method embodiments.
[0093] It should be noted that, for the aforementioned method embodiments, for the sake of simplicity, they are all expressed as a series of action combinations, but those skilled in the art should be aware that the present application is not limited by the described order of actions, because according to the present application, certain steps can be performed in other orders or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by the present application.
[0094] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0095] In the several embodiments provided in the present application, it should be understood that the disclosed device can be implemented in other ways. For example, the device embodiments described above are only schematic, such as the division of the units, which is only a logical function division. There may be other division methods in actual implementation, such as 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, and the indirect coupling or communication connection of the device or unit can be electrical or other forms.
[0096] 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 network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0097] In addition, the functional units in the various embodiments of the 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 units may be implemented in the form of hardware or in the form of software program modules.
[0098] If the integrated unit is implemented in the form of a software program module and sold or used as an independent product, it can be stored in a computer-readable memory. Based on this understanding, the technical solution of the present application is essentially or the part that contributes to the prior art or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a memory, including a number of instructions to enable a computer device (which can be a personal computer, server or network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned memory includes: U disk, read-only memory (ROM), random access memory (RAM), mobile hard disk, disk or optical disk and other media that can store program codes.
[0099] A person of ordinary skill in the art can understand that all or part of the steps in the various methods of the above embodiments can be completed by instructing related hardware through a program, and the program can be stored in a computer-readable memory, which can include: a flash drive, a read-only memory, a random access memory, a magnetic disk or an optical disk, etc.
[0100] The embodiments of the present application are introduced in detail above. Specific examples are used in this article to illustrate the principles and implementation methods of the present application. The description of the above embodiments is only used to help understand the method and core idea of the present application. At the same time, for general technical personnel in this field, according to the idea of the present application, there will be changes in the specific implementation method and application scope. In summary, the content of this specification should not be understood as a limitation on the present application.
Claims
1. A method for optimizing the trajectory of a robotic arm. It is characterized in that Applied to an industrial robot, the method comprises: Obtain the reference motion trajectory of the industrial robot's manipulator arm; Performing trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories; Scaling each of the k sub-manipulator arm reference motion trajectories to obtain k sub-target manipulator arm motion trajectories, wherein the k sub-target manipulator arm motion trajectories satisfy the basic kinematics law; The k sub-target robot arm motion trajectories are combined according to the time axis to obtain the target robot arm motion trajectory.
2. The method for optimizing the trajectory of a robotic arm according to claim 1, It is characterized in that Each of the k sub-manipulator reference motion trajectories is scaled to obtain k sub-target manipulator motion trajectories, and the k sub-target manipulator motion trajectories satisfy the basic kinematics law, including: Performing runtime scaling processing on the motion trajectory of the first sub-target robot arm to obtain m scaled reference runtimes, the motion trajectory of the first sub-target robot arm being any one of the k sub-target robot arm motion trajectories; Energy consumption is calculated according to the m scaled reference running times to obtain energy consumption values corresponding to the m scaled reference running times; Determine a target running time, wherein the energy consumption value corresponding to the target running time is the minimum value of the energy consumption values corresponding to the m scaled reference running times; Determine the target running time as the running time corresponding to the sub-manipulator reference motion trajectory, and obtain the sub-target manipulator motion trajectory; Repeat the above steps from scaling the running time of the first sub-target robotic arm motion trajectory to obtain m scaled reference running times, to determining the target running time as the running time corresponding to the sub-robotic arm reference motion trajectory to obtain the sub-target robotic arm motion trajectory, until k sub-target robotic arm motion trajectories are obtained.
3. The method for optimizing the trajectory of a robotic arm according to claim 1, It is characterized in that The running time scaling process is performed on the motion trajectory of the first sub-target robot arm to obtain m scaled reference running times. The expression form of the running time scaling process calculation process is specifically as follows: tr=u(t) qs(t)=qr(tr)=qr(u(t)) Among them, tr is the reference trajectory time, u(t) is the time scaling function, qr(tr) is the reference trajectory of the robot, and qs(t) is the scaling trajectory of the robot.
4. The method for optimizing the robot arm's running trajectory according to claim 1, It is characterized in that The basic kinematics law includes spatial constraints, and the expression is as follows: Wherein, hk=tk+1-tk, hk is the time interval of the control segment, tk is the trajectory execution time variable at the kth control time point, tk+1 is the trajectory execution time variable at the k+1th control time point; Δ is a time increment; is the adjustment factor associated with the time interval hk; is the first derivative of the variable time scale scaling function u(t) at time k; is the first-order derivative of the variable time scale scaling function u(t) at time k+1.
5. The method for optimizing the trajectory of a robotic arm according to claim 1, It is characterized in that Energy consumption is calculated according to the m scaled reference running times, and energy consumption values corresponding to the m scaled reference running times are obtained, including: The energy consumption calculation model of the robotic arm is used to sequentially calculate the energy consumption values corresponding to the m scaled reference running times, and the reference energy consumption corresponding to the m scaled reference running times is obtained; According to the joint position, velocity, acceleration and execution time constraints, the reference energy consumptions corresponding to the m scaled reference running times are adjusted respectively to obtain the energy consumption values corresponding to the m scaled reference running times.
6. The method for optimizing the trajectory of a robot arm according to claim 5, It is characterized in that The energy consumption calculation model of the robotic arm is used to sequentially calculate the energy consumption values corresponding to the m scaled reference running times, and the reference energy consumption corresponding to the m scaled reference running times is obtained. The specific expression form of the energy consumption calculation model of the robotic arm is as follows: Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, is the current value on the stator during the motion of the i-th joint, and n is the number of joints of the industrial robot.
7. The method for optimizing the trajectory of a robot arm according to claim 5, It is characterized in that According to the joint position, velocity, acceleration and execution time constraints, the reference energy consumptions corresponding to the m scaled reference running times are adjusted respectively to obtain the energy consumption values corresponding to the m scaled reference running times. The specific expressions of the joint position, velocity, acceleration and execution time constraints are as follows: st-qi,max≤qi(t)≤qi,max t≤tmax Among them, E is the total power consumption value; U is the DC bus voltage; zi is the motor back electromotive force constant of the i-th joint, ei is the motor torque constant of the i-th joint, ni is the motor rotor inertia of the i-th joint, is the angular velocity of the i-th joint, ri is the reduction ratio of the reducer of the i-th joint, 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, qi,max is the maximum allowable angle of the i-th joint, is the maximum allowable angular velocity of the ith joint, is the maximum allowable angular acceleration of the ith joint, is the angular velocity of each joint at the initial moment, is the angular acceleration of each joint at the initial moment, tmax is the maximum allowed running time, and t is the time variable, which represents the current time during the robot's motion.
8. A robot arm trajectory optimization device, It is characterized in that The device comprises: An acquisition unit, used for acquiring a reference motion trajectory of a manipulator arm of an industrial robot; A first processing unit, configured to perform trajectory segmentation processing on the reference motion trajectory of the manipulator to obtain k sub-manipulator reference motion trajectories; A second processing unit is used to perform scaling processing on each of the k sub-manipulator reference motion trajectories to obtain k sub-target manipulator motion trajectories; The third processing unit is used to combine the k sub-target robotic arm motion trajectories according to the time axis to obtain the target robotic arm motion trajectory.
9. An electronic device comprising a processor and a memory connected to the processor for storing instructions executable by the processor, It is characterized in that The processor is used to execute the robot arm operation trajectory optimization method described in any one of claims 1-7 above.
10. A computer-readable storage medium, It is characterized in that The computer-readable storage medium stores a computer program, which includes program instructions. When the program instructions are executed by a processor, the processor executes the robot arm operation trajectory optimization method as described in any one of claims 1 to 6.
Citation Information
Cited By
Hydraulic mechanical arm global energy consumption optimization method fused with dynamic time domain planning
CN120244982A
A Global Energy Consumption Optimization Method for Hydraulic Robotic Arms Integrating Dynamic Time-Domain Programming
CN120244982B
