CN103175445A - 基于mems陀螺的位标器系统及其跟踪方法 - Google Patents

基于mems陀螺的位标器系统及其跟踪方法 Download PDF

Info

Publication number
CN103175445A
CN103175445A CN2011104341073A CN201110434107A CN103175445A CN 103175445 A CN103175445 A CN 103175445A CN 2011104341073 A CN2011104341073 A CN 2011104341073A CN 201110434107 A CN201110434107 A CN 201110434107A CN 103175445 A CN103175445 A CN 103175445A
Authority
CN
China
Prior art keywords
module
signal
position marker
control module
gyroscope
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
Application number
CN2011104341073A
Other languages
English (en)
Other versions
CN103175445B (zh
Inventor
任亚飞
葛运旺
白旭灿
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Luoyang Institute of Science and Technology
Original Assignee
Luoyang Institute of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Luoyang Institute of Science and Technology filed Critical Luoyang Institute of Science and Technology
Priority to CN201110434107.3A priority Critical patent/CN103175445B/zh
Publication of CN103175445A publication Critical patent/CN103175445A/zh
Application granted granted Critical
Publication of CN103175445B publication Critical patent/CN103175445B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

本发明公开一种基于MEMS陀螺的位标器系统及跟踪方法。所述系统包括运动载体模块、电机及稳定平台模块、红外探测模块，安装在电机及稳定平台模块上、信号处理模块、光电跟踪控制模块、MEMS陀螺模块、陀螺信号处理模块、视轴稳定控制模块和功率驱动模块。与现有技术相比，本发明采用MEMS陀螺，使位标器体积和重量有效减小，生产成本降低，且本位标器敏感性和隔离度高，系统性能稳定、工作可靠，可以为多种红外探测设备提供准确的稳定平台。本发明的实用性更高，灵敏度和稳定性更好。

Description

基于MEMS陀螺的位标器系统及其跟踪方法
技术领域
本发明属于信号处理技术领域，具体涉及一种基于微机电MEMS(Micro-Electro Mechanical System)陀螺的位标器系统。
背景技术
导弹要在空中完成对目标的探测和跟踪任务，需要一个弹载的平台和搭载一个在该平台上有探测设备组成的集成系统，在硬件表现形式上称之为“位标器”， 广泛应用于红外制导控制系统中。位标器是一个典型的光、机、电结合的复杂组件，涉及的技术范围非常广泛。随着红外成像制导技术应用的不断扩展，急需解决如何提高视线稳定能力、扩大跟踪范围以及小型化、提高抗恶劣环境能力等问题。
目前大多数位标器里面的稳定平台用的是机械陀螺，具有体积大，重量大，安装难度大以及成本高等缺点。光纤陀螺同激光陀螺类似，由于制作工艺复杂，具有成本高，对振动不敏感，不利于批量生产等缺点。本发明的途径在于对制导信号进行分析，采用MEMS陀螺搭建位标器的稳定平台，该系统具有体积小，重量小，成本较低，易于批量生产以及隔离度高等优点。
发明内容
本发明要解决的技术问题是现有位标器体积大、重量大、成本高，提供一种体积小、重量小、成本低的基于MEMS陀螺的位标器系统，还介绍了该系统的跟踪方法。
本发明的技术方案是以下述方式实现的：一种基于MEMS陀螺的位标器系统，包括运动载体模块，用于产生动态；电机及稳定平台模块，安装在运动载体模块上，用于控制运动载体的状态；红外探测模块，安装在电机及稳定平台模块上，用于探测机动目标模块的状态；信号处理模块，用于接收红外探测模块的信号，并将该信号处理后传输至光电跟踪控制模块；光电跟踪控制模块，接收信号处理模块的信息并将处理后的信号传输至视轴稳定控制模块；MEMS陀螺模块，安装在电机及稳定平台模块上，检测电机及稳定平台模块的状态；陀螺信号处理模块，处理MEMS陀螺模块的检测信息并输送至视轴稳定控制模块；视轴稳定控制模块，接收陀螺信号处理模块和光电跟踪控制模块的信息，把稳定后的信号送入功率驱动模块；功率驱动模块，根据视轴稳定控制模块的信息控制电机及稳定平台模块。
一种基于MEMS陀螺的位标器系统的跟踪方法，是按照下述步骤进行的：
步骤1：红外探测模块探测机动目标模块的状态，把探测信息传递给信号处理模块，然后把处理后的信息送到光电跟踪控制模块，然后将处理跟踪结果送入视轴稳定控制模块等待处理；
步骤2：MEMS陀螺模块敏感电机及稳定平台模块的稳定状态，把测量的信号传递给陀螺信号处理模块，然后把处理后的测量信号送入视轴稳定控制模块等待处理；
步骤3：视轴稳定控制模块把陀螺信号处理模块、光电跟踪控制模块的信号稳定后送入功率驱动模块；控制电机及稳定平台模块。
与现有技术相比，本发明采用MEMS陀螺，使位标器体积和重量有效减小，生产成本降低，且本位标器敏感性和隔离度高，系统性能稳定、工作可靠，可以为多种红外探测设备提供准确的稳定平台。本发明的实用性更高，灵敏度和稳定性更好。
附图说明
图1是本发明的原理框图。
图2是本发明工作流程图。
具体实施方式
如图1所示，本发明的位标器系统，包括运动载体模块1，用于产生动态；电机及稳定平台模块2，安装在运动载体模块1上，用于控制运动载体的状态；红外探测模块3，安装在电机及稳定平台模块2上，用于探测机动目标模块10的状态；信号处理模块4，用于接收红外探测模块3的信号，并将该信处理后传输至光电跟踪控制模块5；光电跟踪控制模块5，接收信号处理模块4的信息并将处理后的信号传输至视轴稳定控制模块8；MEMS陀螺模块6，安装在电机及稳定平台模块2上，检测电机及稳定平台模块2的状态；陀螺信号处理模块7，处理MEMS陀螺模块6的检测信息并输送至视轴稳定控制模块8；视轴稳定控制模块8，接收陀螺信号处理模块7和光电跟踪控制模块5的信息，把稳定后的信号送入功率驱动模块9；功率驱动模块9，根据视轴稳定控制模块8的信息控制电机及稳定平台模块2。
本发明中，电机及稳定平台模块2安装在运动载体模块1上，用于控制运动载体的状态。红外探测模块3安装在电机及稳定平台模块2上，用于探测机动目标模块10的状态。信号处理模块4和光电跟踪控制模块5都是用于处理红外探测模块3探测的信号。MEMS陀螺模块6安装在电机及稳定平台模块2上，用于敏感平台的稳定状态。陀螺信号处理模块7用于处理MEMS陀螺模块6的测量信号。将处理后的红外探测信号和陀螺信号一并送入视轴稳定控制模块8，把稳定后的信号送入功率驱动模块9，最后控制电机及稳定平台模块2。
本发明基于MEMS陀螺的位标器跟踪方法，整体稳定式惯性平台系统由稳定内回路和跟踪回路组成，跟踪时具体按照以下步骤实施：
步骤1：红外探测模块3探测机动目标模块10的状态，把探测信息传递给信号处理模块4，然后把处理后的信息送到光电跟踪控制模块5，然后将处理跟踪结果送入视轴稳定控制模块8等待处理。
为了能对目标进行跟踪观测，平台作为跟踪系统的内回路，为跟踪器提供跟踪指令输入以及平台角度和角速度信号反馈。通过手动或者自动扫描搜索视场、锁定目标，系统进入自动跟踪模式，跟踪控制器接收目标脱靶指令，控制平台转动，使视轴始终对准被测的机动目标，达到对目标的跟踪。
步骤2：MEMS陀螺模块6敏感平台的稳定状态，把测量的信号传递给陀螺信号处理模块7，然后把处理后的测量信号送入视轴稳定控制模块8等待处理。
步骤3：视轴稳定控制模块9把陀螺信号处理模块7、光电跟踪控制模块5的信号稳定后送入功率驱动模块9；控制电机及稳定平台模块2。
稳定回路依靠惯性器件实时敏感载体相对惯性空间的偏离，并通过视轴稳定控制器进行实时纠正，保证成像传感器视轴和引起它抖动的各种干扰源相隔离，使其在惯性空间保持相同的角度瞄准方，如和载体的振动无关或者使其残余的晃动量保持在所允许的范围内，为红外探测系统提供一个能获取稳定信号的平台。因此，陀螺稳定光电跟踪平台从伺服控制角度而言，其实质为“视轴稳定与跟踪系统”，稳定分系统的主要任务是使MEMS陀螺与运动载体的姿态变化、振动等相隔离，使视轴稳定在固定的惯性空间里，达到空间稳定。
作为位标器的稳定跟踪系统的速度环敏感器件，MEMS陀螺感受载体在惯性空间的扰动量，并输出与角速度成比例的电压信号，通过控制器输出驱动电机对框架施加一个与扰动力矩大小相等、方向相反的平衡力矩，使系统隔离载体在惯性空间的扰动。同时，速度环反馈控制能够提高系统位置环响应的频带，增加位置环响应的快速性，从而实现红外探测系统的稳定和快速跟踪。为使MEMS陀螺获得更好的应用，通常采用对陀螺进行噪声抑制和信号滤波等系统控制技术，可以使采用MEMS陀螺作为速度反馈器件的光电稳定跟踪平台获得更高精度。
利用Kalman滤波对MEMS陀螺进行噪声抑制和信号滤波，对于单个陀螺，我们可以建立Kalman滤波方程:
Figure 2011104341073100002DEST_PATH_IMAGE001
             (1)
式中i=1,…,N,表示N个MEMS陀螺，
Figure 857976DEST_PATH_IMAGE002
标识量测时间。
Figure 2011104341073100002DEST_PATH_IMAGE003
表示
Figure 502453DEST_PATH_IMAGE002
时刻稳定平台的偏差信息，
Figure 444389DEST_PATH_IMAGE004
表示
Figure DEST_PATH_IMAGE005
时刻稳定平台的偏差信息。
Figure 703070DEST_PATH_IMAGE006
表示
Figure 97666DEST_PATH_IMAGE002
时刻MEMS陀螺的测量信息，
Figure DEST_PATH_IMAGE007
、
Figure 483517DEST_PATH_IMAGE008
表示稳定平台的运动方程系数，
Figure DEST_PATH_IMAGE009
表示陀螺的测量方程系数，
Figure 416312DEST_PATH_IMAGE010
表示稳定平台系统的噪声，
Figure DEST_PATH_IMAGE011
表示测量方法的误差。由于采用了三个单轴的MEMS陀螺进行搭建平台,我们把这3个陀螺进行实验,采用ARMA(2，1)模型参数模型表达式：
  
Figure 845894DEST_PATH_IMAGE012
           (2)
可以得到(1)式中，
Figure DEST_PATH_IMAGE013
；
Figure 790104DEST_PATH_IMAGE014
；
Figure DEST_PATH_IMAGE015
,
Figure 776383DEST_PATH_IMAGE016
为陀螺仪的量测值。噪声序列
Figure DEST_PATH_IMAGE017
、
Figure 738916DEST_PATH_IMAGE018
满足统计特性：
Figure DEST_PATH_IMAGE019
                            (3)
构造如下滤波器：
                                             (4)
Figure DEST_PATH_IMAGE021
                        (5)
             (6)
Figure DEST_PATH_IMAGE023
 
Figure 489770DEST_PATH_IMAGE024
(7)
其中：
Figure DEST_PATH_IMAGE025
为测量数据的方差；
Figure 572389DEST_PATH_IMAGE026
为系统过程噪声的方差，取值为。 
MEMS陀螺用于敏感模拟坐标系相对理想坐标系的偏角或角速度，具有体积小，重量轻以及成本低，可靠性高，易于批量生产等优点。本发明将MEMS陀螺引入位标器系统中，该位标器安装在导引头里的速率陀螺作为速度环的反馈器件，能够敏感空间角速度，构成的高增益角速度稳定回路可以保证平台在惯性空间稳定，实时隔离载体扰动。

Claims (2)

1. 一种基于MEMS陀螺的位标器系统，其特征在于包括
运动载体模块（1），用于产生动态；
电机及稳定平台模块（2），安装在运动载体模块（1）上，用于控制运动载体的状态；
红外探测模块（3），安装在电机及稳定平台模块（2）上，用于探测机动目标模块（10）的状态；
信号处理模块（4），用于接收红外探测模块（3）的信号，并将该信号处理后传输至光电跟踪控制模块（5）；
光电跟踪控制模块（5），接收信号处理模块（4）的信息并将处理后的信号传输至视轴稳定控制模块（8）；
MEMS陀螺模块（6），安装在电机及稳定平台模块（2）上，检测电机及稳定平台模块（2）的状态；
陀螺信号处理模块（7），处理MEMS陀螺模块（6）的检测信息并输送至视轴稳定控制模块（8）；
视轴稳定控制模块（8），接收陀螺信号处理模块（7）和光电跟踪控制模块（5）的信息，把稳定后的信号送入功率驱动模块（9）；
功率驱动模块（9），根据视轴稳定控制模块（8）的信息控制电机及稳定平台模块（2）。
2. 一种基于MEMS陀螺的位标器系统的跟踪方法，其特征在于是按照下述步骤进行的：
步骤1：红外探测模块（3）探测机动目标模块（10）的状态，把探测信息传递给信号处理模块（4），然后把处理后的信息送到光电跟踪控制模块（5），然后将处理跟踪结果送入视轴稳定控制模块（8）等待处理；
步骤2：MEMS陀螺模块（6）敏感电机及稳定平台模块的稳定状态，把测量的信号传递给陀螺信号处理模块（7），然后把处理后的测量信号送入视轴稳定控制模块（8）等待处理；
步骤3：视轴稳定控制模块（9）把陀螺信号处理模块（7）、光电跟踪控制模块（5）的信号稳定后送入功率驱动模块（9）；控制电机及稳定平台模块（2）。
CN201110434107.3A 2011-12-22 2011-12-22 基于mems陀螺的位标器系统及其跟踪方法 Expired - Fee Related CN103175445B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110434107.3A CN103175445B (zh) 2011-12-22 2011-12-22 基于mems陀螺的位标器系统及其跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110434107.3A CN103175445B (zh) 2011-12-22 2011-12-22 基于mems陀螺的位标器系统及其跟踪方法

Publications (2)

Publication Number Publication Date
CN103175445A true CN103175445A (zh) 2013-06-26
CN103175445B CN103175445B (zh) 2015-10-28

Family

ID=48635479

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110434107.3A Expired - Fee Related CN103175445B (zh) 2011-12-22 2011-12-22 基于mems陀螺的位标器系统及其跟踪方法

Country Status (1)

Country Link
CN (1) CN103175445B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106323282A (zh) * 2016-07-14 2017-01-11 中北大学 一种适应多种环境的稳定平台
CN108051787A (zh) * 2017-12-05 2018-05-18 上海无线电设备研究所 一种弹载雷达挂飞试验方法
CN108897341A (zh) * 2018-07-05 2018-11-27 中国科学院光电技术研究所 一种运动载体光电跟踪系统快速目标跟踪控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4085910A (en) * 1972-04-12 1978-04-25 Northrop Corporation Dual mode optical seeker for guided missile control
DE3238897A1 (de) * 1982-10-21 1984-04-26 Messerschmitt-Bölkow-Blohm GmbH, 8000 München Infrarot-testeinrichtung fuer fk-suchkoepfe
US4690351A (en) * 1986-02-11 1987-09-01 Raytheon Company Infrared seeker
US20050178875A1 (en) * 2003-07-01 2005-08-18 Shumov Sergeyi A. Portable surface-to-air missile system
CN101275842A (zh) * 2007-03-29 2008-10-01 北京控制工程研究所 中高轨道航天器的近红外光成像式自主导航敏感器系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4085910A (en) * 1972-04-12 1978-04-25 Northrop Corporation Dual mode optical seeker for guided missile control
DE3238897A1 (de) * 1982-10-21 1984-04-26 Messerschmitt-Bölkow-Blohm GmbH, 8000 München Infrarot-testeinrichtung fuer fk-suchkoepfe
US4690351A (en) * 1986-02-11 1987-09-01 Raytheon Company Infrared seeker
US20050178875A1 (en) * 2003-07-01 2005-08-18 Shumov Sergeyi A. Portable surface-to-air missile system
CN101275842A (zh) * 2007-03-29 2008-10-01 北京控制工程研究所 中高轨道航天器的近红外光成像式自主导航敏感器系统

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
张勤拓: "《基于MEMS惯性传感器的定位定向装置研究》", 《中国优秀硕士论文全文数据库》 *
耿光亚: "《红外成像导引头稳像系统设计与实现》", 《中国优秀硕士论文全文数据库》 *
肖仁鑫 等: "《滚俯仰式红外导引头稳定平台控制与方针》", 《红外与激光工程》 *
蒙涛 等: "《MEMS陀螺误差建模与滤波方法》", 《系统工程与电子技术》 *
袁赣南 等: "《MEMS陀螺随机漂移的状态空间模型分析及应用》", 《传感器技术》 *
陈东波: "《固体成像器件和系统》", 30 September 1991 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106323282A (zh) * 2016-07-14 2017-01-11 中北大学 一种适应多种环境的稳定平台
CN106323282B (zh) * 2016-07-14 2020-02-07 中北大学 一种适应多种环境的稳定平台
CN108051787A (zh) * 2017-12-05 2018-05-18 上海无线电设备研究所 一种弹载雷达挂飞试验方法
CN108897341A (zh) * 2018-07-05 2018-11-27 中国科学院光电技术研究所 一种运动载体光电跟踪系统快速目标跟踪控制方法

Also Published As

Publication number Publication date
CN103175445B (zh) 2015-10-28

Similar Documents

Publication Publication Date Title
CN103853156B (zh) 一种基于机载传感器的小型四旋翼飞行器控制系统及方法
CN108919841B (zh) 一种光电跟踪系统的复合轴控制方法及系统
CN105352495B (zh) 加速度与光流传感器数据融合无人机水平速度控制方法
CN101382805B (zh) 速率陀螺稳定平台式天线随动跟踪系统
Shen et al. Optical flow sensor/INS/magnetometer integrated navigation system for MAV in GPS-denied environment
Sa et al. Build your own visual-inertial drone: A cost-effective and open-source autonomous drone
Kong et al. A ground-based optical system for autonomous landing of a fixed wing UAV
CN104808231B (zh) 基于gps与光流传感器数据融合的无人机定位方法
CN102679979B (zh) 一种航空遥感三轴惯性稳定平台工作模式监控方法
CN104848859A (zh) 一种三轴惯性稳定平台及其自定位定向的控制方法
CN103587708A (zh) 超小型无人旋翼飞行器野外定点零盲区自主软着陆方法
CN107367934A (zh) 一种基于双扰动观测器的快反镜稳定控制方法
CN103322856B (zh) 一种基于偏振光/mimu的射击定姿与微动测量系统
Sun et al. Line-of-sight rate estimation based on UKF for strapdown seeker
CN103196453A (zh) 四轴飞行器视觉导航系统设计
Tsai et al. Optical flow sensor integrated navigation system for quadrotor in GPS-denied environment
CN103175445B (zh) 基于mems陀螺的位标器系统及其跟踪方法
EP4015993A1 (en) Aircraft sensor system synchronization
Cioffi et al. Hdvio: Improving localization and disturbance estimation with hybrid dynamics vio
CN100587644C (zh) 一种摄像机光轴稳定跟踪的一体化单回路控制器
Xie et al. Position estimation and control for quadrotor using optical flow and GPS sensors
Koch et al. A vision-based navigation algorithm for a VTOL-UAV
CN112882498B (zh) 具有抑制图像旋转功能的三轴光电搜索跟踪装置及方法
Wang et al. Uav attitude measurement based on enhanced mahony complementary filter
Borrello A multi stage pointing acquisition and tracking (PAT) control system approach for air to air laser communications

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20151028

Termination date: 20161222

CF01 Termination of patent right due to non-payment of annual fee