Adaptive dynamic motion control methods, devices, equipment and storage media

By adaptively adjusting the interpolation parameters, the problem of non-smooth control of motors and other controlled objects is solved, improving the smoothness and accuracy of the control system and enhancing its adaptability and anti-interference ability.

CN123113370APending Publication Date: 2026-11-17WUHAN JUXIN MICROELECTRONICS CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611448322.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-09-17
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Existing control methods for motors and other controlled objects suffer from low adaptability to operating conditions, resulting in insufficiently smooth control.

Method used

By acquiring the state information of the target controlled object, determining the interpolation point sequence, and updating the interpolation point sequence adaptively based on the preset interpolation parameter update period and state information, the interpolation parameters are dynamically adjusted to achieve adaptive adjustment of interpolation, thereby improving the smoothness and accuracy of the control system.

Benefits of technology

It effectively reduces the control lag and trajectory deviation caused by static interpolation parameters, and enhances the adaptive capability, anti-interference capability and overall operational stability of the control system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123113370A_ABST
    Figure CN123113370A_ABST
Patent Text Reader

Abstract

This application relates to an adaptive dynamic motion control method, apparatus, device, and storage medium. The method includes: acquiring the state information of a target controlled object in the current control cycle, the state information including the target state and initial state of the target controlled object; determining an interpolation point sequence based on a preset interpolation generation cycle; adaptively updating the interpolation parameters of each interpolation point in the interpolation point sequence based on a preset interpolation parameter update cycle and the state information, obtaining the interpolation parameters corresponding to each interpolation point in the interpolation point sequence; performing interpolation based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and controlling the target controlled object to perform an action to transition from the initial state to the target state based on the interpolated result. This method can automatically adapt to different operating conditions to achieve smooth control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of motion control technology, and in particular to an adaptive dynamic motion control method, device, equipment, and storage medium. Background Technology

[0002] With the continuous development of the field of automatic control technology, precision control of motors and other controlled objects has been widely used. Among them, closed-loop control has become the mainstream technology of precision motion control. This architecture relies on the coordinated work of target input, controller and actuator to achieve precise regulation.

[0003] In related technologies, the target signal is usually updated based on the control cycle and directly sent to the controller. Within the control cycle, the target signal is mainly processed by three methods: direct input of the target signal, fixed parameter smoothing, and fixed multiplier interpolation. Precise control is then performed based on the processed target signal. However, the existing processing methods have low adaptability to operating conditions, resulting in insufficient smoothness of control. Summary of the Invention

[0004] Therefore, it is necessary to provide an adaptive dynamic motion control method, device, equipment, and storage medium that can automatically adapt to different working conditions and achieve smooth control, in order to address the above-mentioned technical problems.

[0005] In a first aspect, this application provides an adaptive dynamic motion control method, comprising:

[0006] Obtain the status information of the target controlled object in the current control cycle; the status information includes the target state and initial state of the target controlled object.

[0007] Based on a preset interpolation generation period, determine the interpolation point sequence;

[0008] Based on the preset interpolation parameter update period and the state information, the interpolation parameters of each interpolation point in the interpolation point sequence are adaptively updated to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence.

[0009] Interpolation is performed based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and the target control object is controlled to perform actions to transition from the initial state to the target state based on the interpolation result.

[0010] Secondly, this application also provides an adaptive dynamic motion control device, comprising:

[0011] The acquisition module is used to acquire the status information of the target controlled object in the current control cycle; the status information includes the target status and initial status of the target controlled object;

[0012] The interpolation point confirmation module is used to determine the interpolation point sequence based on a preset interpolation generation period.

[0013] The parameter confirmation module is used to adaptively update the interpolation parameters of each interpolation point in the interpolation point sequence based on the preset interpolation parameter update period and the status information, so as to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence.

[0014] The output module is used to perform interpolation based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and to control the target control object to perform actions to transition from the initial state to the target state based on the interpolated result.

[0015] Thirdly, this application also provides a computer device, including a memory and a processor, wherein the memory stores a computer program, and the processor executes the computer program to implement the steps of the above-described method.

[0016] Fourthly, this application also provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of the above-described method.

[0017] Fifthly, this application also provides a computer program product, including a computer program that, when executed by a processor, implements the steps of the above-described method.

[0018] The aforementioned adaptive dynamic motion control method, device, equipment, and storage medium, during the control of the target controlled object in the current control cycle, first determines the interpolation point sequence for determining multiple interpolation states by combining a preset interpolation generation cycle. Then, based on the preset interpolation parameter update cycle and state information, the interpolation parameters of each interpolation point in the interpolation point sequence are adaptively updated to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence. The updated interpolation parameters are then used to solve the interpolation planning value. Finally, based on the interpolation planning values ​​corresponding to multiple interpolation points, the target controlled object is controlled to perform an action to transition from the initial state to the target state. In the above process, the interpolation parameters can be dynamically adjusted according to the interpolation state within a control cycle, thereby achieving adaptive adjustment of the interpolation. This effectively weakens the control lag and trajectory deviation problems caused by static interpolation parameters, improves the smoothness of the state transition process and control accuracy, and enhances the adaptive capability, anti-interference capability, and overall operational stability of the control system. Attached Figure Description

[0019] To more clearly illustrate the technical solutions in the embodiments of this application or related technologies, the drawings used in the description of the embodiments of this application or related technologies will be briefly introduced below. Obviously, the drawings described below are only some embodiments of this application. For those skilled in the art, other related drawings can be obtained based on these drawings without creative effort.

[0020] Figure 1 This is a flowchart illustrating an adaptive dynamic motion control method in one embodiment;

[0021] Figure 2 This is a schematic diagram of the interpolation parameter update determination process in one embodiment;

[0022] Figure 3 This is a schematic diagram of the control timing involved in one embodiment;

[0023] Figure 4 This is a structural block diagram of an adaptive dynamic motion control device in one embodiment;

[0024] Figure 5 This is an internal structural diagram of a computer device in one embodiment. Detailed Implementation

[0025] To make the objectives, technical solutions, and advantages of this application clearer, the following detailed description is provided in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative and not intended to limit the scope of this application.

[0026] It should be noted that the terms "first," "second," etc., used in this application can be used to describe various elements, but these elements are not limited by these terms. These terms are only used to distinguish the first element from the second element. The terms "comprising" and "having," and any variations thereof, used in this application, are intended to cover non-exclusive inclusion. The term "multiple" used in this application refers to two or more. The term "and / or" used in this application refers to one of the embodiments, or any combination of multiple embodiments.

[0027] In one exemplary embodiment, such as Figure 1 As shown, an adaptive dynamic motion control method is provided. Taking the application of this method to a controller as an example, the method includes the following steps 201 to 206. Wherein:

[0028] Step 201: Obtain the status information of the target controlled object in the current control cycle; the status information includes the target status and initial status of the target controlled object.

[0029] The target control object refers to the controlled equipment used to perform the corresponding action, such as a motor or electric motor.

[0030] The control cycle refers to the fixed running time of a controller used to control the target object during one data acquisition, calculation, and instruction output. It is the basic time unit for the controller to work in cycles.

[0031] The status information of the target controlled object in the current control cycle is used to describe the operating condition of the target controlled object in the current control cycle. It can include the actual operating condition fed back by the target controlled object, or the target operating condition that the target controlled object plans to achieve in the current cycle.

[0032] The target state of the current control cycle refers to the preset control target value of the current control cycle, which is the ideal operating parameter that the controlled object needs to achieve in the current control cycle. For example, the target state can be the target speed or target position that the motor needs to achieve in the current control cycle.

[0033] The initial state of the current control cycle refers to the starting state of the target controlled object in the current control cycle; it can be the actual feedback value of the target controlled object at the current moment, or the target state value of the previous control cycle.

[0034] For example, the status information of the current control cycle may include the original target value of the current control cycle, the current feedback value, and the newly generated target value of the previous control cycle.

[0035] Step 202: Determine the interpolation point sequence based on the preset interpolation generation period.

[0036] The interpolation point sequence includes multiple interpolation points; the value corresponding to each interpolation point corresponds to an interpolation state. It can be understood that the interpolation point sequence at this time only describes the number of interpolation points and does not include the interpolation result corresponding to each interpolation point.

[0037] The preset interpolation generation period is used to describe the number of interpolation points that need to be generated for a target state.

[0038] In some embodiments, the target state of the current control cycle can be a sequence of states consisting of multiple states; for example, the target state can be reaching the first speed after one second, which contains only one state, or reaching the reference speed after 0.5 seconds and reaching the first speed after 1 second, which contains two states.

[0039] It should be noted that when the target state is a state sequence consisting of multiple states, each state in the state sequence is regarded as the target state. For each target state, a corresponding number of interpolation points need to be generated according to the preset interpolation generation period.

[0040] For example, within the current control cycle, the original length of the target state is That is, For each target state, if the interpolation generation period is preset... Thus, each target state will generate m points, and the length of the newly generated interpolation point sequence is... .

[0041] Interpolation state refers to the transitional working condition of the target controlled object at each interpolation point during the transition from the initial state to the target state.

[0042] In some embodiments, the time corresponding to each interpolation point in the interpolation point sequence can be determined based on the time corresponding to the control cycle and the preset interpolation generation cycle.

[0043] Step 203: Based on the preset interpolation parameter update period and status information, adaptively update the interpolation parameters of each interpolation point in the interpolation point sequence to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence.

[0044] In some embodiments, for each interpolation point in the interpolation point sequence, the interpolation parameters of the interpolation points can be adaptively updated based on the interpolation order of the interpolation points, the preset interpolation parameter update period, and the state information, so as to obtain the interpolation parameters corresponding to the interpolation points.

[0045] The preset interpolation parameter update period is the interval between interpolation parameter updates based on the interpolation point number. That is, the interpolation parameter is updated once every fixed number of interpolation points. The frequency of adaptive updates can be controlled by the preset interpolation parameter update period to avoid frequent parameter oscillations.

[0046] Interpolation order refers to the sequence number of each interpolation point in the interpolation point sequence according to the order of time, such as the 1st interpolation point, the 2nd interpolation point, ... the mth interpolation point; obviously, each interpolation point is interpolated in chronological order.

[0047] In some embodiments, the state information may further include the feedback state of the target controlled object during operation. For the i-th interpolation point in the interpolation point sequence, if the interpolation order of the i-th interpolation point satisfies the preset interpolation parameter update period, the interpolation error state of the i-th interpolation point is determined based on the interpolation planning value and / or state information of the (i-1)-th interpolation point. The interpolation parameters of the interpolation point are adaptively updated based on the interpolation error state of the i-th interpolation point to obtain the interpolation parameters of the i-th interpolation point. The interpolation parameters are used to control the rate of change of the interpolation planning value.

[0048] Where i is a positive integer greater than 1, the interpolation planning value of the first interpolation point is determined by interpolation based on preset interpolation parameters; the interpolation planning value of the interpolation point is used to describe the interpolation state corresponding to the interpolation point; the interpolation error state is used to describe the degree of deviation between the state of the target control object after interpolation and the ideal target state.

[0049] The interpolation parameter is used to control the rate of change of the interpolated planned value during the interpolation process; for example, taking exponential interpolation as an example, its interpolation calculation formula is: ,in, For the interpolation planning value of the i-th interpolation point, The interpolation planning value for the (i+1)th interpolation point. For the target state, These are the interpolation parameters. By changing the interpolation parameters, the rate of change between the interpolated planned values ​​of adjacent interpolation points can be altered.

[0050] It is understandable that for other interpolation methods, the interpolation parameters may have different forms of expression, but as long as the parameter can be used to control the rate of change of the interpolated planning value, the parameter can be regarded as an interpolation parameter.

[0051] In some embodiments, the interpolation order satisfies the preset interpolation parameter update period, which may mean that the size relationship between the interpolation order and the preset interpolation parameter update period satisfies the preset rules. For example, the interpolation order is an integer multiple of the preset interpolation parameter update period, or the difference between the interpolation order and the preset interpolation parameter update period is an integer multiple of the preset threshold.

[0052] In some embodiments, the interpolation error state is used to describe the degree of deviation between the state of the target controlled object after interpolation and the ideal target state; for example, the interpolation error state may refer to the deviation between the interpolation planning value at the (i-1)th interpolation point and the initial state, target state, or feedback state in the state information.

[0053] For example, the interpolation error state can be the difference between the interpolation planning value of the (i-1)th interpolation point and the initial state in the state information, used to describe how far the (i-1)th interpolation point has traveled compared to the initial state; or it can be the difference between the interpolation planning value of the (i-1)th interpolation point and the target state in the state information, used to describe how far the (i-1)th interpolation point still needs to travel compared to the target state.

[0054] In other embodiments, interpolation is performed in real time. That is, after determining the interpolation planning value for each interpolation point, the target control object is controlled to perform the corresponding action according to the interpolation planning value. On this basis, the feedback value of the target control object for the (i-1)th interpolation point can also be obtained, and the interpolation error state is determined according to the interpolation planning value of the (i-1)th interpolation point and the feedback value of the (i-1)th interpolation point.

[0055] In some embodiments, the error state can be calculated directly based on the update magnitude of the target state contained in the state information, i.e., the error state e(t) = r(k) - r(k-1); where r(k) is the target state of the current control cycle and r(k-1) is the target state of the previous control cycle.

[0056] In some embodiments, the error state can be determined by controlling the target controlled object to perform actions according to the interpolation planning value of the previous interpolation point, and then based on the actual feedback value of the target controlled object at this moment and the interpolation planning value of the previous interpolation point. ;in, The interpolation planning value of the previous interpolation point, This is the actual feedback value after interpolation.

[0057] In some embodiments, the error state can also be generated directly based on the target state and the actual feedback value of the target controlled object at that moment. Where r(k) is the target state of the current control cycle, This is the actual feedback value of the target controlled object at this moment, obtained by the target controlled object after performing motion based on the interpolation planning value of the previous interpolation point.

[0058] In some embodiments, an error state can also be generated based on the interpolation planning value of the previous interpolation point and the target state in the state information. Where r(k) is the target state of the current control cycle, This is the interpolation planning value of the previous interpolation point.

[0059] In some embodiments, an interpolation parameter update model is preset, which describes the mapping relationship between the interpolation error state and the interpolation parameters. Based on this, the interpolation error state of the i-th interpolation point is substituted into the interpolation parameter update model to obtain the interpolation parameters of the i-th interpolation point. Then, the interpolation parameters corresponding to the interpolation planning value of the (i-1)-th interpolation point are replaced with the interpolation parameters of the i-th interpolation point, and the interpolation planning value of the i-th interpolation point is determined using the new interpolation parameters.

[0060] In other embodiments, the target controlled object has different interpolation methods in different scenarios. Taking the controlled object as a motor as an example, in high-speed start-stop and rapid point-to-point movement scenarios, exponential interpolation is usually used to achieve fast response and reduce control lag; in smooth speed regulation and start-stop shock suppression scenarios, S-shaped function interpolation is usually used to reduce acceleration and deceleration shock and improve running stability. Therefore, interpolation parameter update models corresponding to different interpolation methods can be preset, so that the target interpolation parameter update model can be determined from multiple interpolation parameter update models according to the interpolation method adopted by the target controlled object for interpolation parameter update.

[0061] In other embodiments, interpolation parameter update models corresponding to various motion control targets of the target controlled object can be directly established. This allows the target interpolation parameter update model to be determined from multiple interpolation parameter update models based on the motion control target of the target controlled object. The motion control target can be rapid start-stop, smooth control, precise positioning, anti-disturbance operation, low-speed stability, high-load speed change, etc.

[0062] Step 204: Perform interpolation based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and control the target control object to perform an action based on the interpolation result to transition from the initial state to the target state.

[0063] In some embodiments, before calculating the interpolation planning value, it is also necessary to obtain the interpolation method information used by the target controlled object, determine the interpolation operation formula to be used based on the interpolation method information, and then substitute the interpolation parameters of the i-th interpolation point, the interpolation planning value of the (i-1)-th interpolation point, and the target state value into the interpolation operation formula corresponding to the current interpolation method to obtain the interpolation planning value corresponding to the i-th interpolation point. This planning value represents the interpolation state that the target controlled object should currently achieve.

[0064] In some embodiments, after obtaining the interpolation planning values ​​corresponding to each of the multiple interpolation points, multiple smooth control signals can be generated using the interpolation planning values ​​corresponding to each of the multiple interpolation points, thereby using the generated multiple smooth control signals to control the target controlled object to perform actions to transition from the initial state to the target state.

[0065] In other embodiments, after generating the interpolation planning value corresponding to each interpolation point, the target controlled object can be controlled to perform actions using the interpolation planning value corresponding to that interpolation point. In this way, it is not necessary to pre-calculate all interpolation planning values ​​and then issue instructions uniformly. Online real-time interpolation and closed-loop feedback correction can be realized, which can promptly compensate for deviations caused by external disturbances and mechanical lag, making the state transition trajectory more in line with expectations, while shortening the overall control delay.

[0066] In the aforementioned adaptive dynamic motion control method, during the control of the target controlled object in the current control cycle, the interpolation point sequence for determining multiple interpolation states is first determined by combining a preset interpolation generation cycle. At the interpolation nodes that satisfy the parameter update cycle, the interpolation error state is calculated based on the previous interpolation planning value and state information. The interpolation parameters are then updated adaptively and iteratively using the error state. The interpolation planning value is then solved based on the updated interpolation parameters. Finally, the target controlled object is controlled to perform actions to transition from the initial state to the target state according to the interpolation planning values ​​corresponding to each of the multiple interpolation points. In the above process, the interpolation parameters can be dynamically adjusted according to the interpolation state within a control cycle, thereby achieving adaptive adjustment of the interpolation. This effectively weakens the control lag and trajectory deviation problems caused by static interpolation parameters, improves the smoothness of the state transition process and control accuracy, and enhances the adaptive capability, anti-interference capability and overall operational stability of the control system.

[0067] In one exemplary embodiment, the adaptive dynamic motion control method further includes:

[0068] For the i-th interpolation point, if the interpolation order at the i-th interpolation point does not meet the preset interpolation parameter update period, the interpolation parameter corresponding to the interpolation planning value of the (i-1)-th interpolation point is determined as the interpolation parameter of the i-th interpolation point.

[0069] For example, the preset interpolation parameter update period is n (n is a positive integer). If the interpolation order of the i-th interpolation point is an integer multiple of the preset interpolation parameter update period n, then its interpolation order is considered to satisfy the preset interpolation parameter update period; otherwise, its interpolation order is considered not to satisfy the preset interpolation parameter update period. Thus, for the 1st interpolation point to the (n-1)th interpolation point, interpolation is performed using the preset interpolation parameters. For the n-th interpolation point, the first interpolation parameter update is required, and for the 2n-th interpolation point, the second interpolation parameter update is required, and so on.

[0070] In the above embodiments, the preset interpolation generation period and the preset interpolation parameter update period are decoupled. Within one control cycle, the interpolation parameters can be adjusted in real time according to the actual state of the target controlled object, so that the rate of change of the motion trajectory can be dynamically adapted to the working conditions, taking into account both motion continuity and control accuracy.

[0071] In one exemplary embodiment, such as Figure 2 As shown, Figure 2 A flowchart illustrating the interpolation parameter update judgment is shown, wherein the preset interpolation generation period is not less than the preset interpolation parameter update period; the adaptive dynamic motion control method further includes steps 301 to 302, wherein:

[0072] Step 301: If the interpolation order of the i-th interpolation point is an integer multiple of the preset interpolation parameter update period, determine that the interpolation order of the i-th interpolation point satisfies the preset interpolation parameter update period.

[0073] Understandably, if the preset interpolation generation period is not less than the preset interpolation parameter update period, it can be ensured that at least one interpolation point in a control period has an interpolation order that is an integer multiple of the preset interpolation parameter update period, thereby achieving at least one interpolation parameter update.

[0074] Step 302: If the interpolation order at the i-th interpolation point is not an integer multiple of the preset interpolation parameter update period, determine that the interpolation order at the i-th interpolation point does not satisfy the preset interpolation parameter update period.

[0075] It is understandable that the smaller the preset interpolation parameter update period, the higher the update frequency of the interpolation parameters, and the more timely the response to changes in the state of the controlled object; the larger the preset interpolation parameter update period, the lower the update frequency of the interpolation parameters, which can effectively reduce the overall computational load.

[0076] In the above embodiments, by ensuring that the preset interpolation generation period is not less than the preset interpolation parameter update period, and by determining the relationship between the interpolation order and the preset interpolation parameter update period, the stable operation of the dynamic update mechanism of the interpolation parameters is guaranteed. Furthermore, by flexibly adjusting the preset interpolation parameter update period, a balance can be achieved between controlling the response speed, deviation correction capability, and algorithm computational overhead.

[0077] In some embodiments, interpolation is performed based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and the target controlled object is controlled to perform an action to transition from an initial state to a target state based on the interpolated result, including:

[0078] Based on the control type of the target controlled object, a target interpolation method suitable for the target controlled object is determined from multiple interpolation methods. Among these multiple interpolation methods, at least two of exponential interpolation, growth curve function interpolation, and filter interpolation are selected. For each interpolation point in the interpolation point sequence, the interpolation point is interpolated according to the target interpolation method based on the interpolation parameters of the interpolation point to obtain the interpolation planning value of the interpolation point. Based on the interpolation planning values ​​corresponding to multiple interpolation points, the target controlled object is controlled to perform actions to transition from the initial state to the target state.

[0079] Based on the control type of the target control object, a target interpolation method that is compatible with the target control object is determined from multiple interpolation methods.

[0080] Among them, the control type of the target control object is used to describe the action response characteristics and operation control requirements of the target control object, such as fast response type, smooth control type, precise positioning type, etc.

[0081] In some embodiments, the control type of the target controlled object can be manually set by the controller.

[0082] In some embodiments, a mapping relationship between different interpolation methods and control types is pre-set, so that the corresponding target interpolation method can be quickly matched according to the control type to which the target control object belongs.

[0083] Among them, the various interpolation methods include at least two of the following: exponential interpolation, growth curve function interpolation, and filter interpolation.

[0084] It is understandable that different interpolation methods have different calculation methods.

[0085] For example, exponential interpolation can be either first-order exponential interpolation or multi-level cascaded exponential interpolation. The interpolation formula for first-order exponential interpolation is as follows:

[0086] .

[0087] in That is, the interpolation parameters, which are adaptively updated through the steps of the aforementioned embodiments. Let k be the target state that the target controlled object will reach during the control period. For the interpolation planning value of the i-th interpolation point, This is the interpolation planning value for the (i+1)th interpolation point.

[0088] For growth curve function interpolation, also known as S-curve function interpolation, the interpolation formula is as follows:

[0089] .

[0090] in, k is the interpolation parameter, which is adaptively updated through the steps in the aforementioned embodiments. e is a constant, and m is the preset interpolation generation period, which is also the total number of interpolation steps. Let k be the initial state of the target controlled object during control period k. Let k be the target state that the target controlled object will reach during the control period. Let be the interpolation planning value for the i-th interpolation point.

[0091] For filter interpolation, it can be low-pass filter interpolation or high-order cascaded low-pass filter interpolation. Low-pass filter interpolation first involves repeatedly sampling each state in the state information m times based on a preset interpolation generation period to obtain a stepped sequence. Then, a first-order low-pass filter is used to smooth the stepped sequence. The first-order low-pass filter can be represented as... ,in, The transfer function of a first-order low-pass filter. The cutoff angular frequency, which is also the interpolation parameter of this application, is adaptively updated through the steps of the aforementioned embodiments. For the Laplace operator.

[0092] For high-order sequential low-pass filter interpolation, similar to low-pass filter interpolation, each state in the state information is sampled m times based on a preset interpolation generation period to obtain a stair-shaped sequence. Unlike low-pass filter interpolation, the stair-shaped sequence is smoothly transitioned using multiple first-order low-pass filters. These multiple first-order low-pass filters can be represented as: Where q is the number of first-order filters, The transfer function of a first-order low-pass filter. The cutoff angular frequency, which is also the interpolation parameter of this application, is adaptively updated through the steps of the aforementioned embodiments. For the Laplace operator.

[0093] In the above embodiments, based on the control type of the target controlled object, a suitable target interpolation method is dynamically selected from various interpolation methods such as exponential interpolation, growth curve function interpolation, and filter interpolation. The interpolation planning value is generated by combining the interpolation parameters of the i-th interpolation point, thereby achieving accurate matching between the interpolation method and the control scenario.

[0094] In some embodiments, the target interpolation method includes a multi-layered cascaded interpolation method; based on the interpolation parameters of the interpolation point, interpolation is performed on the interpolation point according to the target interpolation method to obtain the interpolation planning value of the interpolation point, including:

[0095] Based on the interpolation parameters of the interpolation point, p-level cascaded exponential interpolation is performed on the interpolation point to obtain the interpolation planning value of the interpolation point.

[0096] In the p-level cascaded interpolation for the interpolation point, the interpolation result of the j-th interpolation is used as the input of the (j+1)-th interpolation, and the result of the p-th interpolation is used as the interpolation planning value of the interpolation point. The interpolation parameter of the j-th interpolation is determined based on the level of the j-th interpolation and the preset interpolation parameter update period, where j is a positive integer less than p and p is a positive integer greater than 1.

[0097] For example, the number of levels in a multi-level cascaded exponential interpolation method is p, and the calculation formula for the multi-level cascaded exponential interpolation method is as follows:

[0098] ;

[0099] ;

[0100] ;

[0101] ...

[0102] .

[0103] in, That is, the interpolation parameters at the (i+1)th interpolation point are adaptively updated through the steps of the aforementioned embodiments. The interpolation parameters represent the q-th cascaded layer. Let k be the target state that the target controlled object will reach during the control period. For the interpolation planning value of the i-th interpolation point, The result of performing the q-th level exponential interpolation for the i-th interpolation point; This represents the result of performing p-level exponential interpolation on the i-th interpolation point, which is also the interpolation planning value of the (i+1)-th interpolation point.

[0104] In some embodiments, for subsequent interpolation parameters in the multi-level cascaded exponential interpolation at the (i+1)th interpolation point, such as , until It can be based on and The preset proportional coefficient is determined, for example, by presetting the proportional relationship between interpolation parameters of different levels, so that based on the determination of the interpolation parameters of the first level, the interpolation parameters of each level can be determined according to the preset proportional relationship; or the number of levels can be regarded as the interpolation order, and the value of each interpolation parameter can be determined according to the method of the aforementioned embodiment.

[0105] In the above embodiments, the step-by-step calculation is performed by multi-level cascaded exponential interpolation, which can further weaken the abrupt change problem of single-level interpolation and avoid system oscillation caused by jumps.

[0106] In some embodiments, the interpolation parameters of the interpolation point are adaptively updated based on the interpolation error state of the i-th interpolation point to obtain the interpolation parameters of the i-th interpolation point, including:

[0107] Based on the control type of the target control object, the target parameter update function that is compatible with the target control object is determined from multiple parameter update functions.

[0108] Among them, the control type of the target control object is used to describe the action response characteristics and operation control requirements of the target control object, such as fast response type, smooth control type, precise positioning type, etc.

[0109] In some embodiments, the control type of the target controlled object can be manually set by the controller.

[0110] In some embodiments, a mapping relationship between different parameter update functions and control types is pre-set, so that the corresponding target parameter update function can be quickly matched according to the control type to which the target control object belongs.

[0111] Based on the target parameter update function and the interpolation error state at the i-th interpolation point, the interpolation parameters are adaptively updated to obtain the interpolation parameters at the i-th interpolation point.

[0112] Among them, the multiple parameter update functions include at least two of the following: linear proportional function, inverse proportional function, piecewise function, and growth curve function.

[0113] For example, a linear proportional function can be ,in, These are interpolation parameters. This represents the interpolation error state. It is a constant. and These are the minimum and maximum values ​​of the interpolation parameters, respectively. This is the clipping function.

[0114] The inverse proportional function can be ,in, These are interpolation parameters. This indicates an interpolation error state. , , It is a constant. and These are the minimum and maximum values ​​of the interpolation parameters, respectively. This is the clipping function.

[0115] The growth curve function, also known as the sigmoid function, can be... ,in, These are interpolation parameters. This represents the interpolation error state. It is a constant. The maximum value of the interpolation parameter. It is a natural exponential function.

[0116] A piecewise function can be expressed as:

[0117] .

[0118] in, These are interpolation parameters. This represents the interpolation error state. and These are the preset segmentation points.

[0119] In the above embodiments, based on the control type of the target controlled object, a suitable target parameter update function is dynamically selected from various interpolation parameter functions such as linear proportional function, inverse proportional function, piecewise function, and growth curve function. The interpolation parameter is updated in combination with the interpolation error state of the i-th interpolation point, thereby achieving the adaptation of the interpolation parameter update to the control scenario.

[0120] In some embodiments, based on the interpolation planning values ​​corresponding to multiple interpolation points, the target controlled object is controlled to perform actions to transition from an initial state to a target state, including:

[0121] Based on the interpolation planning values ​​corresponding to multiple interpolation points, a target signal sequence is determined; the target signal sequence contains multiple control signals, and one control signal is used to control the target control object to perform an action to achieve the interpolation state corresponding to an interpolation point.

[0122] Specifically, for each interpolation point, the corresponding interpolation planning value is determined, and then the control signal is organized according to the time sequence to obtain the target signal sequence.

[0123] Based on the target signal sequence, control the target object to perform actions to transition from the initial state to the target state.

[0124] In some embodiments, the target controlled object may be controlled to perform actions sequentially according to the control signals in the target signal sequence to transition from the initial state to the target state.

[0125] In other embodiments, after generating the interpolation planning value corresponding to each interpolation point, a control signal can be generated using the interpolation planning value corresponding to that interpolation point, and then the target controlled object can be controlled to perform actions using the control signal. In this way, it is not necessary to pre-calculate all the interpolation planning values ​​and then issue instructions uniformly, which can realize online real-time interpolation and closed-loop feedback correction.

[0126] In this embodiment, the target control object is controlled to perform actions to transition from the initial state to the target state by using a target signal sequence, thus achieving smooth control of the target control object.

[0127] Please see Figure 3 , Figure 3 The diagram shows a control timing diagram related to an embodiment of this application. The solid line represents the ideal control state, and the dashed line represents the interpolated control state obtained by using the dynamic motion control method of this application. It can be seen that a smooth transition curve is formed at both the rising and falling edges of the step signal, which not only preserves the target amplitude and duration of the ideal control state, but also avoids the hard jump of the step signal.

[0128] It should be understood that although the steps in the flowcharts of the above embodiments are shown sequentially according to the arrows, these steps are not necessarily executed in the order indicated by the arrows. Unless explicitly stated herein, there is no strict order restriction on the execution of these steps, and they can be executed in other orders. Moreover, at least some steps in the flowcharts of the above embodiments may include multiple steps or multiple stages. These steps or stages are not necessarily completed at the same time, but can be executed at different times. The execution order of these steps or stages is not necessarily sequential, but can be performed alternately or in turn with other steps or at least some of the steps or stages in other steps. It is understood that the steps in different embodiments can be freely combined as needed, and all non-contradictory solutions formed by such combinations are within the scope of protection of this application.

[0129] Based on the same inventive concept, this application also provides an adaptive dynamic motion control device for implementing the adaptive dynamic motion control method described above. The solution provided by this device is similar to the solution described in the above method; therefore, the specific limitations in one or more embodiments of the adaptive dynamic motion control device provided below can be found in the limitations of the adaptive dynamic motion control method described above, and will not be repeated here.

[0130] In one exemplary embodiment, such as Figure 4 As shown, Figure 4 A schematic diagram of an adaptive dynamic motion control device is provided. The adaptive dynamic motion control device 400 includes:

[0131] The acquisition module 401 is used to acquire the status information of the target controlled object in the current control cycle; the status information includes the target status and initial status of the target controlled object.

[0132] The interpolation point confirmation module 402 is used to determine the interpolation point sequence based on a preset interpolation generation cycle; the interpolation point sequence includes multiple interpolation points; each interpolation point corresponds to an interpolation state.

[0133] The parameter confirmation module 403 is used to adaptively update the interpolation parameters of each interpolation point in the interpolation point sequence based on the preset interpolation parameter update cycle and status information, so as to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence.

[0134] The output module 404 is used to perform interpolation based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and to control the target control object to perform actions to change from the initial state to the target state based on the interpolation result.

[0135] In some embodiments, the parameter confirmation module 403 is used to adaptively update the interpolation parameters of each interpolation point in the interpolation point sequence based on the interpolation order of the interpolation points, the preset interpolation parameter update period, and the status information, so as to obtain the interpolation parameters corresponding to the interpolation points.

[0136] In some embodiments, the state information also includes the feedback state of the target controlled object during operation. The parameter confirmation module 403 is used to determine the interpolation error state of the i-th interpolation point based on the interpolation planning value and / or state information of the (i-1)-th interpolation point in the interpolation point sequence, provided that the interpolation order of the i-th interpolation point satisfies the preset interpolation parameter update period. Here, i is a positive integer greater than 1, the interpolation planning value of the first interpolation point is determined based on the preset interpolation parameters, the interpolation planning value of the interpolation point is used to describe the interpolation state corresponding to the interpolation point, the interpolation parameters of the interpolation point are adaptively updated based on the interpolation error state of the i-th interpolation point to obtain the interpolation parameters of the i-th interpolation point, and the interpolation parameters are used to control the rate of change of the interpolation planning value. For the i-th interpolation point, if the interpolation order of the i-th interpolation point does not satisfy the preset interpolation parameter update period, the interpolation parameter corresponding to the interpolation planning value of the (i-1)-th interpolation point is determined as the interpolation parameter of the i-th interpolation point.

[0137] In some embodiments, the parameter confirmation module 403 is used to determine a target parameter update function that is compatible with the target control object from multiple parameter update functions based on the control type of the target control object; and to perform adaptive parameter update on the interpolation parameters based on the target parameter update function and the interpolation error state of the i-th interpolation point to obtain the interpolation parameters of the i-th interpolation point; wherein the multiple parameter update functions include at least two of linear proportional functions, inverse proportional functions, piecewise functions, and growth curve functions.

[0138] In some embodiments, the preset interpolation generation period is not less than the preset interpolation parameter update period; the parameter confirmation module 403 is used to determine that the interpolation order of the i-th interpolation point satisfies the preset interpolation parameter update period when the interpolation order of the i-th interpolation point is an integer multiple of the preset interpolation parameter update period; and to determine that the interpolation order of the i-th interpolation point does not satisfy the preset interpolation parameter update period when the interpolation order of the i-th interpolation point is not an integer multiple of the preset interpolation parameter update period.

[0139] In some embodiments, the output module 404 is used to determine a target interpolation method that is compatible with the target control object from a variety of interpolation methods based on the control type of the target control object; wherein the variety of interpolation methods includes at least two of exponential interpolation, growth curve function interpolation, and filter interpolation;

[0140] For each interpolation point in the interpolation point sequence, based on the interpolation parameters of the interpolation point, the interpolation point is interpolated according to the target interpolation method to obtain the interpolation planning value of the interpolation point;

[0141] Based on the interpolation planning values ​​corresponding to multiple interpolation points, the control target object performs actions to transform from the initial state to the target state.

[0142] In some embodiments, the target interpolation method includes a multi-layer cascaded interpolation method; the output module 404 is used to perform p-layer cascaded interpolation on the interpolation point based on the interpolation parameters of the interpolation point to obtain the interpolation planning value of the interpolation point; wherein, in the p-layer cascaded interpolation for the interpolation point, the interpolation result of the j-th interpolation is used as the input of the (j+1)-th interpolation, and the result of the p-th interpolation is used as the interpolation planning value of the interpolation point; the interpolation parameters of the j-th interpolation are determined based on the level of the j-th interpolation and the preset interpolation parameter update period, where j is a positive integer less than p and p is a positive integer greater than 1.

[0143] In some embodiments, the output module 404 is used to determine a target signal sequence based on the interpolation planning values ​​corresponding to each of the multiple interpolation points; the target signal sequence includes multiple control signals, with one control signal corresponding to one interpolation point; based on the target signal sequence, the target control object is controlled to perform an action to transition from the initial state to the target state.

[0144] Each module in the aforementioned adaptive dynamic motion control device can be implemented entirely or partially through software, hardware, or a combination thereof. These modules can be embedded in the processor of a computer device in hardware form or independent of it, or stored in the memory of a computer device in software form, so that the processor can call and execute the operations corresponding to each module.

[0145] In one exemplary embodiment, a computer device is provided, which may be a server, and its internal structure diagram may be as follows: Figure 5As shown, this computer device includes a processor, memory, input / output interfaces (I / O), and a communication interface. The processor, memory, and I / O interfaces are connected via a system bus, and the communication interface is also connected to the system bus via the I / O interfaces. The processor provides computational and control capabilities. The memory includes non-volatile storage media and internal memory. The non-volatile storage media stores the operating system, computer programs, and a database. The internal memory provides the environment for the operation of the operating system and computer programs stored in the non-volatile storage media. The database stores data related to motion control. The I / O interfaces are used for exchanging information between the processor and external devices. The communication interface is used for communicating with external terminals via a network connection. When the computer program is executed by the processor, it implements an adaptive dynamic motion control method.

[0146] Those skilled in the art will understand that Figure 5 The structure shown is merely a block diagram of a portion of the structure related to the present application and does not constitute a limitation on the computer device to which the present application is applied. Specific computer devices may include more or fewer components than those shown in the figure, or combine certain components, or have different component arrangements.

[0147] In one exemplary embodiment, a computer device is provided, including a memory and a processor, wherein the memory stores a computer program, and the processor executes the computer program to implement the steps of the method described above.

[0148] In one embodiment, a computer-readable storage medium is provided having a computer program stored thereon, which, when executed by a processor, implements the steps of the above-described method.

[0149] In one embodiment, a computer program product is provided, including a computer program that, when executed by a processor, implements the steps of the method described above.

[0150] It should be noted that the user information (including but not limited to user device information, user personal information, etc.) and data (including but not limited to data used for analysis, data stored, data displayed, etc.) involved in this application are all information and data authorized by the user or fully authorized by all parties, and the collection, use and processing of the relevant data must comply with relevant regulations.

[0151] Those skilled in the art will understand that all or part of the processes in the methods of the above embodiments can be implemented by a computer program instructing related hardware. The computer program can be stored in a non-volatile computer-readable storage medium. When executed, the computer program can include the processes of the embodiments of the above methods. Any references to memory, databases, or other media used in the embodiments provided in this application can include at least one of non-volatile memory and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetic random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. By way of illustration and not limitation, RAM can take many forms, such as Static Random Access Memory (SRAM) or Dynamic Random Access Memory (DRAM). The databases involved in the embodiments provided in this application may include at least one type of relational database and non-relational database. Non-relational databases may include, but are not limited to, blockchain-based distributed databases. The processors involved in the embodiments provided in this application may be general-purpose processors, central processing units, graphics processing units, digital signal processors, programmable logic devices, quantum computing-based data processing logic devices, artificial intelligence (AI) processors, etc., and are not limited to these.

[0152] The technical features of the above embodiments can be combined in any way. For the sake of brevity, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this application.

[0153] The embodiments described above are merely illustrative of several implementation methods of this application, and while the descriptions are specific and detailed, they should not be construed as limiting the scope of this patent application. It should be noted that those skilled in the art can make various modifications and improvements without departing from the concept of this application, and these all fall within the protection scope of this application. Therefore, the protection scope of this application should be determined by the appended claims.

Claims

1. An adaptive dynamic motion control method, characterized in that, The method includes: Obtain the status information of the target controlled object in the current control cycle; the status information includes the target state and initial state of the target controlled object. Based on a preset interpolation generation period, determine the interpolation point sequence; Based on the preset interpolation parameter update period and the state information, the interpolation parameters of each interpolation point in the interpolation point sequence are adaptively updated to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence. Interpolation is performed based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and the target control object is controlled to perform actions to transition from the initial state to the target state based on the interpolation result.

2. The method according to claim 1, characterized in that, The step of adaptively updating the interpolation parameters of each interpolation point in the interpolation point sequence based on the preset interpolation parameter update period and the state information, to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, includes: For each interpolation point in the interpolation point sequence, based on the interpolation order of the interpolation points, the preset interpolation parameter update period, and the state information, the interpolation parameters of the interpolation points are adaptively updated to obtain the interpolation parameters corresponding to the interpolation points.

3. The method according to claim 2, characterized in that, The status information also includes the feedback status of the target controlled object during operation. The step of adaptively updating the interpolation parameters of the interpolation points based on the interpolation order, the preset interpolation parameter update period, and the status information to obtain the interpolation parameters corresponding to the interpolation points includes: For the i-th interpolation point in the interpolation point sequence, if the interpolation order of the i-th interpolation point satisfies the preset interpolation parameter update period, the interpolation error state of the i-th interpolation point is determined based on the interpolation planning value of the (i-1)-th interpolation point and / or the state information; where i is a positive integer greater than 1, and the interpolation planning value of the first interpolation point is determined based on the preset interpolation parameters; the interpolation planning value of the interpolation point is used to describe the interpolation state corresponding to the interpolation point; Based on the interpolation error state of the i-th interpolation point, the interpolation parameters of the interpolation point are adaptively updated to obtain the interpolation parameters of the i-th interpolation point; the interpolation parameters are used to control the rate of change of the interpolation planning value; For the i-th interpolation point, if the interpolation order of the i-th interpolation point does not meet the preset interpolation parameter update period, the interpolation parameter corresponding to the interpolation planning value of the (i-1)-th interpolation point is determined as the interpolation parameter of the i-th interpolation point.

4. The method according to claim 3, characterized in that, The step of adaptively updating the interpolation parameters of the interpolation point based on the interpolation error state of the i-th interpolation point to obtain the interpolation parameters of the i-th interpolation point includes: Based on the control type of the target control object, a target parameter update function that is compatible with the target control object is determined from multiple parameter update functions; Based on the target parameter update function and the interpolation error state of the i-th interpolation point, the interpolation parameters are adaptively updated to obtain the interpolation parameters of the i-th interpolation point; The parameter update functions include at least two of the following: linear proportional function, inverse proportional function, piecewise function, and growth curve function.

5. The method according to claim 3, characterized in that, The preset interpolation generation period is not less than the preset interpolation parameter update period; the method further includes: If the interpolation order of the i-th interpolation point is an integer multiple of the preset interpolation parameter update period, then the interpolation order of the i-th interpolation point is determined to satisfy the preset interpolation parameter update period. If the interpolation order of the i-th interpolation point is not an integer multiple of the preset interpolation parameter update period, it is determined that the interpolation order of the i-th interpolation point does not satisfy the preset interpolation parameter update period.

6. The method according to claim 1, characterized in that, The step of interpolating based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and controlling the target controlled object to perform actions to transition from the initial state to the target state based on the interpolated result, includes: Based on the control type of the target control object, a target interpolation method suitable for the target control object is determined from multiple interpolation methods; wherein, the multiple interpolation methods include at least two of exponential interpolation, growth curve function interpolation, and filter interpolation; For each interpolation point in the interpolation point sequence, based on the interpolation parameters of the interpolation point, the interpolation point is interpolated according to the target interpolation method to obtain the interpolation planning value of the interpolation point; Based on the interpolation planning values ​​corresponding to each of the multiple interpolation points, the target control object is controlled to perform actions to transition from the initial state to the target state.

7. The method according to claim 6, characterized in that, The target interpolation method includes a multi-layered cascaded interpolation method; the step of interpolating the interpolation point based on the interpolation parameters of the interpolation point according to the target interpolation method to obtain the interpolation planning value of the interpolation point includes: Based on the interpolation parameters of the interpolation point, p-level cascaded interpolation is performed on the interpolation point to obtain the interpolation planning value of the interpolation point; In the p-level cascaded interpolation for the interpolation point, the interpolation result of the j-th interpolation is used as the input of the (j+1)-th interpolation, and the result of the p-th interpolation is used as the interpolation planning value of the interpolation point. The interpolation parameter of the j-th interpolation is determined based on the level of the j-th interpolation and the preset interpolation parameter update period, where j is a positive integer less than p and p is a positive integer greater than 1.

8. The method according to claim 6, characterized in that, The step of controlling the target controlled object to perform actions to transition from the initial state to the target state based on the interpolation planning values ​​corresponding to each of the multiple interpolation points includes: A target signal sequence is determined based on the interpolation planning values ​​corresponding to each of the multiple interpolation points; the target signal sequence includes multiple control signals, and each control signal corresponds to one of the interpolation points; Based on the target signal sequence, the target controlled object is controlled to perform an action to transition from the initial state to the target state.

9. An adaptive dynamic motion control device, characterized in that, The device includes: The acquisition module is used to acquire the status information of the target controlled object in the current control cycle; the status information includes the target status and initial status of the target controlled object; The interpolation point confirmation module is used to determine the interpolation point sequence based on a preset interpolation generation period. The parameter confirmation module is used to adaptively update the interpolation parameters of each interpolation point in the interpolation point sequence based on the preset interpolation parameter update period and the status information, so as to obtain the interpolation parameters corresponding to each interpolation point in the interpolation point sequence. The output module is used to perform interpolation based on the interpolation parameters corresponding to each interpolation point in the interpolation point sequence, and to control the target control object to perform actions to transition from the initial state to the target state based on the interpolated result.

10. A computer device comprising a memory and a processor, wherein the memory stores a computer program, characterized in that, When the processor executes the computer program, it implements the steps of the method according to any one of claims 1 to 8.

11. A computer-readable storage medium having a computer program stored thereon, characterized in that, When the computer program is executed by a processor, it implements the steps of the method according to any one of claims 1 to 8.