CN102980577A - 一种微型捷联航姿系统及其工作方法 - Google Patents

一种微型捷联航姿系统及其工作方法 Download PDF

Info

Publication number
CN102980577A
CN102980577A CN2012105165001A CN201210516500A CN102980577A CN 102980577 A CN102980577 A CN 102980577A CN 2012105165001 A CN2012105165001 A CN 2012105165001A CN 201210516500 A CN201210516500 A CN 201210516500A CN 102980577 A CN102980577 A CN 102980577A
Authority
CN
China
Prior art keywords
omega
magnetic
carrier
data
interface
Prior art date
Application number
CN2012105165001A
Other languages
English (en)
Other versions
CN102980577B (zh
Inventor
陈帅
李玺安
张晓亮
雷浩然
王于坤
程晨
查鑫熠
邓贵军
张黎
薄煜明
杜国平
邹卫军
吴盘龙
高玉霞
吉建娇
单童
朱源魁
Original Assignee
南京理工大学
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 南京理工大学 filed Critical 南京理工大学
Priority to CN201210516500.1A priority Critical patent/CN102980577B/zh
Publication of CN102980577A publication Critical patent/CN102980577A/zh
Application granted granted Critical
Publication of CN102980577B publication Critical patent/CN102980577B/zh

Links

Abstract

本发明为一种微型捷联航姿系统及其工作方法。该系统包括数据采集模块、数据处理解算模块和外围通信接口模块,其中:数据采集模块采用三轴陀螺仪、三轴加速度计、三轴磁阻传感器和SPI接口集成一体化的微电子机械系统传感器;数据处理解算模块采用32位ARM微控制器;外围通信接口模块包括串口电平转换芯片、RS_232接口、CAN收发器和CAN接口。该系统工作步骤为:系统上电初始化;系统自检;磁场自标定;初始对准;组合测姿:根据初始三维姿态角和捷联航姿系统姿态解算算法,解算出各航姿信息,同时用补偿后的磁场信息和加速度信息解算出三维磁姿态角,两者经过信息融合算法,最终得到稳定的航姿信息;发送航姿信息到应用设备。

Description

一种微型捷联航姿系统及其工作方法

一、技术领域

[0001] 本发明属于惯性技术领域,特别是一种微型捷联航姿系统及其工作方法。

二、背景技术

[0002] 在航天器、导弹、车辆的导航以及卫星、机器人、平台的姿态控制等领域中都需要用航姿系统来测量载体的姿态信息。目前发展较为迅速的为捷联航姿系统,捷联航姿系统是指直接把惯性测量组件(陀螺仪和加速度计等)固联在运载体上用数学平台解算载体姿态信息的系统。捷联航姿系统依靠算法建立起导航坐标系,即平台坐标系以数学平台形式存在,这样省略了复杂的物理实体平台,因此应用越来越广泛。但现有的捷联航姿系统集成度不够高,体积偏大,使用的惯性测量组件成本太高,没有考虑到外界信号(如GPS等)失

效的情况下如何利用地球周围固有的磁场来补偿航姿精度使其长时间稳定工作的问题,且隐蔽性不强,因此设计一种体积小,集成度高,性能好,成本低和适应能力强的捷联航姿系统成为航姿系统发展的趋势。

[0003] 文献I :中国实用新型专利“航姿组合测量装置”(公开号CN 201402140Y,公开日2010年02月10日)公开了一种可靠性高、成本较低的航姿组合测量装置,由信号处理与解算模块、惯性传感器组合及三轴磁传感器组成,其中的传感器模块由惯性传感器组合和三轴磁传感器两个独立部分组成,集成度不高;且该装置外围通信接口只有RS422,效率较低,数据传输不够稳定。

[0004] 文献2:中国发明专利“一种基于光纤陀螺的捷连航姿系统”(公开号CN102135430A,公开日2011年07月27日)公开了一种集成度高的小型捷联航姿系统,这种系统的传感器模块由陀螺仪和数字双轴倾角仪组成,在解算航姿信息的过程中,解算算法为积分运算,各种误差也会经过积分运算,导致系统的数据解算误差随时间不断积累,并且不断震荡和发散,航姿信息精度越来越低;其惯性测量传感器的陀螺仪为价格昂贵的光纤陀螺仪,使得航姿系统成本较高;该装置外围通信接口只有CAN总线,不够丰富,应用受限。

三、发明内容

[0005] 本发明的目的是提供一种体积小,集成度高,性能好,成本低和适应能力强的微型捷联航姿系统及其工作方法。

[0006] 实现本发明目的的技术解决方案为:一种微型捷联航姿系统,包括数据采集模块、数据处理解算模块和外围通信接口模块,其中:

[0007] 数据采集模块采用三轴陀螺仪、三轴加速度计、三轴磁阻传感器和第ISPI接口集成一体化的微电子机械系统传感器,其中三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别独立工作;数据处理解算模块采用32位ARM微控制器,该微控制器集成了数据处理解算单元、CAN控制器、UART接口和第2SPI接口 ;外围通信接口模块包括串口电平转换芯片、RS_232接口、CAN收发器和CAN接口;

[0008] 三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过第ISPI接口与第2SPI接口连接;第2SPI接口与数据处理解算单元连接;数据处理解算单元通过UART接口与串口电平转换芯片连接,数据处理解算单元还通过CAN控制器与外围通信接口模块的CAN收发器连接;串口电平转换芯片与RS_232接口连接,外围通信接口模块的CAN收发器与CAN接口连接;

[0009] 第ISPI接口与第2SPI接口之间通过SPI总线连接,数据采集模块的三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过SPI总线与数据处理解算模块通信;数据处理解算模块通过SPI总线读取数据采集模块的三轴角速度信息、三轴加速度信息和周围三轴磁场强度信息,并传输给数据处理解算单元,解算的航姿信息通过UART接口或CAN控制器发送给外围通信接口模块;外围通信接口模块的串口电平转换芯片把UART接口发来的TTL电平数据转换为RS_232电平数据,并通过RS_232接口发给外设;外围通信接口模块的CAN收发器将CAN控制器发来的TTL电平数据转换为物理总线的差分电平数据,然后通过CAN接口传输到CAN总线上的设备。

[0010] 使用所述的微型捷联航姿系统测量航姿的方法如下:

[0011] I)航姿系统上电后完成系统初始化工作,并进行系统自检,通过采集数据、发送数据,检查航姿系统有无异常;

[0012] 2)磁场自标定:在没有磁干扰的环境,将航姿系统在水平面缓慢均匀转动一周,数据处理解算单元通过SPI总线,从三轴磁阻传感器读取地球磁场强度在载体系三轴上的分量,通过椭圆补偿自标定法,标定出磁场补偿系数:载体系X轴的标定因数Xsf、Y轴的标定因数Ysf,以及磁场强度在载体系X轴上的漂移量Xoff、Y轴上的漂移量YofT ;

[0013] 3)初始对准状态:用上一步标定出的磁场补偿系数得到载体真实的磁场信息,使用该磁场信息和三轴加速度计值求出航姿系统在静止状态下的三维姿态角,同时算出陀螺的常值漂移,包括以下步骤:

[0014] (31)数据处理解算模块内的数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,并对它们进行补偿:

[0015] = Bl* Xsf + Xoff

[0016] = Bfi * Ysf + Yqff

[0017] = B:

[0018] B:、Βζ、祀为磁场强度在载体系三轴上的分量,

[0019] V K为磁场强度在载体系三轴上补偿后的分量;

[0020] (32)数据处理解算单元通过SPI总线,从三轴加速度计实时读取载体加速度值在

载体系三轴上的分量//、//、//,结合重力加速度g求出载体的俯仰角和滚转角:

Figure CN102980577AD00061

[0022] 其中Θ。为载体的俯仰角,Y。为载体的滚转角;

[0023] (33)根据载体的俯仰角Θ。、滚转角Y。和补偿后的磁场强度可以求得磁场水平分量的表达式为:

Figure CN102980577AD00062

[0026] 其中为磁场强度在水平面X轴的分量,为磁场强度在水平面Y轴的分量;则磁航向角ΨΜ为:

[0027]

Figure CN102980577AD00071

[0028] (34)地磁北向与地理北向之间的夹角就称之为磁偏角D,地磁北极在地理北极东侧时该值为正,地磁北极在地理北极西侧时该值为负,从而得到真航向角Ψ(!,航向角Vtl的表达式为:

[0029] Ψ0 = ¥m+D

[0030] (35)计算出陀螺的漂移:在静止状态,数据处理解算单元通过SPI总线,从三轴陀螺仪实时读取载体角速度值在载体系三轴上的分量、«I'、(^2h ,读取loo〜200次求均值,得到三轴陀螺仪在载体系三轴上的漂移εχ、ey、εζ,三轴陀螺仪的漂移记为ε =

[ε ε ε ]τ ;

Lx y zJ ,

[0031] 4)进入组合测姿状态,组合测姿包括以下步骤:

[0032] (41)根据初始对准状态的俯仰角Qtl、滚转角Ytl、航向角Vci,进行四元数转换得到初始四元数[qQQ Qoi Q02 Qo3]T ;

[0033] (42)在组合测姿状态,对三轴陀螺仪输出的角速度值在载体系三轴上的分! U1、 进行补偿:αζχ =O)^ -εχ βζί = —εγ ^ = ω1^ -εζ ,根据初始四兀数[q。。qQ1 q02

qQ3]T和ω!【、fi,用四阶-龙格库塔法求解四元数微分方程,得到更新后的四元数[qb。Qbl Qb2 qb3]T,转换为俯仰角Θ b、滚转角Yb、航向角…,即为组合测姿得到的航姿信息,将该航姿信息通过UART接口或CAN控制器发送给外围通信接口模块;

[0034] (43)数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,从三轴加速度计实时读取载体加速度值在载体系三轴上的分量,按照步骤(31)〜步骤(34)的方法求得俯仰角0a、滚转角Ya、航向角va,转换为四元数[qaQ Qal Qa2 qa3]T ;

[0035] (44)卡尔曼滤波及信息融合具体如下:

[0036] 本系统采用大失准角下的加性四元数法误差模型,姿态误差方程如下:

[0037]

Figure CN102980577AD00072

[0038] 式中,SQ为四元数误差为陀螺误差,

[0039]

Figure CN102980577AD00073

[0040] 参考卡尔曼滤波公式,状态方程为:i = FX+ (IW

[0041] 量测方程为:Z = HX+V

[0042]其中,状态变量X 为 X = [ δ qQ Sq1 δ q2 δ q3 ε χ ε y ε Jt = [ δ Q ε]τ,即 X包括S Q四元数变量部分和ε三轴陀螺仪漂移变量部分,W为系统激励白噪声;V为量测白噪声;[0043]

Figure CN102980577AD00081

[0044] 经卡尔曼滤波,将更新后的状态变量X的三轴陀螺仪漂移变量部分更新步骤(42)中三轴陀螺仪的漂移ε = [εχ ε y ε Jt ;

[0045] 将更新后的状态变量X的四元数变量部分补偿到步骤(42)中三轴陀螺仪计算得到的四元数[qM qbl qb2 qb3]T,将补偿后的[qbQ qbl qb2 qb3]Mt为步骤(42)中新的初始四元数;

[0046] 重复步骤(42)〜步骤(44),实现航姿系统的信息融合。

[0047] 本发明与现有技术相比,其显著优点是:

[0048] I、数据采集模块采用低成本的MEMS(微电子机械系统)传感器,该传感器利用MEMS技术和微电子技术从根本上改变了传统的惯性测量组合系统的设计思想和制造方法,实现了微型惯性测量组合系统中的微机械陀螺、微机械加速度计和磁强计获取测量信号、处理电路的一体化集成,不仅成本低、集成度高,而且对外输出接口为SPI 口,与数据处理解算模块物理连接方便,数据传输高效、稳定。

[0049] 2、数据处理解算模块采用32位ARM微控制器,片内资源丰富,在具体应用时可以存储程序和临时数据,也可以实现系统扩展,并且集成了两路CAN控制器,通过CAN收发器可实现CAN通信接口,把解算得到的丰富航姿信息传输到其他CAN总线上的设备,实现稳定,高效的数据传输。

[0050] 3、外围通信接口模块由RS_232串口和CAN通信接口组成:RS_232串口不仅能把处理器解算的航姿信息发给外设(如电脑)进行监控,而且还可以扩展外接GPS等设备,实现更深度的信息融合;CAN接口用于把解算得到的丰富航姿信息传输到其他CAN总线上的设备,实现稳定,高效的数据传输。

[0051] 4、不仅用了纯惯性组件解算航姿信息,而且还用三轴加速度计和磁阻传感器获取的信息解算出三维磁姿态角,两者经过信息融合算法,最终输出稳定的航姿信息,使航姿系统长时间稳定工作。各功能模块化、集成化,且对外无任何电磁辐射,隐蔽性好,不易暴露自身目标,环境适应能力强。

四附图说明

[0052] 图1是本发明的微型捷联航姿系统硬件模块框图。

[0053] 图2是本发明的微型捷联航姿系统的工作流程图。

[0054] 图3是本发明的微型捷联航姿系统的卡尔曼滤波信息融合算法流程图。

五具体实施方式

[0055] 以下结合附图,详细说明本发明的实施方式。

[0056] 结合图1,本发明的微型捷联航姿系统,数据采集模块采用三轴陀螺仪、三轴加速度计、三轴磁阻传感器和第ISPI接口集成一体化的微电子机械系统传感器,其中三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别独立工作;数据处理解算模块采用32位ARM微控制器,该微控制器集成了数据处理解算单元、CAN控制器、UART接口和第2SPI接口 ;外围通信接口模块包括串口电平转换芯片、RS_232接口、CAN收发器和CAN接口;

[0057] 三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过第ISPI接口与第2SPI接口连接;第2SPI接口与数据处理解算单元连接;数据处理解算单元通过UART接口与串口电平转换芯片连接,数据处理解算单元还通过CAN控制器与外围通信接口模块的CAN收发器连接;串口电平转换芯片与RS_232接口连接,外围通信接口模块的CAN收发器与CAN接口连接;

[0058] 第ISPI接口与第2SPI接口之间通过SPI总线连接,数据采集模块的三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过SPI总线与数据处理解算模块通信;数据处理解算模块通过SPI总线读取数据采集模块的三轴角速度信息、三轴加速度信息和周围三轴磁场强度信息,并传输给数据处理解算单元,解算的航姿信息通过UART接口或CAN控制器发送给外围通信接口模块;外围通信接口模块的串口电平转换芯片把UART接口发来的TTL电平数据转换为RS_232电平数据,并通过RS_232接口发给外设;外围通信接口模块的CAN收发器将CAN控制器发来的TTL电平数据转换为物理总线的差分电平数据,然后通过CAN接口传输到CAN总线上的设备。

[0059] 本发明的微型捷联航姿系统,所述的微电子机械系统传感器采用ADIS16405,所述的微控制器采用ARM7为核心的32位微控制器LPC2xxx系列,所述的RS_232串口还可以扩展外接GPS等设备。

[0060] ADIS16405惯性传感器产品是一套完整的惯性传感器系统,包括三轴陀螺仪、三轴加速度计和三轴磁阻传感器,并将工业领先的惯性MEMS技术与信号调理相结合,动态性能达到最优化。产品出厂前的校准表征了每个传感器的灵敏度、偏差、校准值、线性加速度以及陀螺漂移。因此,每个传感器都有其动态补偿校准方案,从而能在常温下提供精确的传感器测量值。磁阻传感器运用自校正功能使测量值与真实值的偏差降到最小。

[0061 ] 该传感器体积仅为23mm*23mm*23mm,三个轴的角速率测量范围为± 75 ° /s、±150° /s、±300° /(可设定),分辨率为14位;三个轴的加速度测量范围为±10g,分辨率为14位。对外输出接口为SPI 口,与LPC2119物理连接方便。使用时,只需给它供电,它就会以一定的频率向外输出数据。具有体积小、重量轻、寿命长、可靠性高、成本低和适应环境能力强等优点。

[0062] 数据处理解算模块采用的是飞利浦公司的ARM7为核心的32位微控制器LPC2119。LPC2119片内资源比较丰富,片内ROM高达128K,RAM空间有16K,在具体应用时可以存储程序和临时数据,也可以实现系统扩展。并且,LPC2119的片内Flash支持认IAP功能,可以用来存储数据。LPC2119集成了两路CAN控制器、两路UART及两路SPI,满足接口要求。

[0063] 微控制器LPC2119以一定频率实时通过SPI总线读取数据采集模块的加速度、角速度和磁场强度信息,存储在一定内存空间,然后进行三维姿态角解算。由于纯惯性组件解算数据的固有不足,一般通过RS_232接口外接GPS设备,以固定频率接收GPS信息,对航姿信息进行补偿,使航姿系统长时间稳定工作。但在GPS信息完全失效的情况下,航姿系统不能长时间稳定工作,为了解决这个问题,本微型捷联航姿系统不仅用了纯惯性组件解算航姿信息,而且还用三轴加速度计和磁阻传感器测量的地磁场信息解算出三维磁姿态角,两者经过信息融合算法,最终输出稳定的航姿信息,使航姿系统长时间稳定工作。[0064] 在实际使用环境中,由于周围铁磁材料的影响,地磁场不可避免地受到干扰磁场的影响。在这种情况下,地磁场的测量会带来一定的误差,计算得到的磁航向角也会有偏差。为了保证航姿系统输出精确的航向角,需对磁场干扰进行补偿。现行的磁航向误差补偿技术分为两类:一类是借助于外界因素的标定方法,如依靠高精度转台或标准六面体进行多点标定,这类方法虽然精度较高,但操作复杂,对大多数实际使用场合并不适用;另一类是不借助外界因素的自标定方法,这类方法操作方便,运算量小,补偿效果显著。本发明采用自标定方法,根据具体场合可使用椭圆补偿法、最小二乘曲线拟合法或矩形域的最小二乘曲面拟合法,经实践证明效果显著。

[0065] 外围通信接口模块由RS_232串口和CAN通信接口组成:LPC2119自带UART,通过串口电平转换芯片将TTL电平转换为RS_232电平,此接口不仅能把处理器解算的航姿信息发给外设(如PC机)显示导航数据,而且还可以功能扩展外接GPS信息,从而能得到载体的速度位置信息以及当前位置的磁偏角,进而实现更深度的信息融合;LPC2119集成了 CAN控制器,通过CAN收发器将CAN控制器收发引脚的TTL电平转换为物理总线的差分电平,实现CAN通信接口,把解算得到的丰富航姿信息传输到其他CAN总线上的设备如图像控制板等,实现稳定,闻效的数据传输。

[0066] 结合图2 :本发明的微型捷联航姿系统具体工作如下:

[0067] 使用所述的微型捷联航姿系统测量航姿的方法如下:

[0068] I)航姿系统上电后完成系统初始化工作,并进行系统自检,通过采集数据、发送数据,检查航姿系统有无异常;

[0069] 2)磁场自标定:在没有磁干扰的环境,将航姿系统在水平面缓慢均匀转动一周,数据处理解算单元通过SPI总线,从三轴磁阻传感器读取地球磁场强度在载体系三轴上的分量,通过椭圆补偿自标定法,标定出磁场补偿系数:载体系X轴的标定因数Xsf、Y轴的标定因数Ysf,以及磁场强度在载体系X轴上的漂移量Xoff、Y轴上的漂移量YofT ;

[0070] 3)初始对准状态:用上一步标定出的磁场补偿系数得到载体真实的磁场信息,使用该磁场信息和三轴加速度计值求出航姿系统在静止状态下的三维姿态角,同时算出陀螺的漂移,包括以下步骤:

[0071] (31)数据处理解算模块内的数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,并对它们进行补偿:

[0072] Blx = Bl* Xsf + Xoff

[0073] = Βζ * Ysf + Yoff

[0074] "f = B-

[0075] BI、Βζ,宄为磁场强度在载体系三轴上的分量,

[0076] Bt' 为磁场强度在载体系三轴上补偿后的分量;

[0077] (32)数据处理解算单元通过SPI总线,从三轴加速度计实时读取载体加速度值在载体系三轴上的分量//、//、//,结合重力加速度g求出载体的俯仰角和滚转角:

f fX\ ( fy、

[0078] θ0 = arcsin ———= arctan

V SJ \fb j

[0079] 其中Θ。为载体的俯仰角,Y。为载体的滚转角;

[0080] (33)根据载体的俯仰角Θ。、滚转角Y。和补偿后的磁场强度可以求得磁场水平分量的表达式为:

[0081 ] Bf = β;;' cos θ, + /?f sin θ,

[0082] Bi = Bhhx sinγα sin θ0 + B^' cos f0 — sinγ0 cosθα

[0083] 其中为磁场强度在水平面X轴的分量.#/为磁场强度在水平面Y轴的分量;则磁航向角ΨΜ为:

[0084]

Figure CN102980577AD00111

[0085] (34)地磁北向与地理北向之间的夹角就称之为磁偏角D,地磁北极在地理北极东侧时该值为正,地磁北极在地理北极西侧时该值为负,从而得到真航向角Ψ(!,航向角Vtl的表达式为:

[0086] ψ0= Vm+D

[0087] (35)计算出陀螺的漂移:在静止状态,数据处理解算单元通过SPI总线,从三轴陀螺仪实时读取载体角速度值在载体系三轴上的分量、mfh、ωξ,读取100〜200次求均值,得到三轴陀螺仪在载体系三轴上的漂移εχ、ey、εζ,三轴陀螺仪的漂移记为ε =

Figure CN102980577AD00112

[0088] 4)进入组合测姿状态,组合测姿包括以下步骤:

[0089] (41)根据初始对准状态的俯仰角Qtl、滚转角Ytl、航向角Vci,进行四元数转换得到初始四元数[qQQ Qoi Q02 Qo3]T ;

[0090] (42)在组合测姿状态,对三轴陀螺仪输出的角速度值在载体系三轴上的分量4、CO^l、进行补偿-εχ Mt = ο>1-εν ^ = ο\ -εζ,根据初始四元数[q。。qQ1 q02qQ3]T和#'、政、ffli,用四阶-龙格库塔法求解四元数微分方程,得到更新后的四元数[qbQQbl Qb2 qb3]T,转换为俯仰角Θ b、滚转角Yb、航向角…,即为组合测姿得到的航姿信息,将该航姿信息通过UART接口或CAN控制器发送给外围通信接口模块;

[0091] (43)数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,从三轴加速度计实时读取载体加速度值在载体系三轴上的分量,按照步骤(31)〜步骤(34)的方法求得俯仰角0a、滚转角Ya、航向角va,转换为四元数[qaQ Qal Qa2 qa3]T ;

[0092] (44)卡尔曼滤波及信息融合具体如下:

[0093] 本系统采用大失准角下的加性四元数法误差模型,姿态误差方程如下:

[0094]

[0095] 式中,SQ为四元数误为陀螺误差,

O -1 Zh -α>1 -ω\ζ -qbl —qbl —qbi

[0096] H)=气 °fe f 知;

°hb 0 V j ?63 ?60 cIbl

J^b 0 J L-9j2 %0 —

[0097] 参考卡尔曼滤波公式,状态方程为:X = FX + GW

[0098] 量测方程为a = HX+V[0099]其中,状态变量X 为 X = [ δ qQ Sq1 δ q2 δ q3 ε χ ε y ε Jt = [ δ Q ε]τ,即 X包括S Q四元数变量部分和ε三轴陀螺仪漂移变量部分,W为系统激励白噪声;V为量测白噪声;

Figure CN102980577AD00121

[0101] 将系统的状态方程和量测方程离散化表示为:

[0102] Xk= Ok, ^1Xk-!+T^1Wk-!

[0103] Zk = HkXk+Vk

[0104] 其中,Xk表示被估计状态,Okjk^1为V1时刻的一步转移矩阵,r H为系统噪声驱动阵,Wk为系统激励噪声序列,Zk为量测矩阵,Hk为量测阵,Vk为量测噪声序列。

[0105] 根据适用于离散系统的卡尔曼滤波器基本方程的卡尔曼算法具体如下:

[0106] ①状态一步预测方程:

[0107] Xk/H = Φ,,ηΧη

[0108] ②一步预测均方误差方程:

[01 09] PkJk-1 — Φι(^-Λ-Ι^Λ-1 + ^ k-lQk-^ k-\

[0110] ③最优滤波增益方程:

[0111] Kk = Pkw^lAHkPk^Hl +RkY1

[0112] ④状态估计方程:

[0113] Xk = UKk(Zk-HkX1^1)

[0114] ⑤估计均方误差方程:

[0115] Pk={l-KMk)l\1: ^l-KiHlY +KJlkKl,

[0116] 其中,Qk是系统过程噪声方差阵,Kk为滤波增益系数,Rk是系统观测噪声方差阵,Pk为均方误差阵。

[0117] 经卡尔曼滤波,将更新后的状态变量X的三轴陀螺仪漂移变量部分更新步骤(42)中三轴陀螺仪的漂移ε = [εχ ε y ε Jt ;

[0118] 将更新后的状态变量X的四元数变量部分补偿到步骤(42)中三轴陀螺仪计算得到的四元数[qM qbl qb2 qb3]T,将补偿后的[qbQ qbl qb2 qb3]Mt为步骤(42)中新的初始四元数;

[0119] 重复步骤(42)〜步骤(44),实现航姿系统的信息融合。

Claims (6)

1. 一种微型捷联航姿系统,其特征在于,包括数据采集模块、数据处理解算模块和外围通信接口模块,其中: 数据采集模块采用三轴陀螺仪、三轴加速度计、三轴磁阻传感器和第ISPI接口集成一体化的微电子机械系统传感器,其中三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别独立工作;数据处理解算模块采用32位ARM微控制器,该微控制器集成了数据处理解算单元、CAN控制器、UART接口和第2SPI接口 ;外围通信接口模块包括串口电平转换芯片、RS_232接口、CAN收发器和CAN接口 ; 三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过第I SPI接口与第2 SPI接口连接;第2 SPI接口与数据处理解算单元连接;数据处理解算单元通过UART接口与串口电平转换芯片连接,数据处理解算单元还通过CAN控制器与外围通信接口模块的CAN收发器连接;串口电平转换芯片与RS_232接口连接,外围通信接口模块的CAN收发器与CAN接口连接; 第I SPI接口与第2 SPI接口之间通过SPI总线连接,数据采集模块的三轴陀螺仪、三轴加速度计、三轴磁阻传感器分别通过SPI总线与数据处理解算模块通信;数据处理解算模块通过SPI总线读取数据采集模块的三轴角速度信息、三轴加速度信息和周围三轴磁场强度信息,并传输给数据处理解算单元,解算的航姿信息通过UART接口或CAN控制器发送给外围通信接口模块;外围通信接口模块的串口电平转换芯片把UART接口发来的TTL电平数据转换为RS_232电平数据,并通过RS_232接口发给外设;外围通信接口模块的CAN收发器将CAN控制器发来的TTL电平数据转换为物理总线的差分电平数据,然后通过CAN接口传输到CAN总线上的设备。
2.根据权利要求I所述的微型捷联航姿系统,其特征在于所述的微电子机械系统传感器采用 ADIS16405。
3.根据权利要求I所述的微型捷联航姿系统,其特征在于所述的微控制器采用ARM7为核心的32位微控制器LPC2xxx系列。
4.根据权利要求I所述的微型捷联航姿系统,其特征在于所述的RS_232串口还可以扩展外接GPS等设备。
5.如权利要求I所述的微型捷联航姿系统的测姿方法,其特征在于,工作方法如下: 1)航姿系统上电后完成系统初始化工作,并进行系统自检,通过采集数据、发送数据,检查航姿系统有无异常; 2)磁场自标定:在没有磁干扰的环境,将航姿系统在水平面缓慢均匀转动一周,数据处理解算单元通过SPI总线,从三轴磁阻传感器读取地球磁场强度在载体系三轴上的分量,通过椭圆补偿自标定法,标定出磁场补偿系数:载体系X轴的标定因数Xsf、Y轴的标定因数Ysf,以及磁场强度在载体系X轴上的漂移量Xoff、Y轴上的漂移量YofT ; 3)初始对准状态:用上一步标定出的磁场补偿系数得到载体真实的磁场信息,使用该磁场信息和三轴加速度计值求出航姿系统在静止状态下的三维姿态角,同时算出陀螺的漂移,包括以下步骤: (31)数据处理解算模块内的数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,并对它们进行补偿: Btx= Βζ* Xsf+ Xoff
Figure CN102980577AC00031
BI、尻为磁场强度在载体系三轴上的分量, B:、/f为磁场强度在载体系三轴上补偿后的分量; (32)数据处理解算单元通过SPI总线,从三轴加速度计实时读取载体加速度值在载体系三轴上的分量//、//、/结合重力加速度g求出载体的俯仰角和滚转角:
Figure CN102980577AC00032
其中θ C1为载体的俯仰角,Ytl为载体的滚转角; (33)根据载体的俯仰角Qtl、滚转角Υ(ι和补偿后的磁场强度可以求得磁场水平分量的表达式为:
Figure CN102980577AC00033
其中取f为磁场强度在水平面X轴的分量,成'为磁场强度在水平面Y轴的分量;则磁航向角ψμ为: ΨM=arctam(BYb/BXb) (34)地磁北向与地理北向之间的夹角就称之为磁偏角D,地磁北极在地理北极东侧时该值为正,地磁北极在地理北极西侧时该值为负,从而得到真航向角Ψ(!,航向角Ψ(!的表达式为: Ψ0 = ¥m+D (35)计算出陀螺的漂移:在静止状态,数据处理解算单元通过SPI总线,从三轴陀螺仪实时读取载体角速度值在载体系三轴上的分量,读取100〜200次求均值,得到三轴陀螺仪在载体系三轴上的漂移ε χ、ε y、ε z,三轴陀螺仪的漂移记为ε = [ ε χ ε y^Jt ; 4)进入组合测姿状态,组合测姿包括以下步骤: (41)根据初始对准状态的俯仰角Qtl、滚转角Y(l、航向角Ψ(ι,进行四元数转换得到初始四元数[q00 Qoi Q02 Q03]T ; (42)在组合测姿状态,对三轴陀螺仪输出的角速度值在载体系三轴上的分量<、<4、ί4ζ进行补偿-.OJ^ = CO= - εχ fot = CO^l - Sy ^ =ω^-ε,,根据初始四元数[qQ(l q01 Q02 Q03]T 和ω^\ <,用四阶-龙格库塔法求解四元数微分方程,得到更新后的四元数[qM Qbl qb2qb3]T,转换为俯仰角9b、滚转角Yb、航向角Vb,即为组合测姿得到的航姿信息,将该航姿信息通过UART接口或CAN控制器发送给外围通信接口模块; (43)数据处理解算单元通过SPI总线,从数据采集模块的三轴磁阻传感器实时读取地球磁场强度在载体系三轴上的分量,从三轴加速度计实时读取载体加速度值在载体系三轴上的分量,按照步骤(31)〜步骤(34)的方法求得俯仰角0a、滚转角Ya、航向角Va,转换为四元数[qaQ Qai Qa2 qa3]T ; (44)卡尔曼滤波信息融合:本系统采用大失准角下的加性四元数法误差模型,姿态误差方程如下:
Figure CN102980577AC00041
式中,S Q为四元数误差为陀螺误差,
Figure CN102980577AC00042
参考卡尔曼滤波公式,状态方程为-X = FX + GW 量测方程为:Z = HX+V 其中,状态变量 X 为 X = [ δ q。Sq1 Sq2 δ q3 ε χ ε y ε Jt = [ δ Q ε]τ,即 X 包括SQ四元数变量部分和ε三轴陀螺仪漂移变量部分,W为系统激励白噪声;V为量测白噪声;
Figure CN102980577AC00043
经卡尔曼滤波,将更新后的状态变量X的三轴陀螺仪漂移变量部分更新步骤(42)中三轴陀螺仪的漂移ε = [εχ ε y ε 】t ; 将更新后的状态变量X的四元数变量部分补偿到步骤(42)中三轴陀螺仪计算得到的四元数[qb0 Qbi Qb2 %3]Τ,将补偿后的[qb0 Qbi Qb2如^作为步骤(42)中新的初始四元数;重复步骤(42)〜步骤(44),实现航姿系统的信息融合。
6.如权利要求5所述的微型捷联航姿系统的测姿方法,其特征在于,步骤(44)中所述的卡尔曼滤波的滤波周期为Is。
CN201210516500.1A 2012-12-05 2012-12-05 一种微型捷联航姿系统及其工作方法 CN102980577B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210516500.1A CN102980577B (zh) 2012-12-05 2012-12-05 一种微型捷联航姿系统及其工作方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210516500.1A CN102980577B (zh) 2012-12-05 2012-12-05 一种微型捷联航姿系统及其工作方法

Publications (2)

Publication Number Publication Date
CN102980577A true CN102980577A (zh) 2013-03-20
CN102980577B CN102980577B (zh) 2015-07-08

Family

ID=47854814

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210516500.1A CN102980577B (zh) 2012-12-05 2012-12-05 一种微型捷联航姿系统及其工作方法

Country Status (1)

Country Link
CN (1) CN102980577B (zh)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103353304A (zh) * 2013-06-25 2013-10-16 深圳市宇恒互动科技开发有限公司 一种对三维惯性运动感测进行补偿的方法及装置
CN103630137A (zh) * 2013-12-02 2014-03-12 东南大学 一种用于导航系统的姿态及航向角的校正方法
CN103759730A (zh) * 2014-01-16 2014-04-30 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN103776451A (zh) * 2014-03-04 2014-05-07 哈尔滨工业大学 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
CN103823209A (zh) * 2014-02-13 2014-05-28 中国科学院电子学研究所 用于轻小型合成孔径雷达系统中低成本运动误差测量装置
CN103868512A (zh) * 2014-03-25 2014-06-18 西安电子科技大学 飞行器航向姿态高精度测试电路
CN103940442A (zh) * 2014-04-03 2014-07-23 深圳市宇恒互动科技开发有限公司 一种采用加速收敛算法的定位方法及装置
CN104457748A (zh) * 2013-09-18 2015-03-25 南京理工大学 一种嵌入式瞄准吊舱测姿系统及其传递对准方法
CN104567931A (zh) * 2015-01-14 2015-04-29 华侨大学 一种室内惯性导航定位的航向漂移误差消除方法
CN104880190A (zh) * 2015-06-02 2015-09-02 无锡北微传感科技有限公司 一种用于惯导姿态融合加速的智能芯片
CN104913777A (zh) * 2015-05-15 2015-09-16 上海集成电路研发中心有限公司 一种地磁传感器应用系统的误差补偿算法
CN104980214A (zh) * 2015-05-22 2015-10-14 哈尔滨工业大学 一种星间通信粗精扫描方法
CN105136142A (zh) * 2015-10-16 2015-12-09 北京机械设备研究所 一种基于微惯性传感器的室内定位方法
CN105509740A (zh) * 2015-12-31 2016-04-20 广州中海达卫星导航技术股份有限公司 一种农业机械车辆姿态测量方法及测量模块
CN105588567A (zh) * 2016-01-25 2016-05-18 北京航空航天大学 一种自动电子罗盘校准辅助式的航姿参考系统及方法
WO2016150312A1 (zh) * 2015-03-20 2016-09-29 阿里巴巴集团控股有限公司 一种地磁传感器校准方法、装置及智能设备
CN106468554A (zh) * 2016-09-29 2017-03-01 西北工业大学 一种非接触式的翻滚卫星的惯性参数的测算方法
CN106767776A (zh) * 2016-11-17 2017-05-31 上海兆芯集成电路有限公司 移动设备及求取移动设备姿态的方法
CN109874045A (zh) * 2019-01-30 2019-06-11 深圳岚锋创视网络科技有限公司 一种便携式终端及其获取陀螺仪数据进行视频处理的方法
CN110887480A (zh) * 2019-12-11 2020-03-17 中国空气动力研究与发展中心低速空气动力研究所 基于mems传感器的飞行姿态估计方法及系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020005297A1 (en) * 1999-09-24 2002-01-17 Vermeer Manufacturing Company Underground boring machine employing solid-state inertial navigation control system and method
CN102519450A (zh) * 2011-12-12 2012-06-27 东南大学 一种用于水下滑翔器的组合导航装置及方法
CN202974288U (zh) * 2012-12-05 2013-06-05 南京理工大学 一种微型捷联航姿系统

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020005297A1 (en) * 1999-09-24 2002-01-17 Vermeer Manufacturing Company Underground boring machine employing solid-state inertial navigation control system and method
CN102519450A (zh) * 2011-12-12 2012-06-27 东南大学 一种用于水下滑翔器的组合导航装置及方法
CN202974288U (zh) * 2012-12-05 2013-06-05 南京理工大学 一种微型捷联航姿系统

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
HARADA T等: "Portable orientation estimation device based on accelerometers, magnetometers and gyroscope sensors for sensor network", 《IEEE CONFERENCE ON MULTISENSOR FUSION AND INTEGRATION FOR INTELLIGENT SYSTEMS》 *
杨芬等: "智能传感器的CAN总线接口设计", 《单片机与嵌入式系统应用》 *
魏萍: "基于ARM的嵌入式航向姿态参考系统的研究", 《中国优秀硕士学位论文全文数据库》 *

Cited By (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103353304A (zh) * 2013-06-25 2013-10-16 深圳市宇恒互动科技开发有限公司 一种对三维惯性运动感测进行补偿的方法及装置
CN103353304B (zh) * 2013-06-25 2016-02-03 深圳市宇恒互动科技开发有限公司 一种对三维惯性运动感测进行补偿的方法及装置
CN104457748A (zh) * 2013-09-18 2015-03-25 南京理工大学 一种嵌入式瞄准吊舱测姿系统及其传递对准方法
CN103630137A (zh) * 2013-12-02 2014-03-12 东南大学 一种用于导航系统的姿态及航向角的校正方法
CN103630137B (zh) * 2013-12-02 2016-03-23 东南大学 一种用于导航系统的姿态及航向角的校正方法
CN103759730A (zh) * 2014-01-16 2014-04-30 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN103759730B (zh) * 2014-01-16 2016-06-29 南京师范大学 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法
CN103823209B (zh) * 2014-02-13 2016-04-13 中国科学院电子学研究所 用于轻小型合成孔径雷达系统中低成本运动误差测量装置
CN103823209A (zh) * 2014-02-13 2014-05-28 中国科学院电子学研究所 用于轻小型合成孔径雷达系统中低成本运动误差测量装置
CN103776451B (zh) * 2014-03-04 2016-11-09 哈尔滨工业大学 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
CN103776451A (zh) * 2014-03-04 2014-05-07 哈尔滨工业大学 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
CN103868512A (zh) * 2014-03-25 2014-06-18 西安电子科技大学 飞行器航向姿态高精度测试电路
CN103940442A (zh) * 2014-04-03 2014-07-23 深圳市宇恒互动科技开发有限公司 一种采用加速收敛算法的定位方法及装置
CN103940442B (zh) * 2014-04-03 2018-02-27 深圳市宇恒互动科技开发有限公司 一种采用加速收敛算法的定位方法及装置
CN104567931A (zh) * 2015-01-14 2015-04-29 华侨大学 一种室内惯性导航定位的航向漂移误差消除方法
CN104567931B (zh) * 2015-01-14 2017-04-05 华侨大学 一种室内惯性导航定位的航向漂移误差消除方法
WO2016150312A1 (zh) * 2015-03-20 2016-09-29 阿里巴巴集团控股有限公司 一种地磁传感器校准方法、装置及智能设备
CN104913777A (zh) * 2015-05-15 2015-09-16 上海集成电路研发中心有限公司 一种地磁传感器应用系统的误差补偿算法
CN104980214A (zh) * 2015-05-22 2015-10-14 哈尔滨工业大学 一种星间通信粗精扫描方法
CN104880190A (zh) * 2015-06-02 2015-09-02 无锡北微传感科技有限公司 一种用于惯导姿态融合加速的智能芯片
CN104880190B (zh) * 2015-06-02 2018-05-25 无锡北微传感科技有限公司 一种用于惯导姿态融合加速的智能芯片
CN105136142A (zh) * 2015-10-16 2015-12-09 北京机械设备研究所 一种基于微惯性传感器的室内定位方法
CN105509740A (zh) * 2015-12-31 2016-04-20 广州中海达卫星导航技术股份有限公司 一种农业机械车辆姿态测量方法及测量模块
CN105588567A (zh) * 2016-01-25 2016-05-18 北京航空航天大学 一种自动电子罗盘校准辅助式的航姿参考系统及方法
CN105588567B (zh) * 2016-01-25 2018-03-27 北京航空航天大学 一种自动电子罗盘校准辅助式的航姿参考系统及方法
CN106468554A (zh) * 2016-09-29 2017-03-01 西北工业大学 一种非接触式的翻滚卫星的惯性参数的测算方法
CN106767776A (zh) * 2016-11-17 2017-05-31 上海兆芯集成电路有限公司 移动设备及求取移动设备姿态的方法
CN109874045A (zh) * 2019-01-30 2019-06-11 深圳岚锋创视网络科技有限公司 一种便携式终端及其获取陀螺仪数据进行视频处理的方法
CN110887480A (zh) * 2019-12-11 2020-03-17 中国空气动力研究与发展中心低速空气动力研究所 基于mems传感器的飞行姿态估计方法及系统

Also Published As

Publication number Publication date
CN102980577B (zh) 2015-07-08

Similar Documents

Publication Publication Date Title
EP2909579B1 (en) Surveying system and method
Jekeli Inertial navigation systems with geodetic applications
Niu et al. Fast thermal calibration of low-grade inertial sensors and inertial measurement units
CN102879793B (zh) 超小型gps/ins/磁强计/气压计组合导航系统
CN104848859B (zh) 一种三轴惯性稳定平台及其自定位定向的控制方法
CN101319902B (zh) 一种低成本组合式定位定向装置及组合定位方法
Aggarwal MEMS-based integrated navigation
CN101801837B (zh) 具有mems惯性感测及内置数字电子元件的集成式移动处理单元(mpu)
JP3848941B2 (ja) 地磁界センサの姿勢誤差補償装置及び方法
CN106289246B (zh) 一种基于位置和姿态测量系统的柔性杆臂测量方法
CN103776451B (zh) 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
CN100504295C (zh) 移动电子三维罗盘
JP4782111B2 (ja) 輸送手段の位置、姿勢、および/または飛行方向を推定するシステムおよび方法
Syed et al. A new multi-position calibration method for MEMS inertial navigation systems
EP2557394B1 (en) System for processing pulse signals within an inertial navigation system
Parsa et al. Design and implementation of a mechatronic, all-accelerometer inertial measurement unit
CN102636149B (zh) 挠性体动态变形的组合测量装置及测量方法
Yuan et al. Error compensation of an optical gyro INS by multi-axis rotation
CN103196448B (zh) 一种机载分布式惯性测姿系统及其传递对准方法
CN103575299B (zh) 利用外观测信息的双轴旋转惯导系统对准及误差修正方法
CN101726295B (zh) 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法
CN100405014C (zh) 一种载体姿态测量方法
CN102289306B (zh) 姿态感知设备及其定位、鼠标指针的控制方法和装置
CN103323026B (zh) 星敏感器和有效载荷的姿态基准偏差估计与修正方法
CN1740746B (zh) 微小型动态载体姿态测量装置及其测量方法

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
C53 Correction of patent for invention or patent application
CB03 Change of inventor or designer information

Inventor after: Chen Shuai

Inventor after: Lei Haoran

Inventor after: Wang Yukun

Inventor after: Cheng Chen

Inventor after: Cha Xinyi

Inventor after: Deng Guijun

Inventor after: Zhang Li

Inventor after: Bao Yuming

Inventor after: Du Guoping

Inventor after: Zou Weijun

Inventor after: Wu Panlong

Inventor after: Li Xian

Inventor after: Gao Yuxia

Inventor after: Ji Jianjiao

Inventor after: Dan Tong

Inventor after: Zhu Yuankui

Inventor after: Qu Xinfen

Inventor after: Huang Siliang

Inventor after: Dong Liang

Inventor after: Yu Wei

Inventor after: Peng Shujun

Inventor after: Lu Shuai

Inventor after: Zhang Xiaoliang

Inventor before: Chen Shuai

Inventor before: Bao Yuming

Inventor before: Du Guoping

Inventor before: Zou Weijun

Inventor before: Wu Panlong

Inventor before: Gao Yuxia

Inventor before: Ji Jianjiao

Inventor before: Dan Tong

Inventor before: Zhu Yuankui

Inventor before: Li Xian

Inventor before: Zhang Xiaoliang

Inventor before: Lei Haoran

Inventor before: Wang Yukun

Inventor before: Cheng Chen

Inventor before: Cha Xinyi

Inventor before: Deng Guijun

Inventor before: Zhang Li

Inventor after: Chen Shuai

Inventor after: Lei Haoran

Inventor after: Wang Yukun

Inventor after: Cheng Chen

Inventor after: Cha Xinyi

Inventor after: Deng Guijun

Inventor after: Zhang Li

Inventor after: Bao Yuming

Inventor after: Du Guoping

Inventor after: Zou Weijun

Inventor after: Wu Panlong

Inventor after: Li Xian

Inventor after: Gao Yuxia

Inventor after: Ji Jianjiao

Inventor after: Dan Tong

Inventor after: Zhu Yuankui

Inventor after: Qu Xinfen

Inventor after: Huang Siliang

Inventor after: Dong Liang

Inventor after: Yu Wei

Inventor after: Peng Shujun

Inventor after: Lu Shuai

Inventor after: Zhang Xiaoliang

Inventor before: Chen Shuai

Inventor before: Bao Yuming

Inventor before: Du Guoping

Inventor before: Zou Weijun

Inventor before: Wu Panlong

Inventor before: Gao Yuxia

Inventor before: Ji Jianjiao

Inventor before: Dan Tong

Inventor before: Zhu Yuankui

Inventor before: Li Xian

Inventor before: Zhang Xiaoliang

Inventor before: Lei Haoran

Inventor before: Wang Yukun

Inventor before: Cheng Chen

Inventor before: Cha Xinyi

Inventor before: Deng Guijun

Inventor before: Zhang Li

COR Change of bibliographic data

Free format text: CORRECT: INVENTOR; FROM: CHEN SHUAI LI XIAN ZHANG XIAOLIANG LEI HAORAN WANG YUKUN CHENG CHEN CHA XINYI DENG GUIJUN ZHANG LI BAO YUMING DU GUOPING ZOU WEIJUN WU PANLONG GAO YUXIA JI JIANJIAO DAN TONG ZHU YUANKUI TO: CHEN SHUAI LI XIAN QU XINFEN HUANG SILIANG DONG LIANG YU WEI PENG SHUJUN LU SHUAI ZHANG XIAOLIANG LEI HAORAN WANG YUKUN CHENG CHEN CHA XINYI DENG GUIJUN ZHANG LI BAO YUMING DU GUOPING ZOU WEIJUN WU PANLONG GAO YUXIA JI JIANJIAO DAN TONG ZHU YUANKUI

C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150708

Termination date: 20181205