CN112947079B - Trajectory tracking control method of cricket system - Google Patents
Trajectory tracking control method of cricket system Download PDFInfo
- Publication number
- CN112947079B CN112947079B CN202110154835.2A CN202110154835A CN112947079B CN 112947079 B CN112947079 B CN 112947079B CN 202110154835 A CN202110154835 A CN 202110154835A CN 112947079 B CN112947079 B CN 112947079B
- Authority
- CN
- China
- Prior art keywords
- cricket
- follows
- nonlinear
- axis
- order
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
The invention discloses a track tracking control method of a plate ball system, which comprises the following steps: step 1, establishing a nonlinear mathematical model of a cricket system; step 2, describing the track tracking control problem of the cricket system into a nonlinear servo control problem; and 3, designing a 3-order state feedback controller by adopting a 3-order polynomial approximation regulator equation solution based on a nonlinear output regulation theory. The invention designs the feedback controller based on the nonlinear mathematical model of the cricket system, solves the problem of track tracking control of the system under a time-varying reference signal and has higher-precision tracking performance.
Description
Technical Field
The invention relates to the field of nonlinear system control, in particular to a trajectory tracking control method of a plate ball system.
Background
In recent decades, nonlinear output regulation theory has gained wide attention from the control world, and has the significant advantage of being able to achieve various control targets such as trajectory tracking, interference suppression, robustness, and the like. Common control strategies include feedback control and internal model control. The cricket system is a multi-input multi-output system with nonlinearity, strong coupling, and multiple variables, and is often used to test various advanced control algorithms. The trajectory tracking control problem of a cricket system can be described as a non-linear servo control problem. Although some documents adopt advanced control algorithms such as sliding mode control and the like to solve the problem of trajectory tracking of the cricket system, the track tracking is often based on a simplified cricket system model, and a satisfactory control effect is difficult to achieve. How to design a feedback controller based on an unreduced nonlinear mathematical model to realize the trajectory tracking control of the cricket system under a time-varying reference signal is to be further researched.
Disclosure of Invention
Based on the technical problems in the background art, the invention provides a track tracking control method of a cricket system. Aiming at the cricket system, a 3-order polynomial approximation regulator equation solution is adopted based on a nonlinear output regulation theory, and a 3-order state feedback controller is designed to realize a track tracking target of the cricket system under a time-varying reference signal.
The technical scheme adopted by the invention is as follows:
a trajectory tracking control method of a cricket system comprises the following steps:
and 3, designing a 3-order state feedback controller by adopting a 3-order polynomial approximation regulator equation solution based on a nonlinear output regulation theory.
Further, the trajectory tracking control method of the cricket system is characterized in that in the step 1, assuming that the small balls are always in contact with the flat plate and the sliding friction force between the cricket is ignored, the mathematical model of the cricket system is described as follows:
wherein the content of the first and second substances,respectively showing the displacement, speed and acceleration of the small ball on the flat plate in the directions of the x axis and the y axis,respectively representing the deflection angle, deflection angular velocity and deflection angular acceleration of the flat plate in the directions of an x axis and a y axis, wherein m represents the mass of the small ball, (I)p,Ib) Respectively representing the moment of inertia of the plate and the ball (tau)x,τy) Respectively showing the moment applied to the flat plate in the x-axis direction and the moment applied to the flat plate in the y-axis direction, and g shows the gravity acceleration;
order to
The system (1) can be written as follows:
wherein
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cosx8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cosx3)
Further, in the trajectory tracking control method of the cricket system, in step 2, the trajectory tracking control problem of the cricket system is described as a non-linear servo control problem, and the process is as follows:
2.1, suppose cricketIn the system, the displacement reference tracks of the small ball in the directions of the x axis and the y axis are two sinusoidal signals yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2) This displacement reference trajectory may be generated by an external system of the form:
wherein v ═ v1,v2,v3,v4]TOutput is yd1=v1,yd2=v3;
Let lambdai(i ═ 1,2,3,4) is a matrixCharacteristic value of (a), easy to verifyiEach having zero real part and the equilibrium point v-0 of the external system (3) is lyapunov stable;
2.2, define the tracking error as
2.3, the cricket system (2), the external system (3) and the error function (4) can be written in a compact form as follows:
wherein F (x (t), u (t), v (t)) is described as follows:
at this time, the problem of tracking and controlling the small ball displacement trajectory of the cricket system has been described as a nonlinear servo control problem, and the control objective is to design the controller u so that the reference signal on the small ball displacement trajectory tracking and the steady-state tracking error are small enough on the premise of ensuring the stability of the closed-loop system.
Further, the trajectory tracking control method of the plate ball system is characterized in that in step 3, based on a nonlinear output regulation theory, a 3-order polynomial is adopted to approximate the solution of a regulator equation, and a 3-order state feedback controller is designed, wherein the process is as follows:
3.1, solving the Jacobian matrix of the cricket ball system as follows:
it can be proven by calculation that:
(2)where n is the dimension 8 of the system state variable, p is the output dimension 2, λ ∈ { λ | λ ═ l1λ1+…+l4λ4,l1+…l4=l,l1…l4=0,1,2…l},l=1,2,3;
From 2.1 and 3.1 it is known that the 3 rd order nonlinear output tuning problem of the cricket system is solvable and that the solution of the tuner equation is unique because the input dimension is equal to the output dimension;
3.2, solving the regulator equation of the cricket system, wherein the process is as follows:
the cricket system regulator equation has the form:
wherein
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v)-mx1(v)x4(v)x6(v)-mgx1(v)cos x8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v-mx1(v)x6(v)x8(v)-mgx1(v)cos x3(v)]
A partial solution of the regulator equation can be obtained by simple calculations as follows:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
because the exact values of the other solutions to the regulator equation are not available, polynomial approximations are used to obtain their approximate solutions, and through mathematical calculations, the other 3 rd order approximate solutions can be obtained as follows:
here, the
d1000=gm
3.3, designing a 3-stage state feedback controller as follows:
u=y(3)(v)+Kx(x-x(3)(v)) (7)
wherein
Kx=[K1,K2]T
The invention has the advantages that:
the invention designs the feedback controller based on the nonlinear mathematical model of the cricket system, solves the problem of track tracking control of the system under a time-varying reference signal and has higher-precision tracking performance.
Drawings
FIG. 1 is a diagram of a 3-level state feedback control method.
Fig. 2 is a diagram illustrating the tracking effect of the x-axis and y-axis displacement tracks of the small ball.
Fig. 3 is a diagram of the actual trajectory of the pellet.
Fig. 4 is a comparison graph of tracking errors of the displacement of the ball under the action of the 1 st order and 3 rd order controllers.
Detailed Description
The technical solution in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. It is to be understood that the described embodiments are merely exemplary of the invention, and not restrictive of the full scope of the invention.
A trajectory tracking control method of a cricket system comprises the following steps:
assuming that the ball is always in contact with the plate and the sliding friction between the cricket is negligible, the mathematical model of the cricket system is described as follows:
wherein the content of the first and second substances,respectively showing the displacement, speed and acceleration of the small ball on the flat plate in the directions of the x axis and the y axis,respectively representing the deflection angle, deflection angular velocity and deflection angular acceleration of the flat plate in the directions of an x axis and a y axis, wherein m represents the mass of the small ball, (I)p,Ib) Respectively representing the moment of inertia of the plate and the ball (tau)x,τy) Respectively showing the moment applied to the flat plate in the x-axis direction and the moment applied to the flat plate in the y-axis direction, and g shows the gravity acceleration;
order to
The system (1) can be written as follows:
wherein
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cos x8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cos x3)
2.1, assuming that the displacement reference tracks of the small ball in the X-axis and Y-axis directions in the cricket system are two sinusoidal signals yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2) This displacement reference trajectory may be generated by an external system of the form:
wherein v ═ v1,v2,v3,v4]TOutput is yd1=v1,yd2=v3;
Let lambdai(i ═ 1,2,3,4) is a matrixCharacteristic value of (a), easy to verifyiEach having zero real part and the equilibrium point v-0 of the external system (3) is lyapunov stable;
2.2, define the tracking error as
2.3, the cricket system (2), the external system (3) and the error function (4) can be written in a compact form as follows:
wherein F (x (t), u (t), v (t)) is described as follows:
at this time, the problem of tracking and controlling the small ball displacement trajectory of the cricket system has been described as a nonlinear servo control problem, and the control objective is to design the controller u so that the reference signal on the small ball displacement trajectory tracking and the steady-state tracking error are small enough on the premise of ensuring the stability of the closed-loop system.
And 3, designing a 3-order state feedback controller by adopting a 3-order polynomial to approximate the solution of a regulator equation based on a nonlinear output regulation theory, wherein the process is as follows:
3.1, solving the Jacobian matrix of the cricket ball system as follows:
it can be proven by calculation that:
(2)where n is the dimension 8 of the system state variable, p is the output dimension 2, λ ∈ { λ | λ ═ l1λ1+…+l4λ4,l1+…l4=l,l1…l4=0,1,2…l},l=1,2,3;
From 2.1 and 3.1 it is known that the 3 rd order nonlinear output tuning problem of the cricket system is solvable and that the solution of the tuner equation is unique because the input dimension is equal to the output dimension;
3.2, solving the regulator equation of the cricket system, wherein the process is as follows:
the cricket system regulator equation has the form:
wherein
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v-mx1(v)x4(v)x6(v)-mgx1(v)cos x8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v-mx1(v)x6(v)x8(v)-mgx1(v)cos x3(v)]
A partial solution of the regulator equation can be obtained by simple calculations as follows:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
because the exact values of the other solutions to the regulator equation are not available, a multi-top approximation is used to obtain their approximate solutions, and through mathematical calculations, the other 3 rd order approximate solutions can be obtained as follows:
here, the
d1000=gm
3.4, designing a 3-stage state feedback controller as follows:
u=u(3)(v)+Kx(x-x(3)(v)) (7)
wherein
Kx=[K1,K2]T
In order to verify the validity of the proposed method, the invention provides a 3-stage state feedback controller (7) and a feedback control method of the type u-u(1)(v)+Kx(x-x(1)(v) The control effect of the 1 st order state feedback controller is verified by simulation, wherein
u(1)(v)=[c1000v1,d1000v1+d0010v3]T
x(1)(v)=[x1(v),x2(v),a1000v1,a1000ω1v2,x5(v),x6(v),v0010v3,v0010ω2v4]T
The specific parameters of the simulation verification are as follows:
acceleration of gravity g-9.8 m/s2Mass m of pellet is 0.038kg, and inertia moment of pellet Ib=4.2×10- 6kg·m2Radius of the sphere rb0.015m, moment of inertia of plate Ip=1.1kg·m2。
The state feedback control gain matrix is set to:
the present embodiment tracks the amplitude F1=F2=AmOf the sinusoidal reference signal yd1=Amsin2t andin FIGS. 2 to 4, Am0.5. Fig. 2 and 3 are a tracking effect diagram of x-axis and y-axis of the ball and an actual trajectory diagram of the ball under the action of a 3-order controller, respectively, and fig. 4 is a comparison diagram of tracking error of displacement of the ball under the action of a 1-order controller and a 3-order controller, respectively.
Meanwhile, in order to illustrate that the higher the order, the higher the controller precision and the better the tracking effect, this embodiment lists amThe maximum steady state tracking error results of the ball under the action of the 1 st and 3 rd order controllers when different values are taken are shown in table 1:
TABLE maximum Steady State tracking error under order 11 and 3 controllers
As can be seen from the simulation results of fig. 2-4: under the action of a 3-stage state feedback controller, the displacement of the small ball can quickly track the upper reference signal, and the steady-state tracking error is very small; it can be seen from fig. 4 and table 1 that the maximum steady-state tracking error of the 3-step state feedback controller is less than 1 step, and the tracking effect is better.
The above description is only for the preferred embodiment of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art should be considered to be within the technical scope of the present invention, and the technical solutions and the inventive concepts thereof according to the present invention should be equivalent or changed within the scope of the present invention.
Claims (1)
1. A trajectory tracking control method of a cricket system is characterized by comprising the following steps:
step 1, establishing a nonlinear mathematical model of a cricket system;
step 2, describing the track tracking control problem of the cricket system into a nonlinear servo control problem;
3, designing a 3-order state feedback controller by adopting a 3-order polynomial to approximate the solution of a regulator equation based on a nonlinear output regulation theory;
in step 1, assuming that the small ball is always in contact with the flat plate and the sliding friction force between the cricket is ignored, the nonlinear mathematical model of the cricket system is described as follows:
wherein, the ratio of (x, y),respectively showing the displacement, speed and acceleration (alpha, beta) of the small ball on the flat plate in the directions of the x axis and the y axis,respectively representing the deflection angle, deflection angular velocity and deflection angular acceleration of the flat plate in the directions of an x axis and a y axis, wherein m represents the mass of the small ball, (I)p,Ib) Respectively representing the moment of inertia of the plate and the ball (tau)x,τy) Respectively showing the moment applied to the flat plate in the x-axis direction and the moment applied to the flat plate in the y-axis direction, and g shows the gravity acceleration;
order to
The system (1) can be written as follows
Wherein
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cosx8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cosx3)
In step 2, the trajectory tracking control problem of the cricket system is described as a nonlinear servo control problem, and the process is as follows:
2.1, assuming that the displacement reference tracks of the small ball in the X-axis and Y-axis directions in the cricket system are two sinusoidal signals yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2) This displacement reference trajectory may be generated by an external system of the form:
wherein v ═ v1,v2,v3,v4]TOutput is yd1=v1,yd2=v3;
Let lambdai(i ═ 1,2,3,4) is a matrixCharacteristic value of (a), easy to verifyiEach have zero real part, and the balance point v of the external system (3) is 0 is lieThe compound is stable;
2.2, define the tracking error as
2.3, the cricket system (2), the external system (3) and the error function (4) can be written in a compact form as follows:
wherein F (x (t), u (t), v (t)) is described as follows:
at the moment, the trajectory tracking control problem of the cricket system is described as a nonlinear servo control problem, and the control target is to design a controller u to enable a reference signal on the displacement tracking of a small ball and a steady-state tracking error to be sufficiently small on the premise of ensuring the stability of a closed-loop system;
in step 3, based on the nonlinear output regulation theory, a 3-order polynomial approximation regulator equation solution is adopted to design a 3-order state feedback controller, and the process is as follows:
3.1, solving the Jacobian matrix of the cricket ball system as follows:
it can be proven by calculation that:
(2)where n is the dimension 8 of the system state variable, p is the output dimension 2, λ ∈ { λ | λ ═ l1λ1+…+l4λ4,l1+…l4=l,l1…l4=0,1,2…l},l=1,2,3;
From 2.1 and 3.1 it is known that the 3 rd order nonlinear output tuning problem of the cricket system is solvable and that the solution of the tuner equation is unique because the input dimension is equal to the output dimension;
3.2, solving the regulator equation of the cricket system, wherein the process is as follows:
the cricket system regulator equation has the form:
wherein
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v)-mx1(v)x4(v)x6(v)-mgx1(v)cosx8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v)-mx1(v)x6(v)x8(v)-mgx1(v)cosx3(v)]
A partial solution of the regulator equation can be obtained by simple calculations as follows:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
because the exact values of the other solutions to the regulator equation are not available, polynomial approximations are used to obtain their approximate solutions, and through mathematical calculations, the other 3 rd order approximate solutions can be obtained as follows:
here, the
d1000=gm
3.3, designing a 3-stage state feedback controller as follows:
u=u(3)(v)+Kx(x-x(3)(v)) (7)
wherein
Kx=[K1,K2]T
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110154835.2A CN112947079B (en) | 2021-02-04 | 2021-02-04 | Trajectory tracking control method of cricket system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110154835.2A CN112947079B (en) | 2021-02-04 | 2021-02-04 | Trajectory tracking control method of cricket system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947079A CN112947079A (en) | 2021-06-11 |
CN112947079B true CN112947079B (en) | 2022-03-29 |
Family
ID=76243856
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110154835.2A Active CN112947079B (en) | 2021-02-04 | 2021-02-04 | Trajectory tracking control method of cricket system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947079B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114114903B (en) * | 2021-10-19 | 2023-08-22 | 昆明理工大学 | Cricket system integral terminal sliding mode control method based on variable exponent power approach law |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6013997A (en) * | 1998-08-07 | 2000-01-11 | Tower Automotive, Inc. | Three dimensional tactile seam tracing device |
CN109976188A (en) * | 2019-03-12 | 2019-07-05 | 广东省智能制造研究所 | A kind of cricket control method and system based on Timed Automata |
CN110161848A (en) * | 2019-03-12 | 2019-08-23 | 广东省智能制造研究所 | A kind of single order straight line inverted pendulum control method and system based on Timed Automata |
CN111538274A (en) * | 2020-05-22 | 2020-08-14 | 滨州学院 | Visual control cricket control system |
-
2021
- 2021-02-04 CN CN202110154835.2A patent/CN112947079B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6013997A (en) * | 1998-08-07 | 2000-01-11 | Tower Automotive, Inc. | Three dimensional tactile seam tracing device |
CN109976188A (en) * | 2019-03-12 | 2019-07-05 | 广东省智能制造研究所 | A kind of cricket control method and system based on Timed Automata |
CN110161848A (en) * | 2019-03-12 | 2019-08-23 | 广东省智能制造研究所 | A kind of single order straight line inverted pendulum control method and system based on Timed Automata |
CN111538274A (en) * | 2020-05-22 | 2020-08-14 | 滨州学院 | Visual control cricket control system |
Non-Patent Citations (3)
Title |
---|
Hongwei Liu ; Yanyang Liang.Trajectory tracking sliding mode control of ball and plate system.《2010 2nd International Asia Conference on Informatics in Control, Automation and Robotics (CAR 2010)》.2010,第142-145页. * |
基于LM-RBF-PID的板球系统轨迹控制;黄文杰 等;《计算机工程与科学》;20200831;第42卷(第8期);全文 * |
板球系统的定点与轨迹跟踪控制器设计;高多;《CNKI中国优秀硕士学位论文全文数据库(电子期刊)信息科技辑》;20190630;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112947079A (en) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111618858B (en) | Manipulator robust tracking control algorithm based on self-adaptive fuzzy sliding mode | |
CN108983606B (en) | Robust sliding mode self-adaptive control method of mechanical arm system | |
CN108319144B (en) | Robot trajectory tracking control method and system | |
CN106078742B (en) | A kind of vibration control method for being directed to the flexible mechanical arm with output constraint | |
Yu | Nonlinear PD regulation for ball and beam system | |
CN107132761B (en) | Design method of electric steering engine adopting pure fuzzy and fuzzy PID composite control | |
CN111258216B (en) | Sliding mode repetitive controller suitable for four-rotor aircraft | |
CN105790668B (en) | One kind can overcome the nonlinear bicyclic automatic disturbance rejection controller of drive gap | |
CN107621783B (en) | Self-adaptive robust control method for transmitting platform based on friction compensation | |
CN1877469A (en) | Method for reducing buffeting of sliding mode variable structure control system | |
CN110936374B (en) | Flexible double-joint mechanical arm command filtering backstepping control method | |
CN112947079B (en) | Trajectory tracking control method of cricket system | |
CN111897223B (en) | Speed tracking guidance method considering dynamic characteristics of automatic pilot | |
CN108062024B (en) | Sliding mode control method for inversion of mobile robot by considering resistance | |
CN115256386B (en) | Uncertain mechanical arm neural self-adaptive control method considering tracking error constraint | |
CN115202216A (en) | Anti-interference finite time control method of mechanical arm considering input constraint | |
CN114939869A (en) | Mechanical arm trajectory tracking method based on nonsingular rapid terminal sliding mode | |
CN114114903B (en) | Cricket system integral terminal sliding mode control method based on variable exponent power approach law | |
CN109693774B (en) | Method and system for controlling track of underwater vehicle | |
CN116679571A (en) | Multi-axis vehicle tracking control method based on double feedback loop neural network | |
CN115179300A (en) | Flexible mechanical arm trajectory tracking control method for preset time | |
Huang et al. | Takagi-sugeno fuzzy H∞ tracking control for steer-by-wire systems | |
CN107065549B (en) | Electric steering engine design method based on nonlinear variable structure | |
Shing et al. | TS fuzzy path controller design for the omnidirectional mobile robot | |
CN113110066B (en) | Finite-time Super-Twisting sliding mode control method for four-rotor aircraft |
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 |