Motion control method, device and equipment of load platform and computer readable medium

Optimizing the load platform motion control through the principle of standard displacement segmentation and proportional scaling, solving the problem of incompatibility of motion control laws in the prior art, and improving the flexibility and efficiency of motion control.

CN119087778APending Publication Date: 2024-12-06NANJING CHENGUANG GRP
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202411045240.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-31
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

The existing load platform motion control system is not compatible with a variety of acceleration and deceleration motion control rules, resulting in inflexible motion trajectory planning, complex calculations and inefficient efficiency.

Method used

By obtaining target motion information, determining the standard displacement according to the motion control laws and dividing it into multiple standard motion segments, segmenting any displacement according to the displacement size using the minimum time principle or proportional scaling principle, and inserting a uniform motion segment to optimize the motion time.

Benefits of technology

Compatibility of a variety of acceleration and deceleration motion control rules is achieved, the planning process is simplified, and the understanding of computing efficiency and motion efficiency is improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119087778A_ABST
    Figure CN119087778A_ABST
Patent Text Reader

Abstract

The invention discloses a motion control method, device and equipment of a load platform and a computer readable medium. The method comprises the following steps: acquiring target motion information of a load platform, wherein the target motion information comprises a target stroke and a motion control rule; a motion process corresponding to the standard displacement is determined according to the motion control rule, the motion process corresponding to the standard displacement is divided into a plurality of standard motion sections according to time, and the standard motion sections at least comprise an acceleration process section and a deceleration process section; any displacement in the target stroke is selected to be compared with the standard displacement, and any displacement is segmented according to the comparison result and based on the segmentation result of the standard displacement. The motion control scheme of the load platform provided by the invention can be compatible with various acceleration and deceleration motion control rules, and is good in universality and strong in compatibility.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of motion control technology, and in particular to a motion control method, device, equipment and computer-readable medium for a load platform. Background Art

[0002] With the development of automation in industries such as aerospace, weapons and equipment, and intelligent manufacturing, precise control of motion trajectory is the key to ensuring equipment stability, efficiency, and safety. Especially for large-load test turntables, due to their large inertia, they are prone to shock and vibration during movement, affecting system stability, operating efficiency, and accuracy.

[0003] In order to solve the running stability of the large-load test turntable, ensure that there is no impact and vibration during the acceleration and deceleration process, and improve the positioning accuracy, the trajectory planning technology can be used to achieve the requirements of smooth transition and high-speed movement of the equipment, and improve the accuracy and efficiency of motion control. In addition, as a test turntable, due to different load characteristics and the ability to withstand impact, it is necessary to plan the motion process based on different acceleration and deceleration motion control laws according to the differences in load conditions. The existing trajectory planning methods, such as those based on trapezoidal acceleration and deceleration motion control laws, have simple algorithms and are easy to implement, but poor smoothness. The higher the flexibility of the acceleration and deceleration motion control law, the greater the amount of calculation. For target displacements of different sizes, complex judgment processing is often required to obtain the boundary conditions and segmentation conditions of each acceleration and deceleration stage, which is complex to program and inefficient. According to the requirements of different application scenarios, you can choose a trajectory planning method with slightly worse performance but simple implementation, or a trajectory planning method with complex calculation but better stability, but the processing processes of different acceleration and deceleration planning methods are quite different, and there is currently no unified and flexible planning method. Summary of the invention

[0004] In order to solve at least one technical problem existing in the above-mentioned prior art, the embodiments of the present invention provide a motion control method, device, equipment and computer-readable medium for a load platform. The technical solution is as follows:

[0005] In a first aspect, a motion control method for a load platform is provided, the method comprising:

[0006] Acquire target motion information of the load platform, wherein the target motion information includes: target travel and motion control law;

[0007] Determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into a plurality of standard motion segments according to time, wherein the standard motion segments at least include: an acceleration process segment and a deceleration process segment;

[0008] Randomly select any displacement in the target stroke and compare it with the standard displacement, and segment the random displacement according to the comparison result and based on the segmentation result of the standard displacement.

[0009] Furthermore, the motion process of the standard displacement is determined according to the motion control law, and the motion process of the standard displacement is divided into a plurality of standard motion segments according to time, including:

[0010] Determine the motion process corresponding to the standard displacement according to the motion control law, wherein the motion process of the standard displacement includes: any one or more of the relationship between displacement and time, the relationship between speed and time, and the relationship between acceleration and time;

[0011] Determine the segment time parameters of the motion process for the standard displacement.

[0012] Furthermore, the selecting of any displacement in the target stroke and comparing it with the standard displacement, and segmenting the arbitrary displacement according to the comparison result and based on the segmentation result of the standard displacement, comprises:

[0013] If the arbitrary displacement is greater than and equal to the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle;

[0014] If the arbitrary displacement is smaller than the standard displacement, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to a scaling principle.

[0015] Furthermore, if the arbitrary displacement is greater than and equal to the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle includes:

[0016] Corresponding the standard motion segments divided by the standard displacement to the arbitrary displacement;

[0017] Inserting a uniform motion segment running at a maximum allowable running speed into the arbitrary displacement, and calculating the motion time corresponding to the uniform motion segment, wherein the maximum allowable running speed is obtained according to the motion control law;

[0018] The movement time of each movement segment in the arbitrary displacement is determined according to the movement time of the standard movement segment in the arbitrary displacement and the movement time of the uniform movement segment.

[0019] Furthermore, if the arbitrary displacement is smaller than the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the scaling principle includes:

[0020] Corresponding the standard motion segments divided by the standard displacement to the arbitrary displacement;

[0021] According to the motion time of each standard motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is calculated using a mapping relationship function.

[0022] Furthermore, the mapping relationship function is:

[0023]

[0024] Among them, T L-i is the motion time of each motion segment, f is the mapping relationship function, L is the arbitrary motion segment, L0 is the standard motion segment, t 0-i is the motion time of the standard motion segment, i=1,2...n, λ is the proportional scaling factor, λ=1,2...n.

[0025] Further, the determination of the scaling factor includes:

[0026] Calculating the maximum running speed and the maximum acceleration in the arbitrary displacement according to the preset scaling factor;

[0027] The determined scaling factor is the scaling factor that satisfies the maximum operating speed equal to the maximum allowable operating speed and the maximum acceleration equal to the maximum allowable acceleration, and the maximum allowable operating speed and the maximum allowable acceleration are obtained according to the motion control law.

[0028] In a second aspect, a motion control device for a load platform is provided, the device comprising:

[0029] An information acquisition module is used to acquire target motion information of the load platform, wherein the target motion information includes: target travel and motion control law;

[0030] A standard displacement segmentation module is used to determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into a plurality of standard motion segments according to time, wherein the standard motion segments at least include: an acceleration process segment and a deceleration process segment;

[0031] The arbitrary displacement segmentation module is used to compare any displacement in the target stroke with the standard displacement, and segment the arbitrary displacement according to the comparison result and based on the segmentation result of the standard displacement.

[0032] Furthermore, the standard displacement segmentation module is specifically used for:

[0033] Determine the motion process corresponding to the standard displacement according to the motion control law, the motion process of the standard displacement includes: any one or more of the relationship between displacement and time, the relationship between velocity and time, and the relationship between acceleration and time;

[0034] Determine the segment time parameters for the motion process for the standard displacement.

[0035] Furthermore, the arbitrary displacement segmentation module includes:

[0036] The first sub-segmentation module is used to segment the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle when the arbitrary displacement is greater than and equal to the standard displacement;

[0037] The second sub-segmentation module is used for segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the scaling principle when the arbitrary displacement is smaller than the standard displacement.

[0038] Furthermore, the first sub-segment module is specifically used for:

[0039] Correspond the standard motion segments divided by standard displacement to any displacement;

[0040] Insert a uniform motion segment running at the maximum permissible running speed in any displacement, and calculate the motion time corresponding to the uniform motion segment. The maximum permissible running speed is obtained according to the motion control law;

[0041] According to the motion time of the standard motion segment and the motion time of the uniform motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is determined.

[0042] Furthermore, the second sub-segment module is specifically used for:

[0043] Correspond the standard motion segments divided by standard displacement to any displacement;

[0044] According to the motion time of each standard motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is calculated using a mapping relationship function.

[0045] Furthermore, the mapping relationship function is:

[0046]

[0047] Among them, T L-i is the motion time of each motion segment, f is the mapping relationship function, L is the arbitrary motion segment, L0 is the standard motion segment, t 0-i is the motion time of the standard motion segment, i=1,2...n, λ is the proportional scaling factor, λ=1,2...n.

[0048] Further, the determination of the scaling factor includes:

[0049] Calculating the maximum running speed and the maximum acceleration in the arbitrary displacement according to the preset scaling factor;

[0050] The determined scaling factor is the scaling factor that satisfies the maximum operating speed equal to the maximum allowable operating speed and the maximum acceleration equal to the maximum allowable acceleration, and the maximum allowable operating speed and the maximum allowable acceleration are obtained according to the motion control law.

[0051] In a third aspect, an electronic device is provided, including:

[0052] one or more processors; and

[0053] A memory associated with the one or more processors, the memory being used to store program instructions, wherein the program instructions, when read and executed by the one or more processors, execute any method described in the first aspect.

[0054] According to a fourth aspect, a computer-readable medium is provided, on which a computer program is stored, wherein when the program is executed by a processor, the method described in any one of the first aspects is implemented.

[0055] The technical solution provided by the embodiment of the present invention has the following beneficial effects:

[0056] (1) The motion control solution of the load platform proposed in the present invention is compatible with a variety of acceleration and deceleration motion control laws, and has good versatility and strong compatibility.

[0057] (2) The motion control scheme of the load platform proposed in the present invention can plan the acceleration and deceleration planning process for arbitrary displacement based on the minimum time principle and a fixed proportional scaling factor, making the acceleration and deceleration planning simpler and easier to implement, which can effectively improve the solution efficiency.

[0058] (3) The motion control scheme of the load platform proposed in the present invention fully utilizes the maximum operating speed efficiency and the acceleration performance with constant acceleration amplitude, and has high motion efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0059] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0060] Figure 1A schematic diagram of a motion control method for a load platform disclosed in an embodiment of the present invention;

[0061] Figure 2 It is a schematic diagram of the insertion process of the uniform motion segment;

[0062] Figure 3 The curve relationship between displacement, velocity and acceleration of the trigonometric function motion law;

[0063] Figure 4 is an arbitrary L speed curve based on the minimum time principle;

[0064] Figure 5 For the sinusoidal motion law, T keeps the acceleration curve relationship constant;

[0065] Figure 6 The law of sinusoidal motion T keeps the velocity curve constant;

[0066] Figure 7 The relationship between the stroke curve and the sinusoidal motion law T remains unchanged;

[0067] Figure 8 The acceleration curve relationship when T is a geometric relationship for the law of sinusoidal motion;

[0068] Fig. 9 The velocity curve relationship when T is a geometric relationship for the law of sinusoidal motion;

[0069] Fig.10 The relationship between the stroke curve and the sinusoidal motion law T remains unchanged;

[0070] Fig.11 This is the acceleration curve relationship when the sinusoidal motion law T is transformed to 1 / 2;

[0071] Fig.12 The velocity curve relationship when the sinusoidal motion law T is transformed to 1 / 2;

[0072] Fig.13 The travel curve relationship when the sinusoidal motion law T is transformed to 1 / 2;

[0073] Fig.14 This is the acceleration curve relationship when the sinusoidal motion law T is transformed to 1 / 3;

[0074] Fig.15 The velocity curve relationship when the sinusoidal motion law T is transformed to 1 / 3;

[0075] Fig.16 The travel curve relationship when the sinusoidal motion law T is transformed to 1 / 3;

[0076] Fig.17 It is the position curve of S-type motion law;

[0077] Fig.18 It is the speed curve of S-type motion law;

[0078] Fig.19 It is the acceleration curve of S-type motion law;

[0079] Fig. 20 The relationship between the stroke curves when the S motion law T is transformed to 1 / 3;

[0080] Fig.21 The velocity curve relationship when T is 1 / 3 of the S motion law;

[0081] Fig. 22 It is the relationship of the acceleration curve when the S motion law T is transformed to 1 / 3;

[0082] Fig.23 This is a schematic diagram of the module structure of the motion control device for the load platform provided by the embodiment of the present invention.

[0083] Fig.24 It is a schematic diagram of the structure of an electronic device provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0084] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution in the embodiment of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiment of the present invention. Obviously, the described embodiment is only a part of the embodiment of the present invention, not all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0085] The motion trajectory planning of the load platform is usually implemented based on motion control laws, and different motion control laws can meet different test requirements. However, the current motion control system of the load platform is not compatible with different motion control laws to plan the motion trajectory of the load platform, which makes the motion control of the load platform relatively rigid and not flexible enough. In order to solve the problems existing in the prior art, the embodiments of the present invention provide a motion control method, device, equipment and computer-readable medium for a load platform, and the specific technical solutions are as follows:

[0086] like Figure 1 As shown, a motion control method for a load platform includes:

[0087] S1. Obtain target motion information of the load platform, wherein the target motion information includes: target travel and motion control law.

[0088] S2. Determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into multiple standard motion segments according to time.

[0089] S3. Compare any displacement in the target stroke with the standard displacement, and segment the arbitrary displacement according to the comparison result and the segmentation result of the standard displacement.

[0090] In the above step S1, the target stroke may include: stroke length, stroke direction, and stroke time. The motion control law may be selected from a pre-established motion control law library, which may include but is not limited to triangular acceleration and deceleration motion laws, trapezoidal acceleration and deceleration motion laws, sinusoidal acceleration and deceleration motion laws, S-shaped acceleration and deceleration motion laws, and polynomial acceleration and deceleration motion laws. The motion control law may be selected according to the load conditions of the load platform and the product conditions of the load product.

[0091] In step S2, the motion process corresponding to the standard displacement may include any one or more of the relationship between displacement and time, the relationship between speed and time, and the relationship between acceleration and time. The standard motion segment includes at least one acceleration process segment and one deceleration process segment. According to the speed and acceleration change characteristics of the motion law selected in step S1, the acceleration and deceleration motion process of the standard displacement can be divided into at least two standard motion segments.

[0092] In step S3, the standard displacement is a standard displacement determined according to the motion control law, and the arbitrary displacement is an arbitrary displacement in the target stroke. Segmenting the arbitrary displacement based on the segmentation result of the standard displacement can make the segmentation of the arbitrary displacement conform to the motion control law.

[0093] In one embodiment, step S2 includes:

[0094] Determine the motion process corresponding to the standard displacement according to the motion control law;

[0095] Determine the segment time parameters for the motion process for the standard displacement.

[0096] As an example, the motion control process of the standard displacement L0 is divided into n standard motion segments (n≥2), and the motion time of each standard motion segment is t 0-i , where i is the descriptive name of each motion control segment. Each standard motion segment t 0-i The relationship between travel and time is expressed as S 0-i (t) represents the relationship between speed and time, and V 0-i (t) represents the relationship between acceleration and time, and J 0-i (t). Based on the relationship between the mutual derivatives and integrals of stroke, speed and acceleration, V 0-i (t) represents the motion of each segment, and the expression is as follows:

[0097]

[0098] In this way, the standard displacement can be segmented into time segments based on the motion control law.

[0099] In one embodiment, step S3 specifically includes:

[0100] If the arbitrary displacement is greater than and equal to the standard displacement, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to the minimum time principle;

[0101] If the arbitrary displacement is smaller than the standard displacement, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to the scaling principle.

[0102] As mentioned above, the motion control process of the load platform is based on The relationship between the size of arbitrary displacement and standard displacement , the motion process of arbitrary displacement is segmented according to different calculation principles.

[0103] For example, the magnitude relationship between the arbitrary displacement L and the standard displacement L0 is judged, and according to the judgment result, the motion process is divided into m segments according to different calculation principles, and the running time of each segment is T L-i (i=1,2,3…m). When L is greater than or equal to the standard displacement L0, according to principle A: Based on the minimum time principle "Assign the movement time T of each movement segment of L L-i When the arbitrary displacement L is less than the standard displacement L0, according to principle B: Scaling principle "Allocate exercise time T to each exercise segment L-i .

[0104] In one embodiment, the segmentation of any displacement based on the “minimum time principle” is related to the maximum allowable running speed of the target stroke, that is, the minimum time principle T min (V max ), L≥L0. The maximum permissible operating speed is obtained based on the acquired motion control law.

[0105] Specifically, in step S3, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to the minimum time principle, including:

[0106] Correspond the standard motion segments divided by standard displacement to any displacement;

[0107] Insert a uniform motion segment running at the maximum allowed running speed into any displacement, and calculate the motion time corresponding to the uniform motion segment;

[0108] According to the motion time of the standard motion segment and the motion time of the uniform motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is determined.

[0109] As mentioned above, if the arbitrary displacement is greater than and equal to the standard displacement, the acceleration and deceleration motion law of the arbitrary displacement is solved according to the minimum time principle. Exemplarily, the acceleration and deceleration motion process of the arbitrary displacement L is divided into m segments, and m=n+1, where the n-segment motion process is the same as the n standard motion segments of the standard displacement L0, that is, in the arbitrary displacement corresponding to the standard motion segments divided by the standard displacement, one segment of the motion process is an inserted uniform motion segment running at the maximum allowable running speed. The time used by the n motion segments is consistent with the motion curve of the motion control law, and the motion time T of the n segment is the same as the standard motion segment of the standard displacement L0. L-i The time relationship with the standard motion segment is shown as follows:

[0110] T L-i =t 0-i (i=1,2...n) (2)

[0111] Insert a speed equal to V in the middle of segment n. max The uniform motion segment of the uniform motion is represented by LV max The increase process of uniform motion segment is shown in the following figure. Figure 2 As shown, Figure 2 The uniform motion segment is inserted between the acceleration process segment and the deceleration process segment. The motion time of the uniform motion segment is T L-Vmax , the calculation formula is as follows:

[0112]

[0113] According to equations (2) and (3), the total time t of the acceleration and deceleration motion segment of L can be obtained: L for:

[0114]

[0115] Based on the minimum time principle, for each acceleration and deceleration motion curve of any displacement L greater than or equal to L0, the speed and time relationship V of the process can be used. L (t) is expressed as follows:

[0116]

[0117] In one embodiment, " Scaling principle "The scaling value is calculated based on the mapping function f.

[0118] In step S3, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to the scaling principle, including:

[0119] Correspond the standard motion segments divided by standard displacement to any displacement;

[0120] According to the motion time of each standard motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is calculated using a mapping relationship function.

[0121] In one embodiment, the mapping function f is related to the ratio of the arbitrary displacement L to the standard displacement L0, that is, Specifically, the mapping relationship function is:

[0122]

[0123] Among them, T L-i is the motion time of each motion segment, f is the mapping relationship function, L is the arbitrary motion segment, L0 is the standard motion segment, t 0-i is the motion time of the standard motion segment, i=1,2...n, λ is the proportional scaling factor, λ=1,2...n.

[0124] When the λ value is selected, the running time T of each segment can be obtained. L-i , then the total time t of the motion process of any displacement L is L for:

[0125]

[0126] According to formula (7), different values ​​of λ result in different running times of different motion segments, and different acceleration and deceleration trajectories after proportional scaling.

[0127] In one embodiment, the value of λ needs to satisfy the maximum allowable running speed and maximum allowable acceleration of the load platform in the target stroke. The maximum allowable running speed and maximum allowable acceleration are obtained based on the motion control law. Therefore, the determination of the proportional scaling factor includes:

[0128] Calculate the maximum running speed and maximum acceleration in any displacement according to the preset scaling factor;

[0129] The determined scaling factor is a scaling factor that satisfies the maximum operating speed being equal to the maximum allowed operating speed and the maximum acceleration being equal to the maximum allowed acceleration.

[0130] As described above, for example, according to the relationship between the stroke, speed, acceleration and time of the motion control law, the arbitrary displacement L and the running time T of each motion segment are calculated. L-i The relationship is expressed as follows:

[0131]

[0132] According to formula (8), V L-i (t) and V L (t), further V L(t) integration, we can get the relationship between travel and time S L (t), V L (t) By taking the derivative, we can get the relationship between acceleration and time J L (t), which is expressed as follows:

[0133]

[0134]

[0135] According to equations (6)-(10), the motion process S of any displacement L after scaling can be obtained: L (t), V L (t), J L (t). You can select different positive integers from 1 to the largest as the λ value to calculate V L (t), J L (t), determine if VL(t) = V max , and JL(t)=J max The λ value below is the final scaling factor λ. If it does not meet the requirements, add 1 to this value and repeat the above process until a scaling factor that meets the requirements is obtained.

[0136] The following describes in detail the motion control method of the load platform disclosed in the embodiment of the present invention by taking the sinusoidal acceleration and deceleration motion law as an example:

[0137] If the load platform selects the sinusoidal acceleration and deceleration motion law from the motion control law library as the basic acceleration and deceleration planning curve of motion control under a certain working condition, the acceleration and time relationship J(t), speed and time relationship V(t), and stroke and time relationship S(t) of the actuator during motion can be obtained as shown in the following formula:

[0138]

[0139] Where A is the amplitude of the sinusoidal acceleration and deceleration motion law, ω is the angular frequency of the sinusoidal acceleration and deceleration motion law, and the expression is as follows:

[0140]

[0141] Where L is any displacement and T is the time required to execute L. The constraint conditions are determined according to the sinusoidal acceleration and deceleration motion control law, where the amplitude of the sinusoidal velocity curve is the maximum allowable velocity, i.e. V max =2L0 / T0, the acceleration curve amplitude is the maximum allowable acceleration value J max =2πL0 / T0 2 L0 is the standard displacement, and T0 is the time required to perform the standard displacement.

[0142] Let \(L_0 = 10\) and \(T_0 = 5\). Substituting these values into Equation (11) gives the relationship between the travel and time \(S_0(t)\), the relationship between the velocity and time \(V_0(t)\), and the relationship between the acceleration and time \(J_0(t)\) of the standard displacement \(L_0\), as shown in the appendix Figure 3 as follows.

[0143] According to the appendix Figure 3 it can be intuitively seen that the sine acceleration and deceleration motion law can divide the motion process of the standard displacement \(L_0\) into two segments, namely the sine acceleration segment and the sine deceleration segment. When \(0 \lt t \leq 0.5T_0\), it is the sine acceleration segment, and when \(0.5T_0 \lt t \leq T_0\), it is the sine deceleration segment.

[0144] Given any displacement \(L\), by judging the size relationship with the standard displacement \(L_0\), the processing methods based on the minimum time principle and the proportional scaling principle are respectively selected to plan the acceleration and deceleration motion process of any displacement \(L\).

[0145] Case 1: Assume \(L = 2L_0\), that is, the case where any displacement \(L\) is greater than the standard displacement \(L_0\). Based on the minimum time principle, a uniform motion segment is added in the middle of the two standard motion segments of the standard displacement \(L_0\). The uniform motion segment runs at the maximum operating speed \(V\) max and substituting the arbitrary displacement \(L = 2L_0\) into Equation (3) gives the running time of the uniform motion segment in the above process as follows:

[0146]

[0147] Inserting the uniform motion segment into the middle of the standard motion segments gives the acceleration and deceleration planning curve of the arbitrary displacement \(L = 2L_0\), and its velocity curve is as shown in the appendix Figure 4 as follows. The motion process is divided into three segments in total, and the sine acceleration segment and the sine deceleration segment are consistent with the acceleration and deceleration process of the standard displacement \(L_0\).

[0148] Case 2: If arbitrary displacements less than the standard displacement are selected, namely \(L_1 = 0.5L\), \(L_2 = 0.2L\), \(L_3 = 0.125L\), \(L_4 = 0.1L\).

[0149] If the solution method based on the proportional scaling principle proposed in the present invention is not adopted, let the motion time \(T = T_0\) under the travels of \(L_1\) to \(L_4\), that is, the time remains unchanged. The relationship between the acceleration and time of the standard displacements \(L = L_0\) and \(L_1\) to \(L_4\) is plotted as shown in the appendix Figure 5 , the relationship between the velocity and time is as shown in the appendix Figure 6 as follows, and the relationship between the travel and time is as shown in the appendix Figure 7 as follows. According to what is shown in the appendix Figure 5-7 as follows, if the above travel time is kept unchanged, as the displacements of \(L_1\) to \(L_4\) gradually decrease, the maximum velocity value and the maximum acceleration value during the motion process also gradually decrease. At this time, although the conditions of the maximum operating speed and the maximum operating acceleration are satisfied, the capabilities of the maximum speed and the maximum acceleration are not fully utilized, and the operating efficiency is low.

[0150] The processing method based on the proportional scaling principle proposed in the embodiment of the present invention divides the displacement L1-L4 motion process into two segments. According to the sinusoidal acceleration and deceleration motion law, the running time of the two segments is equal. According to the proportional scaling principle, the duration of each segment of the displacement L1-L4 is calculated as follows, as shown in formula (6):

[0151]

[0152] First, select the scaling factor λ = 1, that is, scale the standard displacement proportionally to the acceleration and deceleration process of any displacement, where the acceleration and time relationship of L1~L4 is as shown in the attached figure. Figure 8 The relationship between speed and time is shown in the attached Fig. 9 The relationship between itinerary and time is shown in the attached Fig.10 As shown, according to the comparison between the standard displacement and the L1~L4 displacement, it can be seen that the maximum value of the acceleration and deceleration process under the L1~L4 displacement satisfies V max limit, but the maximum acceleration exceeds J max , that is, λ=1 does not conform to the principle of selecting the value of the scaling factor λ.

[0153] Therefore, add 1 to the scaling factor, select the scaling factor λ=2, repeat the above process, that is, T is scaled by 1 / 2 transformation ratio, and obtain the acceleration and time relationship of the standard displacement and displacement L1~L4 under the transformation process as shown in the attached figure. Fig.11 The relationship between speed and time is shown in the attached Fig.12 The relationship between itinerary and time is shown in the attached Fig.13 As shown, according to the comparison between the standard displacement and the L1~L4 displacement, it can be seen that the maximum value of the acceleration and deceleration process under the L1~L4 displacement satisfies V max Limit, but the maximum acceleration is equal to J max , that is, λ = 2 conforms to the principle of selecting the value of the proportional scaling factor λ. Substituting λ = 2 into equations (7)-(11) can obtain the relationship between acceleration, velocity, displacement and time when any displacement is less than the standard displacement under the law of sinusoidal acceleration and deceleration motion. Taking L1 as an example, it is as follows:

[0154]

[0155] Where A1 is the velocity curve amplitude under the sine function motion law when the displacement is L1, ω1 is the angular frequency of the sine acceleration and deceleration motion law, and the expression is as follows:

[0156]

[0157] The total time T1 used is expressed as follows:

[0158]

[0159] To verify the correctness of the scaling factor selection principle of the present invention, if the scaling factor λ=3 is selected, the above process is repeated to observe the acceleration and time relationship of the standard displacement and the displacement L1~L4 when T is 1 / 3. Fig.14 The relationship between speed and time is shown in the attached Fig.15 The relationship between itinerary and time is shown in the attached Fig.16 As shown, according to the comparison between the standard displacement and the L1~L4 displacement, it can be seen that the maximum value of the acceleration and deceleration process under the L1~L4 displacement satisfies V max Limit, the maximum acceleration is less than J max , the acceleration performance cannot be fully utilized and the operating efficiency is low, that is, λ=3 does not meet the principle of selecting the value of the proportional scaling factor λ.

[0160] The proportional scaling factor λ=2 is fixed in the motion control system. If the sinusoidal acceleration and deceleration motion law is selected as the basic curve of motion control, the acceleration and deceleration planning can be realized for any displacement according to the two cases in the above steps, and there is no need to repeatedly calculate the λ value. If the arbitrary displacement is greater than the standard displacement, a uniform motion segment is added according to formula (13). If the arbitrary displacement is less than the standard displacement, the duration of each segment is calculated according to formula (14). The acceleration and deceleration planning process of the displacement is quickly obtained according to formula (15).

[0161] Similarly, if the five-stage S-shaped acceleration and deceleration motion law is selected, the acceleration and deceleration motion planning can still be efficiently implemented according to the steps proposed by the present invention, so that the constraint condition V of the motion control system max =20, J max =10, standard displacement L0 = 80, required time T0 = 7, as shown in the attached Figure 17-19 As shown, it is the curve relationship between the stroke, speed, acceleration and time of the five-stage S-shaped acceleration and deceleration motion law under the standard displacement. According to the method proposed by the present invention, when the arbitrary displacement L is greater than or equal to the standard displacement L0, an additional uniform speed segment is allocated based on the minimum time principle. If it is judged that the arbitrary displacement L is less than the standard displacement L0, the specific value of the proportional scaling factor λ is determined according to the proportional scaling principle, and finally the proportional scaling factor value is confirmed to be λ=3. This parameter is solidified in the motion control system. If the given arbitrary displacement L is less than the standard displacement L0, the acceleration and deceleration planning is carried out according to the 1 / 3 proportional scaling principle, as shown in the attached figure. Figure 20-22 shown.

[0162] Based on the motion control method of the load platform disclosed in the above embodiment of the present invention, Fig.23 As shown, an embodiment of the present invention further provides a motion control device for a load platform, comprising:

[0163] The information acquisition module 201 is used to acquire the target motion information of the load platform, and the target motion information includes: target travel and motion control law;

[0164] The standard displacement segmentation module 202 is used to determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into a plurality of standard motion segments according to time, wherein the standard motion segment at least includes: an acceleration process segment and a deceleration process segment;

[0165] The arbitrary displacement segmentation module 203 is used to compare any displacement in the target stroke with the standard displacement, and segment the arbitrary displacement according to the comparison result and the segmentation result based on the standard displacement.

[0166] In one embodiment, the standard displacement segmentation module 202 is specifically used for:

[0167] Determine the motion process corresponding to the standard displacement according to the motion control law, the motion process of the standard displacement includes: any one or more of the relationship between displacement and time, the relationship between velocity and time, and the relationship between acceleration and time;

[0168] Determine the segment time parameters for the motion process for the standard displacement.

[0169] In one embodiment, the arbitrary displacement segmentation module 203 includes:

[0170] The first sub-segmentation module is used to segment the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle when the arbitrary displacement is greater than and equal to the standard displacement;

[0171] The second sub-segmentation module is used for segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the scaling principle when the arbitrary displacement is smaller than the standard displacement.

[0172] In one embodiment, the first sub-segment module is specifically configured to:

[0173] Correspond the standard motion segments divided by standard displacement to any displacement;

[0174] Insert a uniform motion segment running at the maximum permissible running speed in any displacement, and calculate the motion time corresponding to the uniform motion segment. The maximum permissible running speed is obtained according to the motion control law;

[0175] According to the motion time of the standard motion segment and the motion time of the uniform motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is determined.

[0176] In one embodiment, the second sub-segment module is specifically configured to:

[0177] Correspond the standard motion segments divided by standard displacement to any displacement;

[0178] According to the motion time of each standard motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is calculated using a mapping relationship function.

[0179] Specifically, in one embodiment, the mapping relationship function is:

[0180]

[0181] Among them, T L-i is the motion time of each motion segment, f is the mapping function, L is any motion segment, L0 is the standard motion segment, t 0-i is the motion time of the standard motion segment, i=1,2...n, λ is the scaling factor, λ=1,2...n.

[0182] In one embodiment, the determination of the scaling factor includes:

[0183] Calculate the maximum running speed and maximum acceleration in any displacement according to the preset scaling factor;

[0184] The determined scaling factor is a scaling factor that satisfies the maximum operating speed equal to the maximum allowable operating speed and the maximum acceleration equal to the maximum allowable acceleration. The maximum allowable operating speed and the maximum allowable acceleration are obtained according to the motion control law.

[0185] In addition, an embodiment of the present invention further provides an electronic device, including:

[0186] one or more processors; and

[0187] A memory associated with the one or more processors, the memory is used to store program instructions, and when the program instructions are read and executed by the one or more processors, the optical information encoding method disclosed in the above embodiment is executed.

[0188] Among them, Fig.24As shown, the computer device 12 is in the form of a general-purpose computing device. The components of the computer device 12 may include, but are not limited to, one or more processors or processing units 16, a system memory 28, and a bus 18 connecting different system components (including the system memory 28 and the processing unit 16). The bus 18 represents one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, a graphics acceleration port, a processor or a local bus using any of a variety of bus structures. For example, these architectures include, but are not limited to, an Industry Standard Architecture (ISA) bus, a Micro Channel Architecture (MAC) bus, an Enhanced ISA bus, a Video Electronics Standards Association (VESA) local bus, and a Peripheral Component Interconnect (PCI) bus.

[0189] The computer device 12 typically includes a variety of computer system readable media. These media can be any available media that can be accessed by the computer device 12, including volatile and non-volatile media, removable and non-removable media.

[0190] The system memory 28 may include computer system readable media in the form of volatile memory, such as random access memory (RAM) 30 and / or cache memory 32. The computer device 12 may further include other removable / non-removable, volatile / non-volatile computer system storage media. By way of example only, the storage system 34 may be used to read and write non-removable, non-volatile magnetic media (not shown in the figure, usually referred to as a "hard drive"). Although not shown in the figure, a disk drive for reading and writing to a removable non-volatile disk (such as a "floppy disk"), and an optical disk drive for reading and writing to a removable non-volatile optical disk (such as a CD-ROM, DVD-ROM or other optical media) may be provided. In these cases, each drive may be connected to the bus 18 via one or more data media interfaces. The memory 28 may include at least one program product having a set (e.g., at least one) of program modules that are configured to perform the functions of various embodiments of the present invention.

[0191] A program / utility 40 having a set (at least one) of program modules 42 may be stored, for example, in the memory 28, such program modules 42 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment. The program modules 42 generally perform the functions and / or methods of the embodiments described herein.

[0192] The computer device 12 may also communicate with one or more external devices 14 (e.g., keyboard, pointing device, display 24, etc.), may also communicate with one or more devices that enable a user to interact with the computer device 12, and / or communicate with any device that enables the computer device 12 to communicate with one or more other computing devices (e.g., network card, modem, etc.). Such communication may be performed through an input / output (I / O) interface 22. In addition, the computer device 12 in this embodiment, the display 24 does not exist as an independent individual, but is embedded in the mirror surface, and when the display surface of the display 24 is not displayed, the display surface of the display 24 and the mirror surface are visually integrated. In addition, the computer device 12 may also communicate with one or more networks (e.g., local area network (LAN), wide area network (WAN) and / or public network, such as the Internet) through a network adapter 20. As shown in the figure, the network adapter 20 communicates with other modules of the computer device 12 through a bus 18. It should be understood that although not shown in the figure, other hardware and / or software modules can be used in conjunction with the computer device 12, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems.

[0193] The processing unit 16 executes various functional applications and data processing by running programs stored in the system memory 28 .

[0194] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can refer to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the system or system embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can refer to the partial description of the method embodiment. The system and system embodiments described above are merely schematic, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without creative work.

[0195] The technical solution provided by the present application is described in detail above. The principle and implementation method of the present application are described in detail using specific examples. 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 those skilled in the art, 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 limiting the present application.

[0196] All the above optional technical solutions can be arbitrarily combined to form optional embodiments of the present invention, which will not be described in detail here.

[0197] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A motion control method for a load platform, characterized in that: include: Acquire target motion information of the load platform, wherein the target motion information includes: target travel and motion control law; Determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into a plurality of standard motion segments according to time, wherein the standard motion segments at least include: an acceleration process segment and a deceleration process segment; Randomly select any displacement in the target stroke and compare it with the standard displacement, and segment the random displacement according to the comparison result and based on the segmentation result of the standard displacement.

2. The method according to claim 1, characterized in that The step of determining the motion process of the standard displacement according to the motion control law and dividing the motion process of the standard displacement into a plurality of standard motion segments according to time includes: Determine the motion process corresponding to the standard displacement according to the motion control law, wherein the motion process of the standard displacement includes: any one or more of the relationship between displacement and time, the relationship between speed and time, and the relationship between acceleration and time; Determine the segment time parameters of the motion process for the standard displacement.

3. The method according to claim 1, characterized in that The selecting any displacement in the target stroke and comparing it with the standard displacement, and segmenting the arbitrary displacement according to the comparison result and based on the segmentation result of the standard displacement, comprises: If the arbitrary displacement is greater than and equal to the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle; If the arbitrary displacement is smaller than the standard displacement, the segmentation result of the arbitrary displacement based on the standard displacement is segmented according to a scaling principle.

4. The method according to claim 3, characterized in that If the arbitrary displacement is greater than and equal to the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the minimum time principle includes: Corresponding the standard motion segments divided by the standard displacement to the arbitrary displacement; Inserting a uniform motion segment running at a maximum allowable running speed into the arbitrary displacement, and calculating the motion time corresponding to the uniform motion segment, wherein the maximum allowable running speed is obtained according to the motion control law; The movement time of each movement segment in the arbitrary displacement is determined according to the movement time of the standard movement segment in the arbitrary displacement and the movement time of the uniform movement segment.

5. The method according to claim 3, characterized in that If the arbitrary displacement is smaller than the standard displacement, segmenting the segmentation result of the arbitrary displacement based on the standard displacement according to the scaling principle, including: Corresponding the standard motion segments divided by the standard displacement to the arbitrary displacement; According to the motion time of each standard motion segment in the arbitrary displacement, the motion time of each motion segment in the arbitrary displacement is calculated using a mapping relationship function.

6. The method according to claim 5, characterized in that The mapping relationship function is: Among them, T L-i is the motion time of each motion segment, f is the mapping relationship function, L is the arbitrary motion segment, L0 is the standard motion segment, t 0-i is the motion time of the standard motion segment, i=1,2...n, λ is the proportional scaling factor, λ=1,2...n.

7. The method according to claim 6, characterized in that The determination of the scaling factor includes: Calculating the maximum running speed and the maximum acceleration in the arbitrary displacement according to the preset scaling factor; The determined scaling factor is the scaling factor that satisfies the maximum operating speed equal to the maximum allowable operating speed and the maximum acceleration equal to the maximum allowable acceleration, and the maximum allowable operating speed and the maximum allowable acceleration are obtained according to the motion control law.

8. A motion control device for a load platform, characterized in that: include: An information acquisition module is used to acquire target motion information of the load platform, wherein the target motion information includes: target travel and motion control law; A standard displacement segmentation module is used to determine the motion process corresponding to the standard displacement according to the motion control law, and divide the motion process corresponding to the standard displacement into a plurality of standard motion segments according to time, wherein the standard motion segments at least include: an acceleration process segment and a deceleration process segment; The arbitrary displacement segmentation module is used to compare any displacement in the target stroke with the standard displacement, and segment the arbitrary displacement according to the comparison result and based on the segmentation result of the standard displacement.

9. An electronic device, characterized in that: include: one or more processors; as well as A memory associated with the one or more processors, the memory being used to store program instructions, wherein the program instructions, when read and executed by the one or more processors, execute the method according to any one of claims 1 to 7.

10. A computer readable medium having a computer program stored thereon, wherein: When the program is executed by a processor, the method according to any one of claims 1 to 7 is implemented.

Citation Information

Patent Citations

  • Method for generating motion profile by using s-curve, and computing device

    CN110023856A

  • On-line acceleration and deceleration control method and system for pointing mechanism and medium

    CN110543193A

  • Mechanical arm and trajectory planning method and device thereof

    CN113119111A

  • Online speed adjustment method, device and unit, robot and storage medium

    CN113524181A

  • Efficient speed planning method based on jerk

    CN115437252A