CN110389527B - Heterogeneous estimation-based MEMS gyroscope sliding mode control method - Google Patents
Heterogeneous estimation-based MEMS gyroscope sliding mode control method Download PDFInfo
- Publication number
- CN110389527B CN110389527B CN201910648290.3A CN201910648290A CN110389527B CN 110389527 B CN110389527 B CN 110389527B CN 201910648290 A CN201910648290 A CN 201910648290A CN 110389527 B CN110389527 B CN 110389527B
- Authority
- CN
- China
- Prior art keywords
- dimensionless
- designed
- substances
- content
- parameter
- 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/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/027—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using neural networks only
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
The invention relates to a heterogeneous estimation-based sliding-mode control method for an MEMS gyroscope, and belongs to the field of intelligent instruments. The method converts a gyroscope kinetic model into a dimensionless kinetic linear parameterized model; the current data and the historical data are combined to jointly design a parameter self-adaption law to be identified, so that parameter identification is realized; designing a self-adaptive neural network to adjust the weight of the neural network on line, and realizing effective estimation on uncertainty; the sliding mode controller is designed to realize the drive control of the MEMS gyroscope, and meanwhile, the robustness of the system to external interference is improved. The MEMS gyroscope sliding mode control method based on historical data learning and parameter identification based on heterogeneous estimation can solve the problem that the control precision of a driving control system is limited, realize high-precision gyroscope driving control, identify dynamic parameters and further improve the performance of the MEMS gyroscope.
Description
Technical Field
The invention relates to a drive control method of an MEMS gyroscope, in particular to an MEMS gyroscope sliding mode control method based on heterogeneous estimation, and belongs to the field of intelligent instruments.
Background
In practical engineering application, changes of working environments such as temperature, air pressure, magnetic field and vibration of the MEMS gyroscope pose challenges for gyro drive control, and particularly, a controller lacking adaptive capacity is difficult to adapt to a dynamically changing environment. Two commonly used solutions are: (1) the hardware design is improved, and the influence of shielding the external environment by the isolation component is increased; (2) the design scheme of the controller is improved, and the self-adaptive capacity of the controller is enhanced.
Because Sliding Mode Control is insensitive to external environment change and the system robustness is strong, an MEMS Gyroscope Global Sliding Mode Control method based on an RBF Neural Network is provided in the text of Adaptive Global Sliding Mode Control for MEMS Gyroscope Using RBF Neural Network (Yundi Chu and Juntao Fei, physical schemes in Engineering, 2015), the Neural Network is adopted to adjust Sliding Mode switching gain, and a dynamic model parameter identification result is provided at the same time. However, this method mainly focuses on the problem of sliding mode buffeting, and it is difficult to ensure the driving control accuracy.
Disclosure of Invention
Technical problem to be solved
In order to solve the problem that the control precision of a driving control system in the prior art is limited, the invention provides an MEMS gyroscope sliding mode control method based on heterogeneous estimation. The method combines the current data and the historical data to jointly construct a parameter self-adaptive law to be identified, and realizes parameter identification; designing a self-adaptive neural network to adjust the weight of the neural network on line, and realizing effective estimation on uncertainty; the sliding mode controller is designed to realize the drive control of the MEMS gyroscope, and meanwhile, the robustness of the system to external interference is improved.
Technical scheme
A sliding mode control method of an MEMS gyroscope based on heterogeneous estimation is characterized by comprising the following steps:
step 1: the MEMS gyroscopic dynamics model considering the presence of quadrature errors and system uncertainty is:
where m is the mass of the proof mass, ΩzIn order to input the angular velocity for the gyro,and x is the acceleration, velocity and displacement of the MEMS gyroscope proof mass along the driving shaft respectively,and y are acceleration, velocity and displacement along the detection axis respectively,andas an electrostatic driving force, cxxAnd cyyAs damping coefficient, kxxAnd kyyIn order to be a stiffness factor, the stiffness factor,andis a nonlinear coefficient, cxyAnd cyxTo damp the coupling coefficient, kxyAnd kyxIs the stiffness coupling coefficient; and is WhereinAndis a parameter nominal value, is selected according to a certain model of vibrating silicon micromechanical gyroscope, and is delta kxx、Δkyy、Δcxx、Δcyy、Δkxy、Δkyx、ΔcxyAnd Δ cyxIs an unknown uncertain parameter;
taking the dimensionless time t as omegaot*Non-dimensionalized displacement x ═ x*/q0,y=y*/q0Wherein ω is0As reference frequency, q0For reference length, the MEMS gyroscopic dynamics model is dimensionless and divided by the equation on both sides simultaneouslyTo obtain
Wherein the content of the first and second substances,and x is the dimensionless acceleration, the dimensionless speed and the dimensionless displacement of the MEMS gyroscope proof mass along the driving shaft respectively,and y is the dimensionless acceleration, the dimensionless speed and the dimensionless displacement along the detection axis, respectively;
redefining
The formula (2) can be represented as
Definition of θ ═ x, y]T,F=[f1,f2]T,ΔF=[Δf1,Δf2]T,U=[u1,u2]TThen formula (3) can be written as
Suppose thatIs the unknown parameter matrix to be identified,if the vector is a continuous micro regression function vector, performing linear parameterization on the F to obtain
F=WΦ (5)
Wherein the content of the first and second substances,is the input vector of the neural network and,is the weight matrix of the neural network, M is the number of nodes of the neural network,is a base vector, the q (q is 1,2, …, M) th element of which is defined as the following Gaussian function
Wherein σqIs the standard deviation of the gaussian to be designed,is the center of the gaussian function to be designed;
step 2: the reference trajectory given for MEMS gyroscopic dynamics (1) is
Wherein the content of the first and second substances,andrespectively reference vibration displacement signals of the proof mass along the drive axis and the detection axis,andreference amplitudes, ω, of drive and sense shaft vibrations, respectively1And ω2Respectively the reference angular frequencies of the drive shaft and the detection shaft vibrations,andthe phases of the drive shaft and the detection shaft vibration respectively;
the reference trajectory of the dimensionless kinetic equation (4) is
θd=[xd,yd]T (9)
Defining a tracking error as
e=θ-θd (10)
The slip form surface is designed as
the controller is designed as
U=Un+Us+Ul (12)
Us=-Kss(14)
defining a prediction error as
giving an adaptation law of the parameters
Wherein, the first term on the right side of the equation is calculated by using the data at the current moment, and the second term is calculated by using tau epsilon [ t-tau ]d,t]Historical data calculation in interval and parameter to be designedAndmeets the Hurwitz condition;
giving an update law of the weight of the neural network as
and step 3: the controller type (12) is designed to drive the dimensionless dynamics (4) based on the parameter adaptive law type (17) and the neural network weight updating law type (18), and the dimensionless dynamics are returned to the MEMS gyro dynamics model (1) through dimension conversion, so that gyro drive control and dynamics parameter identification are realized.
Advantageous effects
Compared with the prior art, the heterogeneous estimation-based MEMS gyroscope sliding mode control method has the beneficial effects that:
(1) aiming at the problem that the dynamic parameters are unknown in the actual engineering, the historical data information is fully mined, and the current data and the historical data are utilized to jointly construct a parameter adaptive law so as to realize parameter identification.
(2) Aiming at the uncertainty of system dynamics caused by environmental changes such as temperature, air pressure and the like, a self-adaptive neural network is designed to adjust the weight of the neural network on line, and the uncertainty effective estimation is realized.
(3) Aiming at the problem that the system is easily influenced by an external vibration environment, the sliding mode controller is designed to realize the drive control of the MEMS gyroscope and improve the robustness of the system.
Drawings
FIG. 1 is a flow chart of an embodiment of the present invention
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
the invention discloses a heterogeneous estimation-based MEMS gyroscope sliding mode control method, which comprises the following specific design steps in combination with figure 1:
(a) the MEMS gyroscopic dynamics model considering the presence of quadrature errors and system uncertainty is:
where m is the mass of the proof mass, ΩzIn order to input the angular velocity for the gyro,and x is the acceleration, velocity and displacement of the MEMS gyroscope proof mass along the driving shaft respectively,and y are acceleration, velocity and displacement along the detection axis respectively,andas an electrostatic driving force, cxxAnd cyyAs damping coefficient, kxxAnd kyyIn order to be a stiffness factor, the stiffness factor,andis a nonlinear coefficient, cxyAnd cyxTo damp the coupling coefficient, kxyAnd kyxIs the stiffness coupling coefficient. And is WhereinAndthe parameters are nominal values, and according to a certain type of vibrating silicon micromechanical gyroscope, each parameter of the gyroscope is selected to be m-5.7 multiplied by 10-9kg,q0=10-5m,ω0=1kHz,Ωz=5.0rad/s, Δkxx、Δkyy、Δcxx、Δcyy、Δkxy、Δkyx、ΔcxyAnd Δ cyxIs an unknown uncertain parameter.
Taking the dimensionless time t as omegaot*Non-dimensionalized displacement x ═ x*/q0,y=y*/q0Wherein ω is0As reference frequency, q0Carrying out dimensionless processing on the MEMS gyro dynamic model to obtain a reference length
Wherein the content of the first and second substances,and x is the dimensionless acceleration, the dimensionless speed and the dimensionless displacement of the MEMS gyroscope proof mass along the driving shaft respectively,and y is the dimensionless acceleration, the dimensionless velocity, and the dimensionless displacement along the detection axis, respectively.
Redefining the kinetic parameters to
The formula (3) can be represented as
Definition of
The formula (4) can be rewritten as
Definition of θ ═ x, y]T,F=[f1,f2]T,ΔF=[Δf1,Δf2]T,U=[u1,u2]TThen formula (5) can be written as
Suppose thatIs the unknown parameter matrix to be identified,if the vector is a continuous micro regression function vector, performing linear parameterization on the F to obtain
F=WΦ (7)
Wherein the content of the first and second substances,is the input vector of the neural network and,is a weight matrix of the neural network, M is the number of nodes of the neural network, M is selected to be 5 multiplied by 3 multiplied by 225,is a base vector, the q (q is 1,2, …, M) th element of which is defined as the following Gaussian function
Wherein σqIs the standard deviation of the Gaussian function, selected as σq=1,Is the center of the Gaussian function and has a value of-29.202, 29.202]×[-25.55,25.55]×[-6.2,6.2]×[-5,5]Can be selected arbitrarily.
(b) The reference trajectory given for MEMS gyroscopic dynamics (1) is
Wherein the content of the first and second substances,andreference vibration displacement signals of the proof mass along the drive axis and the proof axis, respectively.
The reference trajectory of the dimensionless kinetic equation (6) is
θd=[xd,yd]T (11)
Defining a tracking error as
e=θ-θd (12)
The slip form surface is designed as
the controller is designed as
U=Un+Us+Ul (14)
Us=-Kss (16)
defining a prediction error as
giving an adaptation law of the parameters
Wherein, the first term on the right side of the equation is calculated by using the data at the current moment, and the second term is calculated by using tau epsilon [ t-tau ]d,t]Historical data within the interval is calculated, and
giving an update law of the weight of the neural network as
(d) and designing a sliding mode controller formula (14) to drive a dimensionless dynamic formula (6) based on a parameter adaptive formula (19) and an update formula (20) of the weight of the neural network, and returning to the MEMS gyro dynamic model formula (1) through dimension conversion to realize gyro drive control and dynamic parameter identification.
Claims (1)
1. A sliding mode control method of an MEMS gyroscope based on heterogeneous estimation is characterized by comprising the following steps:
step 1: the MEMS gyroscopic dynamics model considering the presence of quadrature errors and system uncertainty is:
where m is the mass of the proof mass, ΩzIn order to input the angular velocity for the gyro,and x*Respectively the acceleration, the speed and the displacement of the MEMS gyroscope detection mass block along the driving shaft,and y*Acceleration, velocity and displacement along the detection axis,andas an electrostatic driving force, cxxAnd cyyAs damping coefficient, kxxAnd kyyIn order to be a stiffness factor, the stiffness factor,andis a nonlinear coefficient, cxyAnd cyxTo damp the coupling coefficient, kxyAnd kyxIs the stiffness coupling coefficient; and is WhereinAndis a parameter nominal value, is selected according to a certain model of vibrating silicon micromechanical gyroscope, and is delta kxx、Δkyy、Δcxx、Δcyy、Δkxy、Δkyx、ΔcxyAnd Δ cyxIs an unknown uncertain parameter;
taking the dimensionless time t as omegaot*Non-dimensionalized displacement x ═ x*/q0,y=y*/q0Wherein ω is0As reference frequency, q0For reference length, the MEMS gyroscopic dynamics model is dimensionless and divided by the equation on both sides simultaneouslyTo obtain
Wherein the content of the first and second substances,and x is the dimensionless acceleration, the dimensionless speed and the dimensionless displacement of the MEMS gyroscope proof mass along the driving shaft respectively,and y is the dimensionless acceleration, the dimensionless speed and the dimensionless displacement along the detection axis, respectively;
redefining
The formula (2) can be represented as
Definition of θ ═ x, y]T,F=[f1,f2]T,ΔF=[Δf1,Δf2]T,U=[u1,u2]TThen formula (3) can be written as
Suppose thatIs the unknown parameter matrix to be identified,if the vector is a continuous micro regression function vector, performing linear parameterization on the F to obtain
F=WΦ (5)
Wherein the content of the first and second substances,is the input vector of the neural network and,is the weight matrix of the neural network, M is the number of nodes of the neural network,is a base vector, the q element of which is defined as the following Gaussian function; q ═ 1,2, …, M;
wherein σqIs the standard deviation of the gaussian to be designed,is the center of the gaussian function to be designed;
step 2: the reference trajectory given for MEMS gyroscopic dynamics (1) is
Wherein the content of the first and second substances,andreference vibration displacement of the proof mass along the drive axis and the proof axis, respectivelyThe signal(s) is (are) transmitted,andreference amplitudes, ω, of drive and sense shaft vibrations, respectively1And ω2Respectively the reference angular frequencies of the drive shaft and the detection shaft vibrations,andthe phases of the drive shaft and the detection shaft vibration respectively;
the reference trajectory of the dimensionless kinetic equation (4) is
θd=[xd,yd]T (9)
Defining a tracking error as
e=θ-θd (10)
The slip form surface is designed as
the controller is designed as
U=Un+Us+Ul (12)
Us=-Kss (14)
defining a prediction error as
giving an adaptation law of the parameters
Wherein, the first term on the right side of the equation is calculated by using the data at the current moment, and the second term is calculated by using tau epsilon [ t-tau ]d,t]Historical data calculation in interval and parameter to be designedAndmeets the Hurwitz condition;
giving an update law of the weight of the neural network as
and step 3: the controller type (12) is designed to drive the dimensionless dynamics (4) based on the parameter adaptive law type (17) and the neural network weight updating law type (18), and the dimensionless dynamics are returned to the MEMS gyro dynamics model (1) through dimension conversion, so that gyro drive control and dynamics parameter identification are realized.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648290.3A CN110389527B (en) | 2019-07-18 | 2019-07-18 | Heterogeneous estimation-based MEMS gyroscope sliding mode control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910648290.3A CN110389527B (en) | 2019-07-18 | 2019-07-18 | Heterogeneous estimation-based MEMS gyroscope sliding mode control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110389527A CN110389527A (en) | 2019-10-29 |
CN110389527B true CN110389527B (en) | 2022-04-01 |
Family
ID=68285173
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910648290.3A Active CN110389527B (en) | 2019-07-18 | 2019-07-18 | Heterogeneous estimation-based MEMS gyroscope sliding mode control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110389527B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114253308B (en) * | 2020-09-21 | 2022-08-30 | 陕西环保产业研究院有限公司 | Active control method and equipment for vibration of space frame structure |
CN114199279B (en) * | 2021-11-26 | 2023-06-20 | 北京航天自动控制研究所 | Online estimation method of MEMS inertial measurement unit parameters based on high-precision inertial measurement unit in full-quantity mode |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298315A (en) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | Adaptive control system based on radial basis function (RBF) neural network sliding mode control for micro-electromechanical system (MEMS) gyroscope |
CN102914972A (en) * | 2012-11-01 | 2013-02-06 | 河海大学常州校区 | Micro-gyroscope RBF (Radial Basis Function) network self-adapting control method based on model global approximation |
CN103116275A (en) * | 2013-03-01 | 2013-05-22 | 河海大学常州校区 | Robust neural network control system for micro-electro-mechanical system (MEMS) gyroscope based on sliding mode compensation and control method of control system |
CN104281056A (en) * | 2014-09-18 | 2015-01-14 | 河海大学常州校区 | MEMS gyroscope robust self-adaptation control method based on neural network upper bound learning |
CN107607102A (en) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | MEMS gyro sliding formwork based on interference observer buffets suppressing method |
-
2019
- 2019-07-18 CN CN201910648290.3A patent/CN110389527B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298315A (en) * | 2011-06-21 | 2011-12-28 | 河海大学常州校区 | Adaptive control system based on radial basis function (RBF) neural network sliding mode control for micro-electromechanical system (MEMS) gyroscope |
CN102914972A (en) * | 2012-11-01 | 2013-02-06 | 河海大学常州校区 | Micro-gyroscope RBF (Radial Basis Function) network self-adapting control method based on model global approximation |
CN103116275A (en) * | 2013-03-01 | 2013-05-22 | 河海大学常州校区 | Robust neural network control system for micro-electro-mechanical system (MEMS) gyroscope based on sliding mode compensation and control method of control system |
CN104281056A (en) * | 2014-09-18 | 2015-01-14 | 河海大学常州校区 | MEMS gyroscope robust self-adaptation control method based on neural network upper bound learning |
CN107607102A (en) * | 2017-11-05 | 2018-01-19 | 西北工业大学 | MEMS gyro sliding formwork based on interference observer buffets suppressing method |
Non-Patent Citations (2)
Title |
---|
MEMS陀螺仪滑模控制策略研究;赵清;《中国优秀硕士学位论文全文数据库(电子期刊)》;20180615(第6期);第I140-574页 * |
Sliding mode control of MEMS gyroscopes;RUI ZHANG etc.;《Neurocomputing》;20180131;第275卷;第2555-2564页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110389527A (en) | 2019-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110389528B (en) | Data-driven MEMS gyroscope driving control method based on disturbance observation | |
CN108897226B (en) | The nonsingular sliding-mode control of MEMS gyroscope default capabilities based on interference observer | |
CN109927032A (en) | A kind of mechanical arm Trajectory Tracking Control method based on High-Order Sliding Mode observer | |
CN110389527B (en) | Heterogeneous estimation-based MEMS gyroscope sliding mode control method | |
CN110703610B (en) | Nonsingular terminal sliding mode control method for recursive fuzzy neural network of micro gyroscope | |
CN104049534B (en) | Self-adaption iterative learning control method for micro-gyroscope | |
CN106338918B (en) | A kind of adaptive dynamic surface amphineura network control method of microthrust test | |
CN110262237B (en) | Micro gyroscope super-distortion sliding mode control method based on double-feedback fuzzy neural network | |
CN110389530B (en) | MEMS gyroscope parameter identification drive control method based on data screening | |
Ranjbar et al. | A composite adaptive controller design for 3-DOF MEMS vibratory gyroscopes capable of measuring angular velocity | |
CN109062048B (en) | The nonsingular sliding-mode control of MEMS gyroscope default capabilities based on Hybrid Learning | |
CN110471293B (en) | Z-axis gyroscope sliding mode control method for estimating time-varying angular velocity | |
CN110426952B (en) | High-precision drive control method for interval data learning MEMS gyroscope considering external interference | |
CN110456639B (en) | MEMS gyroscope self-adaptive driving control method based on historical data parameter identification | |
CN107870566A (en) | MEMS gyroscope quick start method based on parallel estimation Hybrid Learning | |
CN110579966B (en) | Z-axis gyroscope control method based on neural network identification parameters | |
CN110456640B (en) | MEMS gyroscope parameter identification neural network control method based on nonsingular terminal sliding mode design | |
CN110262242B (en) | Micro gyroscope self-adaptive fractional order sliding mode control method | |
CN110456638B (en) | MEMS gyroscope parameter identification adaptive drive control method based on interval data excitation | |
CN110389529B (en) | MEMS gyroscope parameter identification driving control method based on parallel estimation | |
CN110389526B (en) | MEMS gyroscope self-adaptive sliding mode control method based on Super-Twisting algorithm | |
CN110703611B (en) | Micro-gyroscope sensor terminal sliding mode control system based on recursive fuzzy neural network | |
Lee et al. | Real-time rls-based joint model identification and state observer design for robot manipulators: Experimental studies | |
CN111930154B (en) | Nonsingular terminal sliding mode control method and device of MEMS gyroscope | |
CN107608216A (en) | MEMS gyroscope Hybrid Learning control method based on parallel estimation model |
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 |