CN119668091A - A piecewise linear motion control method based on adaptive MRAC and PID - Google Patents
A piecewise linear motion control method based on adaptive MRAC and PID Download PDFInfo
- Publication number
- CN119668091A CN119668091A CN202510186456.XA CN202510186456A CN119668091A CN 119668091 A CN119668091 A CN 119668091A CN 202510186456 A CN202510186456 A CN 202510186456A CN 119668091 A CN119668091 A CN 119668091A
- Authority
- CN
- China
- Prior art keywords
- mrac
- pid
- output
- controller
- follows
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Feedback Control In General (AREA)
Abstract
The invention discloses a piecewise linear motion control method based on self-adaptive MRAC and PID, which relates to the technical field of nonlinear control and comprises the following steps of 1, constructing an MRAC controller, 2, constructing a PID controller, 3, segmenting the whole motion process of a system for a plurality of times, regarding each section of actual output path as a linear line segment, switching the motion control mode of the system according to the error norm between state output and the estimation state of the PID control stage to obtain a system state feedback control law of the linear line segment, and 4, calculating the system state feedback control law of the whole motion process of the system according to the obtained system state feedback control law of the linear line segment.
Description
Technical Field
The invention relates to the technical field of nonlinear control, in particular to a piecewise linear motion control method based on self-adaptive MRAC and PID.
Background
The unmanned system faces the influence of uncertain factors such as enemy target attack, environmental interference and the like in a combat scene, and when the unmanned system is co-located with other units in the unmanned cluster, the unmanned system also performs self-attitude control. In summary, attitude control is a nonlinear process, and linearizing the nonlinear motion process of an unmanned system is a common and efficient method, because the system object characteristics after linearization are relatively clear, and the controller design is relatively simple and efficient.
The PID and Model Reference Adaptive Control (MRAC) algorithms each have advantages for controller design of nonlinear systems, especially piecewise linear systems. The PID controller has the advantages of convenient parameter design and relatively simple structure, can realize the deviation control of input and output through a proportional, integral and derivative controller, and reduces the time for controlling to reach the minimum deviation through an integral link, but has less ideal parameter effect for the same controller of different linear systems because the PID controller relatively depends on PID control parameters. The MRAC can adapt to the model according to the controller to realize the relatively ideal follow-up of input and output, but in the initial control stage, the adaptive parameters have larger deviation compared with the expected parameters, so that a better control effect cannot be achieved in the initial stage.
When the characteristics of each section of linear system are not different, a single control method can be adopted to design the piecewise linear system controller, and when the motion process of the system is complex and the motion track is tortuous, the control method is not applicable any more. Therefore, the present invention proposes a piecewise linear motion control method based on adaptive MRAC and PID to solve the above-mentioned shortcomings of the prior art.
Disclosure of Invention
The invention aims to provide a piecewise linear motion control method based on self-adaptive MRAC and PID, which solves the problem that a single PID or MRAC algorithm in the prior art is difficult to be applied under the conditions of complex system motion process and tortuous motion track.
In order to achieve the above object, the present invention provides a piecewise linear motion control method based on adaptive MRAC and PID, comprising the steps of:
step 1, constructing an MRAC controller;
step 2, constructing a PID controller;
Step3, segmenting the whole motion process S of the system for a plurality of times, wherein each segment of actual output path is regarded as a straight line segment ,Switching the motion control mode of the system according to the error norm between the state output and the PID control stage estimation state to obtainSystem state feedback control law of (2);
Step 4, obtained according to step 3System state feedback control law of (2)And obtaining a system state feedback control law u of the whole motion process S of the system.
Preferably, the MRAC controller constructed in step 1 specifically includes:
output of MRAC controller The calculated expression of (2) is as follows:
(1)
In the formula, For the input to the system,For the output of the system,As a scalar of the gain,Is a gain matrix;
MRAC controller outputs tracking state error The calculated expression of (2) is as follows:
(2)
In the formula, Representing a desired output;
Based on tracking state errors Calculating the gain scalar updated by the ith iterationGain matrixThe expression is as follows:
(3)
(4)
In the formula, Representing gain scalarIs used as a first derivative of (a),Representing gain matrixIs used as a first derivative of (a),Representing the coefficient matrix 1 after the i-th iteration update,Representing the output tracking state error after the i-th iteration update,Representing the system output transpose after the i-th iteration update,Representing the coefficient matrix 2 after the i-th iteration update,Is a system input.
Preferably, the PID controller constructed in step 2 specifically comprises:
output of PID controller The calculated expression of (2) is as follows:
(5)
In the formula, Representing the output tracking state error corresponding to the integration segment,、、Proportional gain, integral time and differential time of the linear system are known parameters (the numerical value is set according to the controlled object);
PID controller outputs tracking state error The calculated expression of (2) is as follows:
(6)
In the formula, Representing a desired output;
the control target is to ensure the state output of the controlled system Tracking a desired trajectoryThe expression is as follows:
(7)。
preferably, the expression for switching the motion control mode of the system according to the error norm between the state output and the PID control phase estimation state is as follows:
(8)
In the formula, Is the desired output during the PID control phase for evaluating the estimated state of the MRAC controller whenThe PID controller passes the tracking errorUpdatingAndWhen (1)When the system is in operation, the MRAC controller has better tracking performance and tracking precision, so that the MRAC controller is switched to perform motion control and update on the systemAndWherein, the method comprises the steps of,AndRespectively represent the gain scalar and gain matrix of the PID control stage,AndRespectively representing the gain scalar, gain matrix of the MRAC control stage.
Preferably, whenWhen updatingAndThe expression of (2) is as follows:
(9)
In the formula, Is output by the PID controller and is used for controlling the output,For the input to the system,Is the desired output.
Preferably, whenWhen updatingAndThe expression of (2) is as follows:
(10)
In the formula, For the output of the MRAC controller,The input of the system is provided by,And outputting a system.
Preferably, obtained in step 3System state feedback control law of (2)The expression of (2) is as follows:
(11)。
Preferably, the expression of the system state feedback control law u of the entire motion process S of the system obtained in step 4 is as follows, wherein, ;:
(12)。
Therefore, the invention adopts the piecewise linear motion control method based on the self-adaptive MRAC and PID, and has the following beneficial effects:
(1) The method provided by the invention enables the system to have faster control, considers the design problem of controllers of a plurality of piecewise linear systems by establishing PID and MRAC piecewise linear controllers, combines the characteristics of PID parameter fast control and MRAC self-adaptive control accuracy, and rapidly eliminates deviation to reach the expected position in the motion control process;
(2) The method provided by the invention enables the system to be switched more stably, realizes the self-adaptive control of the controlled object through the design of the switch controller, reduces the challenges brought to the controller by the characteristic change of the system switching and the like, overcomes the small disturbance in the switching process, and quickly approaches to an ideal value, and has good self-adaptive motion control effect under complex interference environments of high dynamic, strong countermeasure and the like.
The technical scheme of the invention is further described in detail through the drawings and the embodiments.
Drawings
FIG. 1 is an overall flow chart of a piecewise linear motion control method based on adaptive MRAC and PID of the present invention;
FIG. 2 is a block diagram of an MRAC controller according to an embodiment of the present invention;
FIG. 3 is a block diagram of a PID controller according to an embodiment of the invention;
FIG. 4 is a schematic diagram of a graph segmentation process according to an embodiment of the present invention;
Fig. 5 is a block diagram of a piecewise linear system controller in accordance with an embodiment of the present invention.
Detailed Description
The following detailed description of the embodiments of the invention, provided in the accompanying drawings, is not intended to limit the scope of the invention, as claimed, but is merely representative of selected embodiments of the invention. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
Referring to fig. 1-5, a piecewise linear motion control method based on adaptive MRAC and PID includes the steps of:
Step 1, constructing an MRAC controller, as shown in fig. 2, and providing an adaptive controller for state feedback, namely a Model Reference Adaptive Controller (MRAC), aiming at the stability of motion control and state tracking of a piecewise linear system, wherein the constructed MRAC controller specifically comprises:
output of MRAC controller The calculated expression of (2) is as follows:
(1)
In the formula, For the input to the system,For the output of the system,As a scalar of the gain,Is a gain matrix;
MRAC controller outputs tracking state error The calculated expression of (2) is as follows:
(2)
In the formula, Representing a desired output;
Based on tracking state errors Calculating the gain scalar updated by the ith iterationGain matrixThe expression is as follows:
(3)
(4)
In the formula, Representing gain scalarIs used as a first derivative of (a),Representing gain matrixIs used as a first derivative of (a),Representing the coefficient matrix 1 after the i-th iteration update,Representing the output tracking state error after the i-th iteration update,Representing the system output transpose after the i-th iteration update,Representing the coefficient matrix 2 after the i-th iteration update,Is a system input.
Step 2, constructing a PID controller as shown in fig. 3, wherein in order to enable the system state output to gradually track the expected track more quickly, the PID controller is used, and the constructed PID controller specifically comprises:
output of PID controller The calculated expression of (2) is as follows:
(5)
In the formula, Representing the output tracking state error corresponding to the integration segment,、、Proportional gain, integral time and differential time of the linear system are known parameters (the numerical value is set according to the controlled object);
PID controller outputs tracking state error The calculated expression of (2) is as follows:
(6)
In the formula, Representing a desired output;
the control target is to ensure the state output of the controlled system Tracking a desired trajectoryThe expression is as follows:
(7)。
Step3, segmenting the whole motion process S of the system for a plurality of times, wherein each segment of actual output path is regarded as a straight line segment The specific curve segmentation procedure is shown in figure 4,Switching the motion control mode of the system according to the error norm between the state output and the PID control stage estimation state, designing corresponding switching devices for the PID and MRAC parts to obtain the fast asymptotic tracking of the system state output to the expected track, as shown in figure 5System state feedback control law of (2)Wherein the expression for switching the motion control mode of the system according to the error norm between the state output and the PID control stage estimation state is as follows:
(8)
In the formula, Is the desired output during the PID control phase for evaluating the estimated state of the MRAC controller whenThe PID controller passes the tracking errorUpdatingAndThe PID controller can ensure error convergence to a certain extent whenWhen the system is in operation, the MRAC controller has better tracking performance and tracking precision, so that the MRAC controller is switched to perform motion control and update on the systemAndWherein, the method comprises the steps of,AndRespectively represent the gain scalar and gain matrix of the PID control stage,AndRespectively representing the gain scalar, gain matrix of the MRAC control stage.
When (when)When updatingAndThe expression of (2) is as follows:
(9)
In the formula, Is output by the PID controller and is used for controlling the output,For the input to the system,Is the desired output.
When (when)When updatingAndThe expression of (2) is as follows:
(10)
In the formula, For the output of the MRAC controller,The input of the system is provided by,And outputting a system.
Obtained bySystem state feedback control law of (2)The expression of (2) is as follows:
(11)。
Step 4, obtained according to step 3 System state feedback control law of (2)Obtaining a system state feedback control law u of the whole motion process S of the system, wherein each sectionCan control law by segmentationThe control proportion of the corresponding motion state is selected in a self-adaptive way, the control advantages of the two algorithms on the piecewise linear system are fully exerted, and the closed-loop control of the whole curve motion process S is finally realized, wherein,;The specific expression of the system state feedback control law u is as follows:
(12)。
therefore, the invention adopts the piecewise linear motion control method based on the self-adaptive MRAC and the PID, the piecewise linear system is controlled by the PID controller in the initial stage, and when the tracking state error is greater than the threshold value, the method is switched into the MRAC self-adaptive control state, thereby realizing the rapid asymptotic tracking of the system state output to the expected track.
It should be noted that the above-mentioned embodiments are merely for illustrating the technical solution of the present invention and not for limiting the same, and although the present invention has been described in detail with reference to the preferred embodiments, it should be understood by those skilled in the art that the technical solution of the present invention may be modified or substituted by the same, and the modified or substituted technical solution may not deviate from the spirit and scope of the technical solution of the present invention.
Claims (8)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202510186456.XA CN119668091B (en) | 2025-02-20 | 2025-02-20 | Piecewise linear motion control method based on self-adaptive MRAC and PID |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202510186456.XA CN119668091B (en) | 2025-02-20 | 2025-02-20 | Piecewise linear motion control method based on self-adaptive MRAC and PID |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN119668091A true CN119668091A (en) | 2025-03-21 |
| CN119668091B CN119668091B (en) | 2025-06-13 |
Family
ID=94999982
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202510186456.XA Active CN119668091B (en) | 2025-02-20 | 2025-02-20 | Piecewise linear motion control method based on self-adaptive MRAC and PID |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN119668091B (en) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20030195641A1 (en) * | 2000-06-20 | 2003-10-16 | Wojsznis Wilhelm K. | State based adaptive feedback feedforward PID controller |
| CN105182750A (en) * | 2015-09-02 | 2015-12-23 | 中国人民解放军军械工程学院 | Switching control method of linear/nonlinear active disturbance rejection control system |
| CN114779628A (en) * | 2022-03-16 | 2022-07-22 | 哈尔滨工业大学 | Active disturbance rejection motion control method based on RBF and multi-mode switching mechanism |
| CN114859889A (en) * | 2022-03-30 | 2022-08-05 | 华中科技大学 | Unmanned ship fault-tolerant control method based on path planning and control system thereof |
| US20220404777A1 (en) * | 2020-09-29 | 2022-12-22 | Dut Artificial Intelligence Institute, Dalian | Design method for undisturbed switching of linear controllers |
| CN117489669A (en) * | 2023-07-14 | 2024-02-02 | 山东理工大学 | Improved sectional active disturbance rejection control method for direct-drive valve-controlled electrohydraulic system |
-
2025
- 2025-02-20 CN CN202510186456.XA patent/CN119668091B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20030195641A1 (en) * | 2000-06-20 | 2003-10-16 | Wojsznis Wilhelm K. | State based adaptive feedback feedforward PID controller |
| CN105182750A (en) * | 2015-09-02 | 2015-12-23 | 中国人民解放军军械工程学院 | Switching control method of linear/nonlinear active disturbance rejection control system |
| US20220404777A1 (en) * | 2020-09-29 | 2022-12-22 | Dut Artificial Intelligence Institute, Dalian | Design method for undisturbed switching of linear controllers |
| CN114779628A (en) * | 2022-03-16 | 2022-07-22 | 哈尔滨工业大学 | Active disturbance rejection motion control method based on RBF and multi-mode switching mechanism |
| CN114859889A (en) * | 2022-03-30 | 2022-08-05 | 华中科技大学 | Unmanned ship fault-tolerant control method based on path planning and control system thereof |
| CN117489669A (en) * | 2023-07-14 | 2024-02-02 | 山东理工大学 | Improved sectional active disturbance rejection control method for direct-drive valve-controlled electrohydraulic system |
Non-Patent Citations (1)
| Title |
|---|
| 茅靖峰等: "风力发电系统最大功率跟踪自适应鲁棒控制", 电力系统保护与控制, no. 22, 15 November 2018 (2018-11-15) * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN119668091B (en) | 2025-06-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Jin et al. | Adaptive fuzzy control of uncertain stochastic nonlinear systems with full state constraints | |
| CN110376879B (en) | PID type iterative learning control method based on neural network | |
| CN110597061A (en) | A Multi-Agent Fully Distributed Active Disturbance Rejection Time-varying Formation Control Method | |
| CN117492359A (en) | Parameter optimization method of self-adaptive PID controller | |
| CN113359445A (en) | Distributed output feedback asymptotic consistent control method for multi-agent hysteresis system | |
| KR20180024092A (en) | Automatic Tuning Method for PID controllers | |
| CN118859686A (en) | A feedforward adaptive PID control optimization method | |
| CN102495547A (en) | Indirect adaptive fuzzy sliding mode control method of SISO discrete time system | |
| CN111413865B (en) | A Disturbance Compensation Single-loop Superheated Steam Temperature Active Disturbance Rejection Control Method | |
| CN114879508B (en) | Model predictive control-based grinding robot path tracking control method | |
| CN112241123A (en) | Aeroengine acceleration control method based on deep reinforcement learning | |
| CN110568763A (en) | A Model Predictive H∞ Fault Tolerant Control Method Against Intermittent Process Disturbance and Delay | |
| CN117452993A (en) | Temperature control method of temperature-cycle test box | |
| CN115981165B (en) | Global self-adaptive tracking control method for high-order non-strict feedback nonlinear system | |
| CN114035436A (en) | Backstepping control method based on saturation adaptive law, storage medium and equipment | |
| CN109212972A (en) | The limited rolling time horizon of batch process mixes 2D tracking and controlling method | |
| CN116135485A (en) | Design method of preset performance track tracking controller of two-degree-of-freedom mechanical arm | |
| CN118818985B (en) | Accurate positioning platform data driving control method based on jump inverse | |
| CN114200834B (en) | Optimal tracking control method for model-free off-track strategy in batch process in packet loss environment | |
| Chidrawar et al. | Generalized predictive control and neural generalized predictive control | |
| CN119668091B (en) | Piecewise linear motion control method based on self-adaptive MRAC and PID | |
| CN118438438B (en) | Variable load mechanical arm self-adaptive limited time fault tolerance control method and system based on fuzzy sliding mode | |
| CN110262221B (en) | A PID controller parameter control method for objects in thermal process | |
| CN113641193B (en) | Accurate tracking control method for non-minimum phase system | |
| CN112987561B (en) | Robust filter type iterative learning control method for finite time trajectory tracking |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |