Multi-joint synchronous S-shaped speed curve trajectory planning method and device
通过计算机械臂各关节的运动时间段和调整最大速度,解决了多关节机械臂中同步S型速度曲线轨迹规划的难题,实现了加速度的连续性和同步性,提高了机械臂的运动效率和 Positioning accuracy.
Patent Information
- Application Number
- CN202411230308.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-04
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-09-04
AI Technical Summary
The prior art is difficult to implement synchronous S-type velocity curve trajectory planning in multi-joint robot arms, resulting in sudden acceleration changes, reducing the service life of the drive device and the positioning accuracy of the robot arms.
By obtaining the expected displacement, maximum velocity, maximum acceleration and fixed acceleration of each joint of the robot arm, calculate the velocity change, set multiple motion time periods, and adjust the motion time of other joints according to the longest total motion time, ensuring all Joints are synchronized and coordinated to optimize movement efficiency.
It realizes that each joint of the robot arm can complete tasks efficiently and accurately within the specified time, ensures the continuity and synchronization of acceleration, extends the service life of the drive device and improves positioning accuracy.
Smart Images

Figure CN118721218B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot arm control, and in particular to a multi-joint synchronous S-shaped speed curve trajectory planning method and device. Background Art
[0002] In order to make the robot arm appear visually synchronized during its movement, it is necessary to consider the synchronization of multiple joints, that is, how to ensure that the joints of the robot arm start and stop at the same time, and rotate to different angles or move different distances as desired.
[0003] The linear speed curve fitted by parabola can ensure that the speed of each joint of the robot arm changes continuously, and the calculation is relatively simple, so it has been widely used. However, this planning method cannot guarantee that the acceleration does not change suddenly, and the sudden acceleration will reduce the service life of the drive device and the positioning accuracy of the robot arm.
[0004] The trajectory planning method of the S-shaped velocity curve makes up for this shortcoming and ensures the continuity of acceleration. However, due to its complex calculation, previous research on this trajectory planning method has only focused on a single joint, and there are certain challenges in its application in multi-joint synchronization. Summary of the invention
[0005] In view of this, the present invention provides, on one hand, a multi-joint synchronous S-shaped speed curve trajectory planning method, comprising:
[0006] Get the expected displacement of each joint of the robot arm , Maximum speed absolute value , Maximum absolute value of acceleration and a fixed absolute value of jerk ;
[0007] According to the maximum absolute value of acceleration and the absolute value of jerk Calculate the speed change ;
[0008] According to the maximum speed absolute value , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint;
[0009] Calculate the total movement time of each joint according to the multiple movement time periods of each joint The maximum total exercise time is used as the reference standard. ;
[0010] According to the reference standard Reduce the maximum speed of each joint except the maximum total motion time to get the minimum available speed ;
[0011] According to the minimum available speed Determines whether to change the maximum absolute value of acceleration , and use the speed change according to the result , acceleration time and reference standards Calculating critical motion distance ;
[0012] Based on the minimum available speed , speed change and the maximum absolute value of acceleration Calculate the time of uniform acceleration ;
[0013] Based on the minimum available speed , acceleration time , Reference Standards , Maximum absolute value of acceleration , absolute value of jerk Uniform acceleration time Calculate the actual movement distance of the remaining joints ;
[0014] According to the critical movement distance The actual moving distance of the remaining joints The relationship between the remaining joints determines the movement time period;
[0015] like , then according to the actual moving distance of the remaining joints Set the remaining joint movement time periods to
[0016] ,
[0017] ,
[0018] ,
[0019] in, is the time it takes for a single joint to reach its maximum velocity.
[0020] Optionally, if , then according to the absolute value of the acceleration and maximum acceleration Calculate maximum speed ;
[0021] According to the reference standard , absolute value of jerk , maximum acceleration and maximum speed Calculate the actual movement distance of the remaining joints after correction ;
[0022] According to the actual moving distance of the remaining joints after correction Set the remaining joint movement time periods to
[0023] ,
[0024] ,
[0025] ,
[0026] in,
[0027] ,
[0028] ,
[0029] ,
[0030] .
[0031] Optionally, ,
[0032] .
[0033] Alternatively, the minimum available speed is obtained by: :
[0034] .
[0035] Optionally, the actual movement distance of each remaining joint is calculated using the following formula: :
[0036] .
[0037] Optionally, according to the minimum available speed Determines whether to change the maximum absolute value of acceleration ,include:
[0038] Determine the minimum available speed and size;
[0039] like , then determine the minimum available speed The absolute value of the maximum acceleration does not change ;
[0040] like , then determine the minimum available speed Change the maximum absolute value of acceleration , and calculate the maximum acceleration value after the change .
[0041] Optionally, the maximum speed can be calculated using the following formula: :
[0042] .
[0043] Optionally, according to the maximum speed absolute value , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint, including:
[0044] Determine the absolute value of the maximum speed and size;
[0045] like , then determine the moving distance of each joint to the target position The expected displacement ;
[0046] Determine the moving distance Is it greater than or equal to twice the moving distance of the acceleration segment? ;
[0047] like ≥2 , then each exercise time period is set to
[0048] ,
[0049] ,
[0050] ;
[0051] in, .
[0052] Optionally, it also includes:
[0053] like , then use the following formula to adjust the maximum absolute value of acceleration :
[0054] ;
[0055] in, is the absolute value of the maximum acceleration after adjustment.
[0056] Optionally, it also includes:
[0057] like <2 , then determine the minimum moving distance Is it less than or equal to the actual moving distance? ;
[0058] like ≤ , then each exercise time period is set to
[0059] ,
[0060] ,
[0061] ;
[0062] like > , then each exercise time period is set to
[0063] ,
[0064] .
[0065] Optionally, the minimum moving distance is calculated using the following formula: :
[0066] .
[0067] A second aspect of the present invention provides a multi-joint synchronized S-shaped speed curve trajectory planning device, the device comprising: a processor and a memory connected to the processor; wherein the memory stores instructions executable by the processor, and the instructions are executed by the processor so that the processor executes the above-mentioned multi-joint synchronized S-shaped speed curve trajectory planning method.
[0068] The present invention first plans the motion time periods of each joint of the robot arm, and sets a preliminary motion time for each joint based on parameters such as expected displacement, maximum speed and acceleration. By calculating the total motion time of each joint in each motion time period, the longest total motion time is determined as a reference standard, and the time frame of the joint motion of the entire robot arm is determined to ensure that all joints can complete the predetermined task synchronously. Subsequently, the joints of other short times are replanned according to the longest total motion time, and the reference standard is determined according to the longest total motion time, and the maximum speed of the remaining joints is reduced, so as to ensure that the motion time of the remaining joints is equal to the longest time, and ensure that the joints can be synchronized and coordinated during the entire motion process. Through this adjustment, the motion efficiency of each joint is optimized, so that each joint of the robot arm can efficiently and accurately complete the predetermined task within the specified time. BRIEF DESCRIPTION OF THE DRAWINGS
[0069] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0070] Figure 1 It is a flow chart of a multi-joint synchronous S-shaped speed curve trajectory planning method in an embodiment of the present invention;
[0071] Figure 2 It is an S-shaped speed curve diagram in an embodiment of the present invention. DETAILED DESCRIPTION
[0072] The technical solution of the present invention will be described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0073] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.
[0074] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, it can also be the internal connection of two components, it can be a wireless connection, or it can be a wired connection. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0075] In addition, the technical features involved in the different embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.
[0076] like Figure 1 As shown, an embodiment of the present invention provides a multi-joint synchronous S-shaped speed curve trajectory planning method, which is executed by an electronic device such as a computer or a server, and specifically includes:
[0077] S1, obtain the expected displacement of each joint of the robot arm , Maximum speed absolute value , Maximum absolute value of acceleration and a fixed absolute value of jerk These parameters are determined when designing and implementing the motion control of the robot. Desired displacement It refers to the displacement distance of each joint of the robot arm from the starting position to the target position in the corresponding task, and the maximum speed and maximum acceleration is a system design parameter, and jerk It is a fixed value set to ensure smooth acceleration of the robot system.
[0078] S2, according to the absolute value of the maximum acceleration and the absolute value of jerk Calculate the speed change .in, .
[0079] S3, according to the absolute value of the maximum speed , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint.
[0080] Figure 2It is a preset S-shaped speed curve, with the horizontal axis representing time and the vertical axis representing speed. It can be divided into 7 sections, representing acceleration motion with increasing acceleration, uniform acceleration motion, acceleration motion with decreasing acceleration, uniform speed motion, deceleration motion with increasing acceleration, uniform deceleration motion, and deceleration motion with decreasing acceleration. The time corresponding to each section is , , , , , , The corresponding accelerations for each period of time are ,0, ,0, ,0, .
[0081] According to the absolute value of the maximum velocity of each joint , Maximum absolute value of acceleration and speed change Calculate the time of the corresponding seven stages. For example, the seven movement time periods of the first joint are , , , , , , .
[0082] S4, calculating the total movement time of each joint according to multiple movement time periods of each joint The maximum total exercise time is used as the reference standard. .
[0083] For example, the total movement time of the first joint , and then the total movement time of each joint Compare and keep the largest , using this time as a reference standard , re-plan for the remaining joints with shorter motion time. Since the jerk of each joint is a fixed value, the purpose of re-planning is to obtain the specific value of each time period of each remaining joint, that is, to solve the jerk of each remaining joint. , , , , , , , so that the movement time planned by the remaining joints is the maximum .
[0084] S5, according to the reference standard Reduce the maximum speed of each joint except the maximum total motion time to get the minimum available speed .
[0085] The maximum absolute velocity of a single joint is known , Maximum absolute value of acceleration , speed change When , the time for a single joint to reach the maximum speed is calculated as
[0086] .
[0087] Reference standard time The time it takes for a single joint to reach maximum velocity Comparison to evaluate whether the robot can reach its maximum speed in a given time, where
[0088] The first case: If , then the speed can reach the maximum value, and the maximum movement distance is:
[0089] ,
[0090] The second case: If , then the time is not enough for the speed to reach the maximum value, and the maximum running distance at this time is:
[0091] ,
[0092] in, is the time period during which the jerk exists, such as Figure 2 The time period in which the jerk exists is , , , .
[0093] The third case: , at this time the maximum acceleration cannot be reached, and the maximum running distance is:
[0094] ,
[0095] The maximum movement distance that will be calculated Expected displacement For comparison,
[0096] like ≤ , then the remaining joints of the robot arm are at a given time Ability to reach or exceed the desired movement distance within In this case, the original maximum speed and acceleration can be used, and the total motion time parameter is ;
[0097] like > , then the remaining joints of the robot arm are at a given time Unable to reach the expected movement distance At this time, the maximum speed of the remaining joints needs to be reduced to ensure that the remaining joints of the robot arm can complete the motion task within the specified time.
[0098] The remaining joints of the robot arm are Unable to reach the expected movement distance By reducing its maximum speed, its movement time is prolonged to ensure the total movement time of the remaining joints The maximum speed after the reduction is called the minimum available speed. .
[0099] S6, based on the minimum available speed Determines whether to change the maximum absolute value of acceleration , and use the speed change according to the result , acceleration time and reference standards Calculating critical motion distance The critical condition is When , the critical movement distance is:
[0100] ,
[0101] S7, according to the minimum available speed , speed change and the maximum absolute value of acceleration Calculate the time of uniform acceleration Expected displacement , in this case, the motion process includes acceleration, constant speed and deceleration phases. Specifically, the maximum speed after the reduction Falling range, indicating that the acceleration and jerk of each joint are still within the design allowable range and do not need to be readjusted.
[0102] when , hour, , then the uniform acceleration time is:
[0103] ,
[0104] S8, based on minimum available speed , acceleration time , Reference Standards , Maximum absolute value of acceleration , absolute value of jerk Uniform acceleration time Calculate the actual movement distance of the remaining joints Since the maximum speed has changed, the time for uniform acceleration needs to be calculated. Recalculate the actual moving distance.
[0105] S9, judging the critical movement distance Is it greater than the actual moving distance? According to the critical movement distance The actual moving distance of the remaining joints The relationship between the remaining joints determines the remaining movement time period. The actual moving distance Compare and time the motion phases of the remaining joints in different situations. , then execute step S10, if the critical motion distance Is not greater than the actual moving distance , then execute step S11,
[0106] S10, based on the actual moving distance of the remaining joints Set the remaining joint movement time periods to
[0107] ,
[0108] ,
[0109] ,
[0110] in, is the time it takes for a single joint to reach its maximum velocity.
[0111] This embodiment first plans the movement time periods of each joint of the robot arm, sets a preliminary movement time for each joint based on parameters such as expected displacement, maximum speed and acceleration, calculates the total movement time of each joint in each movement time period, determines the longest total movement time as a reference standard, determines the time frame of the joint movement of the entire robot arm, and ensures that all joints can complete the scheduled tasks synchronously. Subsequently, the other short-time joints are replanned according to the longest total movement time, and the reference standard is determined according to the longest total movement time, and the maximum speed of the remaining joints is reduced, thereby ensuring that the movement time of the remaining joints is equal to the longest time, ensuring that each joint can be synchronized and coordinated during the entire movement process. Through this adjustment, the movement efficiency of each joint is optimized, so that the robot arm can efficiently and accurately complete the scheduled tasks within the specified time.
[0112] Further,
[0113] ,
[0114] ,
[0115] The minimum available speed is obtained by the following method :
[0116] ,
[0117] Use the following formula to calculate the actual moving distance of the remaining joints :
[0118] ,
[0119] Specifically, when the critical motion distance Less than or equal to the actual moving distance , it means that in the actual movement process, the actual moving distance is large enough to include multiple stages such as acceleration, uniform speed and deceleration stages of the entire movement process. , , , These four time periods are the time required for the acceleration phase, which is used for the acceleration and deceleration process. , , The time can be calculated specifically.
[0120] like Figure 2 For example, when , including seven exercise time periods , , , , , , The motion forms are respectively acceleration motion with increasing acceleration, uniform acceleration motion, acceleration motion with decreasing acceleration, uniform speed motion, deceleration motion with increasing acceleration, uniform deceleration motion, and deceleration motion with decreasing acceleration. The specific parameters of each motion time period of trajectory planning are: the time of acceleration motion with increasing acceleration , the time of accelerated motion with decreasing acceleration , the time of deceleration motion with increasing acceleration The time of deceleration motion with decreasing acceleration All the same, all The jerks in the seven motion stages are ,0, ,0, ,0, ; Time of uniformly accelerated motion The time of uniform deceleration motion All for , and their accelerations are , ; Time of uniform motion for , the maximum speed it reaches is , the actual moving distance of each remaining joint is .
[0121] Furthermore, if Figure 1 As shown, it also includes:
[0122] S11, if , then according to the absolute value of the acceleration and maximum acceleration Calculate maximum speed Actual moving distance Less than critical movement distance When the maximum speed is In this case, the actual moving distance is not enough to complete all the acceleration, constant speed and deceleration stages, so a new maximum speed needs to be determined by recalculation. , so that the actual movement distance can meet the movement requirements.
[0123] S12, according to the reference standard , absolute value of jerk , Maximum acceleration and maximum speed Calculate the actual movement distance of the remaining joints after correction After adjusting the maximum speed again, you need to calculate the corrected actual moving distance to ensure that the new speed setting meets the actual motion requirements.
[0124] S13, based on the actual moving distance of the remaining joints after correction Set the remaining joint movement time periods to
[0125] ,
[0126] ,
[0127] ,
[0128] in,
[0129] ,
[0130] ,
[0131] ,
[0132] ,
[0133] Use the following formula to calculate the maximum speed :
[0134] ,
[0135] Specifically, according to the adjusted maximum speed and the corrected actual moving distance , you need to reset the remaining joint movement time periods, such as Figure 2 For example, when Only five exercise periods are included , , , , The motion forms are respectively acceleration motion with increasing acceleration, acceleration motion with decreasing acceleration, uniform motion, deceleration motion with increasing acceleration, and deceleration motion with decreasing acceleration. The specific parameters of each motion time period of trajectory planning are: the time of acceleration motion with increasing acceleration , the time of accelerated motion with decreasing acceleration , the time of deceleration motion with increasing acceleration The time of deceleration motion with decreasing acceleration All the same, all The jerk of the five motion stages are , ,0, , , the accelerations are , ; Time of uniform motion for , the maximum speed it reaches is , the actual moving distance of each remaining joint is .
[0136] In one embodiment, in step S6, the minimum available speed Determines whether to change the maximum absolute value of acceleration , specifically including:
[0137] S61, determine the minimum available speed and After determining the total motion time, and determining the new maximum speed (minimum available speed ), determine the minimum available speed and The relationship is to ensure that in actual movement, the remaining joints of the robot arm can complete the predetermined acceleration and deceleration requirements.
[0138] S62, if , then determine the minimum available speed The absolute value of the maximum acceleration does not change .when When the minimum available speed is high enough to ensure that the switching between the acceleration phase and the deceleration phase is not restricted, the remaining joints of the robot can accelerate at the existing maximum absolute acceleration value. to complete the desired speed change.
[0139] S63, if , then determine the minimum available speed Change the maximum absolute value of acceleration , and calculate the maximum acceleration value after the change .when When the minimum available speed is not enough to meet the acceleration and deceleration requirements, the maximum acceleration absolute value needs to be adjusted. To adapt to the lower minimum available speed. In this case, the absolute value of the maximum acceleration value of steps S7, S8 and subsequent steps By properly setting the maximum acceleration absolute value and adjusting the minimum available speed, the movement process can be optimized, the stability and performance of the remaining joints can be improved, and overspeed, underspeed or instability can be avoided.
[0140] In one embodiment, step S3 is based on the maximum speed absolute value , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint, including:
[0141] S31, determine the absolute value of the maximum speed and When planning for a single joint, the maximum absolute speed that each joint can achieve is ,and is the speed change in the acceleration phase, is the speed change in the acceleration and deceleration stages, by judging and The size of can determine whether each joint can complete the entire motion process within the expected acceleration and deceleration sections.
[0142] S32, if , then determine the moving distance of each joint to the target position The expected displacement .when When the expected displacement (i.e. the distance between the target position and the starting position) is directly used as the moving distance , this is because the speed capacity of each joint is large enough to reach the maximum speed during acceleration and deceleration and complete the entire movement.
[0143] S33, determine the moving distance Is it greater than or equal to twice the moving distance of the acceleration segment? This step is to check the moving distance Is it long enough so that each joint can complete the complete S-shaped velocity curve movement, including multiple stages such as acceleration, constant speed and deceleration? is the distance required to move during the acceleration phase (including acceleration with increasing acceleration, uniform acceleration, and acceleration with decreasing acceleration). It is the acceleration and deceleration stage (acceleration with increasing acceleration, uniform acceleration, acceleration with decreasing acceleration, deceleration with increasing acceleration, uniform deceleration, deceleration with decreasing acceleration).
[0144] S34, if ≥2 , then each exercise time period is set to
[0145] ,
[0146] ,
[0147] ;
[0148] in, .
[0149] if ≥2 , indicating that there is enough distance to complete the entire S-curve movement. The specific planning settings are: Figure 2 For example, when ≥2 , including seven exercise time periods , , , , , , The motion forms are respectively acceleration motion with increasing acceleration, uniform acceleration motion, acceleration motion with decreasing acceleration, uniform speed motion, deceleration motion with increasing acceleration, uniform deceleration motion, and deceleration motion with decreasing acceleration. The specific parameters of each motion time period of trajectory planning are: the time of acceleration motion with increasing acceleration , the time of accelerated motion with decreasing acceleration , the time of deceleration motion with increasing acceleration The time of deceleration motion with decreasing acceleration All the same, all The jerks in the seven motion stages are ,0, ,0, ,0, ; Time of uniformly accelerated motion The time of uniform deceleration motion All for , and their accelerations are , ; Time of uniform motion for , the maximum speed it reaches is , the actual moving distance of each joint is .
[0150] S35, if , then use the following formula to adjust the maximum absolute value of acceleration :
[0151] ;
[0152] in, is the absolute value of the maximum acceleration after adjustment.
[0153] when When the maximum speed is not high enough, the acceleration needs to be increased to ensure that the required speed change can be completed during the acceleration and deceleration stages, so as to achieve smoother and more accurate motion control.
[0154] Furthermore, if <2 , then determine the minimum moving distance Is it less than or equal to the actual moving distance? .when <2 This means that the distance of the moving target point (Actual moving distance) is less than the total moving distance of the acceleration and deceleration stages of the S-shaped speed curve 2 At this time, it is necessary to consider whether it is possible to successfully complete multiple movement stages within this short moving distance, including acceleration with increasing acceleration, uniform acceleration, acceleration with decreasing acceleration, uniform speed, deceleration with increasing acceleration, uniform deceleration, and deceleration with decreasing acceleration. The shortest moving distance It can ensure that the acceleration reaches its maximum value, but it cannot guarantee the shortest moving distance when the speed reaches its maximum value.
[0155] like ≤ , then each exercise time period is set to
[0156] ,
[0157] ,
[0158] .
[0159] when ≤ There is enough distance to complete the acceleration and deceleration process, and to be able to smoothly transition between these stages. The specific planning settings are: Figure 2 For example, when ≤ , including six exercise time periods , , , , , The motion forms are respectively acceleration motion with increasing acceleration, uniform acceleration motion, acceleration motion with decreasing acceleration, deceleration motion with increasing acceleration, uniform deceleration motion, and deceleration motion with decreasing acceleration. The specific parameters of each motion time period of trajectory planning are: the time of acceleration motion with increasing acceleration , the time of accelerated motion with decreasing acceleration , the time of deceleration motion with increasing acceleration The time of deceleration motion with decreasing acceleration All the same, all The jerk of the six motion stages are ,0, , ,0, ; Time of uniformly accelerated motion The time of uniform deceleration motion All for , and their accelerations are , ; There is no uniform motion, and the maximum speed it reaches is , the actual moving distance of each joint is .
[0160] like > , then each exercise time period is set to
[0161] ,
[0162] .
[0163] The minimum moving distance is calculated using the following formula: :
[0164] .
[0165] when > When , it indicates the actual moving distance Less than the minimum required moving distance , which means that the distance is not enough to complete all stages of the S-curve. In this case, each joint cannot move at a given distance. The complete acceleration and deceleration process is completed within 10 seconds, so a simplified motion strategy must be adopted. The specific planning settings are: Figure 2 For example, when > time, including four exercise time periods , , , The motion forms are respectively acceleration motion with increasing acceleration, acceleration motion with decreasing acceleration, deceleration motion with increasing acceleration, and deceleration motion with decreasing acceleration. The specific parameters of each motion time period of trajectory planning are: the time of acceleration motion with increasing acceleration , the time of accelerated motion with decreasing acceleration , the time of deceleration motion with increasing acceleration The time of deceleration motion with decreasing acceleration All the same, all The jerk of the four motion stages are , , , The accelerations are , ; There is no uniform acceleration, uniform speed and uniform deceleration, and the maximum speed it reaches is , the actual moving distance of each joint is .
[0166] In this embodiment, the minimum moving distance is determined by and actual distance moved The relationship between the speed and velocity helps determine whether the expected S-shaped velocity curve can be completed within a given motion distance, and adjusts the motion strategy accordingly. Through this judgment, the system can ensure the smoothness, accuracy and effectiveness of the motion, thereby achieving high-quality motion control.
[0167] It will be appreciated by those skilled in the art that embodiments of the present invention may be provided as methods, systems, or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Furthermore, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0168] The present invention is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0169] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0170] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0171] Obviously, the above embodiments are merely examples for the purpose of clear explanation, and are not intended to limit the implementation methods. For those skilled in the art, other different forms of changes or modifications can be made based on the above description. It is not necessary and impossible to list all the implementation methods here. The obvious changes or modifications derived therefrom are still within the scope of protection of the invention.
Claims
1. A multi-joint synchronous S-shaped velocity curve trajectory planning method, It is characterized in that include: Get the expected displacement of each joint of the robot arm , Maximum speed absolute value , Maximum absolute value of acceleration and a fixed absolute value of jerk ; According to the maximum absolute value of acceleration and the absolute value of jerk Calculate the speed change ; According to the maximum speed absolute value , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint; Calculate the total movement time of each joint according to the multiple movement time periods of each joint The maximum total exercise time is used as the reference standard. ; According to the reference standard Reduce the maximum speed of each joint except the maximum total motion time to get the minimum available speed : , in is the actual moving distance of each of the remaining joints; According to the minimum available speed Determines whether to change the maximum absolute value of acceleration , and use the speed change according to the result , acceleration time and reference standards Calculating critical motion distance ; Based on the minimum available speed , speed change and the maximum absolute value of acceleration Calculate the time of uniform acceleration ; According to the critical movement distance The actual moving distance of the remaining joints The relationship between the remaining joints determines the movement time period; like , then according to the actual moving distance of the remaining joints Set the remaining joint movement time periods to , , , in , , The actual moving distance of each remaining joint With the minimum available speed The corresponding relationship is 。 2. The method according to claim 1, It is characterized in that like , then according to the absolute value of the acceleration and maximum acceleration Calculate maximum speed ; According to the reference standard , absolute value of jerk , maximum acceleration and maximum speed Calculate the actual movement distance of the remaining joints after correction ; According to the actual moving distance of the remaining joints after correction Set the remaining joint movement time periods to , , , in, , , , 。 3. The method according to claim 1, It is characterized in that According to the minimum available speed Determines whether to change the maximum absolute value of acceleration ,include: Determine the minimum available speed and size; like , then determine the minimum available speed The absolute value of the maximum acceleration does not change ; like , then determine the minimum available speed Change the absolute value of the maximum acceleration , and calculate the maximum acceleration value after the change .
4. The method according to claim 2, It is characterized in that The maximum speed is calculated using the following formula: : 。 5. The method according to claim 1, It is characterized in that According to the maximum speed absolute value , Maximum absolute value of acceleration and speed change Set multiple motion time periods in the S-shaped speed curve trajectory corresponding to each joint, including: Determine the absolute value of the maximum speed and size; like , then determine the moving distance of each joint to the target position The expected displacement ; Determine the moving distance Is it greater than or equal to twice the moving distance of the acceleration segment? ; like ≥2 , then each exercise time period is set to , , ; in, .
6. The method according to claim 5, It is characterized in that Also includes: like , then use the following formula to adjust the maximum absolute value of acceleration : ; in, is the absolute value of the maximum acceleration after adjustment.
7. The method according to claim 5, It is characterized in that Also includes: like <2 , then determine the minimum moving distance Is it less than or equal to the actual moving distance? ; like ≤ , then each exercise time period is set to , , ; like > , then each exercise time period is set to , 。 8. The method according to claim 7, It is characterized in that The minimum moving distance is calculated using the following formula: : 。 9. A multi-joint synchronous S-shaped speed curve trajectory planning device, It is characterized in that include: A processor and a memory connected to the processor; wherein the memory stores instructions executable by the processor, and the instructions are executed by the processor so that the processor executes the multi-joint synchronized S-shaped speed curve trajectory planning method as described in any one of claims 1-8.
