CN103759730A - 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 - Google Patents

一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 Download PDF

Info

Publication number
CN103759730A
CN103759730A CN201410020089.8A CN201410020089A CN103759730A CN 103759730 A CN103759730 A CN 103759730A CN 201410020089 A CN201410020089 A CN 201410020089A CN 103759730 A CN103759730 A CN 103759730A
Authority
CN
China
Prior art keywords
navigation
error
pedestrian
intelligent mobile
mobile carrier
Prior art date
Application number
CN201410020089.8A
Other languages
English (en)
Other versions
CN103759730B (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 CN201410020089.8A priority Critical patent/CN103759730B/zh
Publication of CN103759730A publication Critical patent/CN103759730A/zh
Application granted granted Critical
Publication of CN103759730B publication Critical patent/CN103759730B/zh

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • G01C21/08Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Abstract

本发明公开了一种基于导航信息双向融合的行人与智能移动载体协同导航系统及其导航方法,属于惯性与组合导航领域。该系统由安装于人体的行人导航系统与智能移动载体上安装的惯性导航系统组成,在系统进入存在信号屏蔽或电磁干扰的未知环境时,构建信息双向融合滤波器同步修正两套系统的导航信息误差,即利用智能移动载体惯性导航系统中较高的传感器精度完成行人导航系统磁航向误差的实时补偿,同时利用行人导航系统较高的位移精度修正智能移动载体惯性导航系统误差,实现同步提高两套导航系统的定位性能。本方法改进了环境存在信号屏蔽或电磁干扰的情况下行人导航与移动载体导航系统的定位方法,有助于全面提高人机一体化智能系统的综合性能。

Description

一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法

技术领域

[0001] 本发明涉及一种基于人体与智能移动载体构建的人机一体化智能导航系统及其导航方法,属于惯性与组合导航的技术领域。

背景技术

[0002] 人机一体化智能系统(简称人机智能系统)是一类人与智能机器共同感知、共同认知、共同决策,实现人与智能机器在决策层面上进行融合,产生更高行动效率的智能系统,该系统在军事行动、工程作业、残疾人行动辅助等领域具有很高的应用价值。人机智能系统中各类信息的交互融合是建立人机耦合协同作业机制的重要前提。利用行人导航系统与智能移动载体可构建人机一体化智能导航系统,该系统由安装于人体的行人导航系统与智能移动载体上安装的惯性导航系统组成,可实现复杂电磁环境中的导航定位任务。

[0003] 一体化智能导航系统所涉及的行人导航技术是导航定位技术中的一个重要分支,近年来随着应用环境的不断拓展,行人导航定位技术的性能与环境适应性被提出了新的要求。目前,较为成熟的行人导航定位方案多数是基于卫星导航系统实现定位功能,例如,美国、英国、法国为等多个军事发达国家所实施“陆地勇士”、“FIST”、“FELIN”等多种高技术士兵装备计划中,均以卫星导航系统为作战士兵提供定位信息。美国Draper实验室在本世纪初提出并设计了基于微机电惯性测量组件的个人导航定位方案,并研究了行进中的零速修正与静止状态下的零姿态修正方法,实时修正惯性导航系统与微惯性传感器的误差;瑞士 Vectronix公司的研究部门研制的个人导航系统将磁传感器与MEMS陀螺仪相结合,以克服环境中的磁场干扰对航向信息的影响,并采用高精度计步器探测人体的运动状态与加速度,通过优化后的多传感器信息融合算法来实现个人导航。在国内,南京航空航天大学导航研究中心与香港理工大学等研究机构研究了以视觉障碍者紧急避障、个人定位、语音导航等服务为应用背景、结合MEMS惯性技术的行人导航方法。

[0004] 一体化智能导航系统所涉及的智能移动载体则是一类安装了具有特定功能载荷的移动载体,可通过实时控制或自主的形式实现按一定要求运动,并对环境进行信息与态势感知的智能化系统,例如智能移动机器人、智能车辆等。智能移动载体的有关研究是机器人领域里的一个重要方向,由于其应用的广泛性与功能的重要性,近年来受到该领域国内外学者的深入探讨与研究。针对智能移动载体的导航技术的研究,也成为了智能移动载体研究的热点之一:1)微小型无人飞行器正在被国内外研究机构广泛研究,微小型飞行器的使用场合多在室内等信号遮蔽的环境下,因此视觉导航是广泛应用于这类特定环境下的导航手段。目前,英国牛津大学,美国斯坦福大学,西班牙马德里理工大学等知名高校都在着力研究基于视觉信息的无人飞行器导航定位、定姿技术;2)基于移动机器人的导航技术近些年也被广泛重视,移动机器人大致分为两类,一类按照固定轨迹或者路标点运动,这一类机器人使用路标点实现实时的导航和控制,典型的如清华大学的THMR-1II等。另一类不受固定轨迹约束,根据自身对环境的感知进行路径规划并实施任务,例如,卡内基梅隆大学的机器人Xavier,采用视觉组合测距传感器,利用扩展卡尔曼滤波方式进行导航决策;3)随着现代交通事业的发展,智能车辆的概念逐渐进入人们的视野,国外对于智能汽车的研究起步较早且目前已初见成效,德国联邦国防大学与奔驰公司共同开发的智能汽车VaMoRs,该汽车使用四台CCD相机实时捕捉道路情况并使用卡尔曼滤波器拟合,一般路况条件下的智能汽车可以达到完全自主的状态,国内清华大学等高校与研究机构采用差分GPS、磁罗盘等传感器形成组合定位导航系统,此外还配置有激光测距仪,视觉传感器等设备感知周围环境。

发明内容

[0005] 为了提高一体化智能导航系统的综合定位性能与可靠性,本发明提供了一种人机一体化智能导航系统,包括行人导航系统和智能移动载体(涵盖上述各类载体)导航系统。其中智能移动载体导航系统采用中高精度捷联惯性导航系统,在进入存在信号屏蔽或电磁干扰的未知环境时,如果单独采用惯性系统将无法满足人机智能系统的导航定位性能需求。针对该问题,本发明又提出了一种基于行人导航系统与智能移动载体惯性导航系统的信息双向融合协同导航方法。该方法利用两种导航系统不同的误差特性,构建信息双向融合滤波器,同步修正两者的导航信息误差,即利用智能移动载体的中高精度捷联惯导系统中较高的传感器精度完成对行人导航系统磁航向误差的实时修正,同时利用行人导航系统较高的单步位移精度修正机器人捷联惯导系统的误差,从而实现同步提高两类载体导航系统的定位与航向精度。

[0006] 本发明的导航系统采用的技术方案如下:

[0007] —种基于导航信息双向融合的行人与智能移动载体的协同导航系统,包括行人导航系统与智能移动载体;其中,所述行人导航系统采用足部微惯性导航系统,安装于人体上;所述智能移动载体(如移动机器人、智能车等)中安装有高精度捷联惯性导航系统;所述行人导航系统与智能移动载体的导航系统之间通过无线通讯方式进行数据交换。

[0008] 本发明提供的导航方法,包括如下步骤:

[0009] 行人导航系统经干净磁环境中磁传感器误差标定与补偿后进行导航系统初始对准,系统进入导航工作状态,通过人体步态相位检测对导航系统进行间断性的零速修正,估计导航系统级误差以及陀螺仪与加速度计的部分漂移误差,利用智能移动载体的中高精度惯导系统中较高的传感器精度完成行人导航系统磁航向误差的实时补偿;智能移动载体的捷联惯性导航系统采用行人导航系统零速修正后的位置信息来实时修正捷联惯性导航系统误差与惯性传感器误差,从而构成行人与智能移动载体的协同导航,具体步骤如下:

[0010] (I)行人导航系统与传感器误差建模与修正:行人导航系统与传感器误差在初始对准与零速修正中得到修正,采用捷联惯性导航系统的线性误差模型,同时采用最优估计理论与滤波方法完成对准与零速修正;行人导航系统误差模型包括平台误差角模型、速度误差模型、定位误差以及惯性传感器误差模型,经粗对准后MEMS惯性传感器的误差分别近似为随机常值与白噪声的结合以及导航过程中的惯性器件随机常值误差模型;在足部运动过程中,采用智能移动载体的捷联惯性导航系统提供的航向误差为观测量构建观测方程,即采用航向匹配的方法完成行人导航系统的误差估计与补偿;

[0011] (2)智能移动载体的捷联惯性导航系统的误差建模与修正:建立系统误差模型,并采用随机常值、一阶马尔科夫过程以及白噪声相结合的惯性器件误差模型,行人导航系统的零速修正使其误差积累速度由时间的三次函数转变随位移的线性函数,行进速度无突变情况下基于零速修正的行人导航系统误差特性近似为随时间的线性函数;将行人导航系统的位置信息作为观测量,通过观测量扩充法实现基于最优估计理论的系统误差估计与修正。

[0012] 若对环境中某一位置地磁场与其他磁场源所产生的磁场进行辨识与分离,则可有效修正由环境干扰源所导致的磁航向误差。通过分析磁场矢量在水平面上的投影可进行磁场的辨识方法的研究,求得该地理位置上的磁航向角修正值。由于磁航向角修正值与载体的姿态无关,只与载体位置与磁场干扰源的相对位置有关,可通过该特性实现高精度惯性系统对低精度惯性系统的航向修正。基于上述理论分析,利用人机一体化智能系统中智能移动载体中的惯性导航系统含有的较高精度的传感器实时修正行人导航系统的磁航向误差,其具体步骤如下:

[0013] (I)在磁场环境纯净的区域,对与智能移动载体的捷联惯性导航系统中的惯性传感器同轴安装且经过标定的中高精度三轴磁传感器组件进行硬、软磁误差补偿,补偿方法采用基于椭圆约束的多位置最小二乘拟合方法,采用捷联惯性导航系统来测量机器人水平姿态,从而结合磁传感器的输出解算磁航向,并利用当地地理位置信息修正磁偏角;

[0014] (2)行人与智能移动载体同步进入电磁干扰环境中,利用智能移动载体中高精度捷联惯导系统输出的航向角为航向基准Θ 并以其磁传感器输出与水平姿态数据解算0h,从而求解Λ Θ,并将该值实时通过数据通讯传递给行人导航系统,实现行人导航系统的航向修正。

[0015] 本发明与现有技术相比,具有如下显著优点:

[0016] (I)本发明利用行人导航系统与智能移动载体导航系统中两种不同的系统误差特性,采用信息双向融合协同导航方法,构建信息双向融合的系统结构,同步修正两个导航系统的信息误差。

[0017] (2)本发明利用智能移动载体捷联惯导系统中较高的传感器精度完成行人导航系统磁航向误差的实时补偿,提高行人导航系统的航向精度。

[0018] (3)本发明采用行人导航系统零速修正后的位置信息来实时修正捷联惯导系统误差与惯性传感器误差,从而提高智能移动载体的导航定位性能。

附图说明

[0019] 图1环境存在信号屏蔽与电磁干扰情况下的信息双向融合协同导航系统原理图;

[0020] 图2未知环境中磁传感器所敏感的磁矢量示意图;

[0021] 图3地磁场与环境磁源产生磁场的水平分量不意图。

具体实施方式

[0022] 本发明内容所涉及的人机一体化智能导航系统,由安装于人体的行人导航系统与智能移动载体上安装的导航系统组成,行人与智能移动载体同步行进,行人导航系统与智能移动载体的导航系统之间通过蓝牙、UffB等无线通讯方式进行数据交换。在具体的工程实施过程中,行人导航系统可采用足部微惯性/卫星组合导航系统,而智能移动载体导航系统可采用中高精度捷联惯性/卫星组合导航系统,从而提高系统的综合定位性能与可靠性。在卫星导航系统可用的环境中,两者的导航系统可独立工作,但在进入存在电磁干扰或信号屏蔽的未知环境时,卫星导航系统与磁航向计将会受到严重影响甚至失效,单独采用惯性系统将无法满足人机智能系统的导航定位性能需求。因此,提出一种基于行人导航系统与智能移动载体惯性导航系统的信息双向融合协同导航方法,实现同步提高两类载体导航系统的定位与航向精度。

[0023] 信息双向融合协同导航方法由采集IMU信号、陀螺仪与加速度计的随机误差建模与校正、惯性导航系统初始对准、捷联惯性导航解算、惯性导航系统零速修正、磁航向误差实时补偿、信息双向融合方法七部分组成。信息双向融合协同导航方法中,首先是行人导航系统采用基于微惯性/地磁测量组件足部安装的行人导航定位方案,经干净磁环境中磁传感器误差标定与补偿后进行导航系统初始对准,系统进入导航工作状态;通过人体步态相位检测对导航系统进行间断性的零速修正(Zero Velocity Update,简称ZUPT),估计导航系统级误差以及陀螺仪与加速度计的部分漂移误差;基于磁航向误差实时补偿方法提高行人导航系统的航向精度。同时,智能移动载体导航系统由于工作于捷联惯性模式,其精度随时间降低。为保持智能移动载体捷联惯 导系统航向信息的高精度,采用行人导航系统零速修正后的位置信息来实时修正捷联惯导系统误差与惯性传感器误差,从而构成行人与智能移动载体的协同导航。信息双向融合协同导航方法流程如图1所示,为了完成个人导航系统和智能移动载体导航系统的测速、定姿、定位以及信息双向融合协同导航,需要完成的步骤如以下实例所示:

[0024] 4.1MU信号采集步骤

[0025] 该步骤同步应用于行人导航系统和智能移动载体导航系统。采集个人导航系统和智能移动载体导航系统的IMU (惯性测量组件)中陀螺与加速度计的输出信号,得到惯导系统的角速度和比力,并将信号通过安装于足部与躯干的通讯模块传输给微型导航计算机。

[0026] 4.2惯性器件的随机误差的建模与校正步骤

[0027] 该步骤同步应用于行人导航系统和智能移动载体导航系统。在两者微型导航计算机中对上一步采集的陀螺仪与加速度计数据并分别建立相应的信息误差模型,实时估计陀螺仪与加速度计的理论输出,并将理论输出估计值作为初始对准步骤、捷联惯性导航步骤、零速修正步骤以及组合导航步骤等的数据源。在陀螺仪与加速度计的零位偏置随时间变化较明显的情况下,首先需对零位偏置的特性进行统计分析,分别建立符合陀螺仪与加速度计的多阶多项式零位偏置趋势项,如某型MEMS陀螺仪零偏趋势项适用模型为四阶多项式模型,某型MEMS加速度计零偏趋势项适用模型为二阶多项式模型,其形式分别如公式(I)与⑵所示:

[0028] fl (t) =a1t4+b1t3+c1t2+d1t+e1 (1)

[0029] f2 (t) =c2t2+d2t+e2 (2)

[0030] 式中,f\(t)与f2(t)分别为陀螺仪与加速度计零偏的趋势项,t为时间,apbpq、C^e1分别为四阶多项式模型的各阶参数,c2、d2、e2分别为二阶多项式模型的各阶参数。确定陀螺仪与加速度计的零偏趋势项模型后,在MEMS陀螺仪与MEMS加速度计的信号输出端加入零偏趋势项校正,对数据的零偏趋势项进行实时校正。

[0031] 对校正趋势项后的陀螺仪与加速度计分别建立求和自回归滑动平均模型即ARIMA模型,如某型MEMS陀螺仪随机误差的适用模型为ARMA (2,I)模型,其中2为自回归模型阶数,I为滑动平均模型阶数,其模型结构如公式(3)所示:

[0032] xt- φ JXt-J+ Φ 2xt-2+ ε t_ 9 I ε t-1 (3)

[0033] 式中Xt为t时刻的信号,ε t为t时刻噪声,Φρ Φ2为自回归模型参数,Θ I为滑动平均模型参数。如某型MEMS加速度计随机误差的适用模型为AR⑴模型,其中2为自回归模型阶数,其模型结构如公式所示:

[0034] yt= ζ Jh+ τ t (4)

[0035] 式中yt为t时刻的信号,Tt为七时刻噪声,ζ I为自回归模型参数。将经过零偏趋势项建模与校正步骤后的陀螺仪与加速度计输出作为观测量,将陀螺仪与加速度计的理想输出估计值作为状态量,建立基于ARIMA模型的卡尔曼滤波器,分别实时估计陀螺仪与加速度计的理想输出,卡尔曼滤波的状态方程如公式(5)所示:

[0036] Xk=AX1^BVk (5)其中Xk -[.Vi,,为相邻两个时刻的惯性传感器(如MEMS陀螺仪或MEMS加速度计等)的输出,VkKabaH]'为相邻两个时刻的系统过程噪声,

Figure CN103759730AD00071

为离散系统的状态转移矩阵,

Figure CN103759730AD00072

为系统过程噪声系数矩阵,卡尔曼滤

波的量测方程如公式(6)所示:

[0037] Zk=HXk+ffk (6)

[0038] 将惯性传感器的理论输出估计值作为初始对准步骤、捷联惯性导航步骤、零速修正步骤以及组合导航步骤的数据源。

[0039] 4.3惯性系统初始对准步骤

[0040] 该步骤同步应用于行人导航系统和智能移动载体导航系统。惯性导航系统初始对准步骤:该步骤在微型导航计算机中进行,系统启动后在静态条件下,利用步骤4.2中加速度计的理论输出估计值,在微型导航计算机中通过水平自对准得到MU初始横滚角与俯仰角,并将磁强计的信号输出通过通讯模块传送至微型导航计算机以得到IMU的初始航向角,水平自对准的公式为:

Figure CN103759730AD00073

[0043] 其中Θ为俯仰角,Y为横滚角,g为重力加速度广与广分别为加速度计理论输

出估计值在载体坐标系中投影的X与I轴分量;

[0044] 4.4捷联惯性导航解算步骤

[0045] 该步骤同步应用于行人导航系统和智能移动载体导航系统。惯性导航系统的捷联惯性导航解算步骤分为姿态解算与速度、位置解算。

[0046] (I)姿态解算

[0047] 捷联惯性导航系统的姿态解算有欧拉角法、方向余弦法和四元数法。由于四元数法具有可以全姿态工作、计算工作量小等特点,故本方法采用该方法进行姿态解算。四元数法解算姿态主要有以下几个步骤:[0048] 1)载体相对导航坐标系角速残ω的计算

[0049]

Figure CN103759730AD00081

[0050] 其中ωbib为MEMS陀螺仪输出的理论估计值,ωbin可通过行进速度在导航坐标系中

的投影、地球自转角速度ωic以及上个周期的姿态转移矩阵Cbn求得。

[0051] 2)四元数微分方程的求解

[0052] 四元数微分方程的离散化形式,即四元数迭代计算公式如下:

Figure CN103759730AD00082

[0054] 上式中

Figure CN103759730AD00083

为规范化后的四兀数,其中

i、j、k为相互正交的单位矢量,ί为四元数算法计算的单位时间间隔;

Figure CN103759730AD00084

分别为在一次姿态解算周期内对 MEMS 陀螺仪输出角速度的3次采样值,即采用3子样采样方法补偿陀螺非定轴转动时角速度矢量积分产生的计算误差,MEMS陀螺仪采样周期为h。

[0055] [0056]

Figure CN103759730AD00085

[0057] 上式中口表示向量的矩阵扩展,

Figure CN103759730AD00086

[0058] 3)四元数规范化

[0059] 姿态解算中计算误差的存在使得计算的变换四元数的范数不再等于1,即计算的四元数失去规范性,因此对计算的四元数必须周期性地进行规范化处理。设

q =qo+q1 i + q2 j + q3 k为直接由四元数微分方程计算得到的四元数,而设规范化后的四

7Ώ数为q = q0+ q1 i + q2 j + q3 k,其中i、j、k ,为相互正交的单位矢量,利用最小二乘判

据可以求得最优规范化的变换四元数。计算公式如下:

[0060]

Figure CN103759730AD00087

[0061] 4)由四元数计算姿态转移矩阵勺

[0062] 依据四元数表示的固定矢量之间的变换关系,可以获得四元数与方向余弦矩阵的关系为:

Figure CN103759730AD00091

[0064] 5)由姿态转移矩阵勺提取姿态角

Figure CN103759730AD00092

[0066] 其中θ、Y、φ分别为捷联惯导系统的俯仰角、横滚角以及航向角,

C,U、C,12、C,13、C,21、C,22、C,23、C,31、C,32 > c’ 33 分别为姿态转移矩阵对应行

列位置的各元素,即C1/ =Cos Y cos Φ +sin Y sin Θ sin Φ、C12’ =cos Θ sin Φ、

Figure CN103759730AD00093

[0067] (2)速度、位置解算

[0068] 捷联惯性导航速度解算中,由于加速度计固连在MEMS惯性测量组件上,它的输出是载体相对于惯性空间的比力在载体坐标系中的投影,因此需要把加速度计原始输出Jt通过姿态转移矩阵C转换到导航坐标系中,记力/6即

Figure CN103759730AD00094

[0070] 从而可以解算出载体在地理系中的速度,其微分方程为:

Figure CN103759730AD00095

[0072] 式中fn SMEMS加速度计理论输出估计值在导航坐标系中的投影,<为地球自转角速度在导航坐标系中的投! 为导航坐标系相对于地球坐标系的角速度在导航坐标系中的投影,可通过行进中的速度在导航坐标系中的投影求得。将上式移项并展开得:

Figure CN103759730AD00096

[0074] 式中,//、/;> /;分别是K在东向、北向和地向的投影分量,Ve、Vn、Vd*别是东

向、北向和地向的速度分量,λ、L分别为当地的经度与纬度,g为当地重力加速度。

[0075] 利用Ve, \、Vd并结合上个时刻载体的纬度、经度、高度与速度,求解当前时刻导航

坐标系相对于惯性坐标系的角速度在导航坐标系中的投,、以及当前时刻载体的纬度

L、经度λ、高度h,完成整个MEMS捷联惯性导航的算法流程。

[0076] 4.5惯性导航系统零速修正步骤

[0077] 该步骤同步应用于该步骤应用于行人导航系统和智能移动载体导航系统。该步骤在行人导航系统的微型导航计算机中进行,求解MEMS加速度计输出经步骤4.2误差建模与校正后的估计值的三轴矢量和,通过判断该值是否接近重力来检测人体足部是否处于着地时间段,并利用着地时间段MEMS IMU相对地面静止的特点进行间断式的零速修正,即根据惯性导航系统误差与惯性器件误差特性误差建立状态方程:

[0078]

Figure CN103759730AD00101

[0079]式中,误差状态量

Figure CN103759730AD00102

其中 δ VN、δ Ve

为水平速度误差沿北、东方向的分量,ΦΝ、ΦΕ、ΦΒ为平台误差角在北、东、地方向的分量;V,、Vji分别为加速度计的常值零偏在载体坐标系中x、y方向的分量;ε χ、ε y、ε Z分别为

陀螺零位常值漂移在载体坐标系中X、1、Z方向的分量;状态转移矩阵

Figure CN103759730AD00103

,其

Figure CN103759730AD00104

,QD,ΩΝ为地球自转角速度

在地向与北向的分量,Cu’~C33’分别为惯性导航系统姿态转移矩阵中的对应行列位置上的各元素,定义同上;g为当地重力加速度w=[w1w2w3w4w5]式中WpW2为等效北向、东向的加速度计输出白噪声分量,W3、W4、W5为等效北向、东向、地向的陀螺仪输出白噪声分量。以足部着地点MEMS惯性导航系统的水平速度输出作为观测量,建立系统的观测方程:

Figure CN103759730AD00105

[0081] 式中,δνΝ、δ Ve分别为水平速度误差沿北、东方向的分量,X定义同上;V为观测噪声矢量。运用最优滤波方法实时估计MEMS惯性导航系统的初始平台误差角,MEMS陀螺仪随机常值误差,以及MEMS加速度计随机常值误差,并以反馈校正的方式提高惯性导航系统的水平姿态精度与惯性器件精度。

[0082] 4.6捷联惯性导航系统/卫星导航系统组合导航步骤

[0083] 该步骤同步应用于行人导航系统与智能移动载体导航系统。分布构建行人导航系统与智能移动载体导航系统的捷联惯性/卫星组合导航系统,将捷联惯性导航系统与卫星导航系统构建组合导航子系统,根据惯性导航系统误差方程与惯性器件误差特性建立状态方程:

Figure CN103759730AD00111

为系统状态量,分别代表惯性导航系统的3维平台误差角(其中航向误差角已经磁强计修正)、3维速度误差、3维位置误差、陀螺的3轴随机常值和3轴一阶马尔可夫误差以及加速度计的3轴一阶马尔可夫误差,共18阶。

[0087] ff=[wgx Wgy Wgz Wbx Wby Wbz Wax Way waz]T 为系统的白噪声矢量;

[0088]

Figure CN103759730AD00112

[0089] 其中I3x3表示3阶单位矩阵,Omxn表示mXn阶的O矩阵(下同),Fn表示对应平台误差角、速度误差、位置误差9个基本导航参数误差的系数矩阵,其非零元素为

[0090]

Figure CN103759730AD00113
Figure CN103759730AD00121

[0113] 其中wie为地球自转角速率,L为载体所在纬度,Re为地球赤道平面半径,Rm为地球子午圈半径,Rn为地球卯酉圈半径,VN、VE、VU为载体北向、东向和天向速度,fN>fE>fu分别为北向、东向和天向的比力,Fs和Fm分别为:

[0114]

Figure CN103759730AD00122

[0116] 其中ΤΜ、Try, Trz分别为陀螺仪一阶马尔科夫过程误差的相关时间,Tax, Tay, Taz分别为加速度计一阶马尔科夫过程误差的相关时间,以惯性导航系统与卫星导航系统所输出的位置、速度信息之间的差值为量测量建立量测方程,位置差值的观测方程分别为:

[0117]

Figure CN103759730AD00131

式中:Zp(t)表示位置差值,

Figure CN103759730AD00132

为量测噪声,可视为白噪声,

其方差分别为σ;\ > °ih。

[0118] 速度差值的观测方程为

[0119]

Figure CN103759730AD00133

[0120]式中:

Figure CN103759730AD00134

为量测噪声,

可视为白噪声,其方差分别为^4,σ2νΝ, σ2νΙι。

[0121] 采用线性卡尔曼滤波等最优估计理论与方法实时估计惯性导航系统与惯性器件的误差。

[0122] 4.7基于智能移动载体中高精度惯性系统的行人导航系统磁航向误差实时补偿步骤

[0123] 磁航向误差修正基本原理如下:地球磁场在空间中构成一个三维磁矢量,基于对该磁矢量进行检测与分解,即可求得运动载体当前的磁航向信息。然而,实际应用中磁传感器所测量的信号,是地磁场与环境干扰磁场源所共同形成的磁场。由于环境中干扰磁场源的位置、数量、类型等往往无法确定,且随着载体的移动呈现不可预测的特点,因此对各类干扰源产生的磁场进行建模与分析是十分复杂的,但若可对环境中某一位置地磁场与其他磁场源所产生的磁场进行辨识与分离,则可有效修正由环境干扰源所导致的磁航向误差。

[0124] 磁航向的常规解算方法是将与载体固联的磁传感器检测的地磁场矢量投影在水平面上,通过水平分量之间的三角函数关系求解载体磁航向。因此,通过分析磁场矢量在水平面上的投影可进行磁场的辨识方法的研究。未知环境中的磁场分布示意图如图2所示。图中mage表示地磁场矢量在水平面上的投影,magd表示环境干扰磁场源所产生的磁场矢量和在水平面上的投影,magh表示环境中某位置总磁场矢量的水平分量,即mage与magd的矢量和O

[0125] 忽略地磁场异常等现象且暂时忽略磁偏角,在某地域内的地磁场矢量可视为已知常量,表不为mage,并将磁偏角表不为Θ e ;在存在磁场干扰的环境中,将磁传感器所测量的环境中总磁场矢量表示为magh,类似地将带有误差的磁偏角表示为Θ h。

[0126] 设三轴磁传感器测量的地磁场mage在载体坐标系下的投影为,而测量总磁场矢量magh在载体坐标系下的投影为maS,其中

[0127] maSe = maSey Hiag 二 Oiaghy

_magez」 [maghz_

[0128] 若已知与磁传感器固联载体的横滚角与俯仰角分别为Y与Θ,则可将nmg:投影到水平面与垂直的方向上。

Figure CN103759730AD00141

[0131] 通过相同方法也可以求得ed

Figure CN103759730AD00142

[0134] 因此即可求得该地理位置上的磁航向角修正值Λ Θ = Θ d- Θ e。由rnig tjm,g [勿理含义可知,△ Θ与载体的姿态无关,只与载体位置与磁场干扰源的相对位置有关。因此,可通过该特性实现高精度惯性系统对低精度惯性系统的航向修正。

[0135] 基于上述分析的磁航向角修正值,利用人机一体化智能系统中智能移动载体惯性导航系统中较高精度的传感器实时修正行人导航系统的磁航向误差。具体实现步骤如下:

[0136] (I)在磁场环境纯净的区域,将与捷联惯性传感器同轴安装且经过标定的中高精度三轴磁传感器搭载于智能移动载体上进行硬、软磁误差补偿,补偿方法采用基于椭圆约束的多位置最小二乘拟合方法,采用捷联惯导系统来测量机器人水平姿态,从而结合磁传感器的输出解算磁航向,并利用当地地理位置信息修正磁偏角;

[0137] (2)行人与智能移动载体同步进入电磁干扰环境中,利用机器人中高精度捷联惯导系统输出的航向角为航向基准Θ 并以其磁传感器输出与水平姿态数据解算0h,从而求解Λ Θ,并将该值实时通过数据通讯传递给行人导航系统,实现行人导航系统的航向修正。

[0138] 4.8行人导航系统与智能移动载体导航系统的信息双向融合协同导航步骤

[0139] 根据步骤4.7中所计算磁航向误差实时补偿方法提高行人导航系统的航向精度。同时,采用行人导航系统零速修正后的位置信息来实时修正捷联惯导系统误差与惯性传感器误差,从而构成行人与智能移动载体的协同导航。该步骤实现如下:

[0140] (I)行人导航系统与传感器误差建模与修正

[0141] 行人导航系统与传感器误差可在初始对准与零速修正中得到修正。由于初始对准时间较短,而零速修正采用闭环校正的方式,系统与惯性传感器误差积累均为小量,因此可采用捷联惯性导航系统的线性误差模型,同时采用线性卡尔曼滤波完成对准与零速修正。行人导航系统误差模型由平台误差角模型、速度误差模型、定位误差以及惯性传感器误差

模型组成。其中平台误差角方程为:

[0142]

Figure CN103759730AD00151

[0143] 速度误差模型如下:

[0144]

Figure CN103759730AD00152

[0145] 定位误差模型为:

[0146]

Figure CN103759730AD00153

[0147] 经粗对准后MEMS惯性传感器的误差可分别近似为随机常值与白噪声的结合,导航过程中的惯性器件随机常值误差模型。

[0148] 在足部运动过程中,采用智能移动载体导航系统提供的航向误差为观测量构建观测方程,即采用航向匹配的方法完成行人导航系统的误差估计与补偿。由于捷联惯性系统姿态、航向误差与平台误差角之间存在如下转换关系:

[0149]

Figure CN103759730AD00154

[0150] 航向误差作为观测量本质上是对平台误差角的直接观测,人体足部周期性运动情况下航向误差对于速度误差与位置误差也存在一定的间接观测性。在足部着地的过程中,采用航向与速度同时匹配的观测方程。

[0151] (2)智能移动载体惯性导航系统的误差建模与修正

[0152] 为智能移动载体定位精度需求,通常安装中高精度的光纤MU构成捷联系统,该系统误差模型同样采用公式(28)- (30),并采用随机常值、一阶马尔科夫过程以及白噪声相结合的惯性器件误差模型。

[0153] 行人导航系统的零速修正使其误差积累速度由时间的三次函数转变随位移的线性函数,且人体行走过程中虽然步长不断变化,但总试图维持比较平稳的步速,因此在行进速度不突变情况下基于零速修正的行人导航系统误差特性也可近似为随时间的线性函数。将行人导航系统的位置信息作为观测量,通过观测量扩充法实现基于抗差滤波的系统误差估计与修正,此时系统方程中将增加如下3阶方程组:[0154]

Figure CN103759730AD00161

[0155] 即状态方程扩展为18阶。观测方程的形式如下:[0156] Z=HX+V (33)

[0157] 其中观测系数矩阵H扩展为3X21阶矩阵,其中H(16,I) =H(17,2) =H(18,3) =_1。

Claims (3)

1.一种基于导航信息双向融合的行人与智能移动载体的协同导航系统,其特征在于,该系统包括行人导航系统与智能移动载体;其中,所述行人导航系统采用足部微惯性导航系统,安装于人体上;所述智能移动载体中安装有高精度捷联惯性导航系统;所述行人导航系统与智能移动载体的导航系统之间通过无线通讯方式进行数据交换。
2.利用如权利要求1所述协同导航系统的导航方法,其特征在于,包括如下步骤:行人导航系统经干净磁环境中磁传感器误差标定与补偿后进行导航系统初始对准,系统进入导航工作状态,通过人体步态相位检测对导航系统进行间断性的零速修正,估计导航系统级误差以及陀螺仪与加速度计的部分漂移误差,利用智能移动载体的中高精度惯导系统中较高的传感器精度完成行人导航系统磁航向误差的实时补偿;智能移动载体的捷联惯性导航系统采用行人导航系统零速修正后的位置信息来实时修正捷联惯性导航系统误差与惯性传感器误差,从而构成行人与智能移动载体的协同导航,具体步骤如下: (1)行人导航系统与传感器误差建模与修正:行人导航系统与传感器误差在初始对准与零速修正中得到修正,采用捷联惯性导航系统的线性误差模型,同时采用最优估计理论与滤波方法完成对准与零速修正;行人导航系统误差模型包括平台误差角模型、速度误差模型、定位误差以及惯性传感器误差模型,经粗对准后MEMS惯性传感器的误差分别近似为随机常值与白噪声的结合以及导航过程中的惯性器件随机常值误差模型;在足部运动过程中,采用智能移动载体的捷联惯性导航系统提供的航向误差为观测量构建观测方程,即采用航向匹配的方法完成行人导航系统的误差估计与补偿; (2)智能移动载体的捷联惯性导航系统的误差建模与修正:建立系统误差模型,并采用随机常值、一阶马尔科夫过程以及白噪声相结合的惯性器件误差模型,行人导航系统的零速修正使其误差积累速度由时间的三次函数转变随位移的线性函数,行进速度无突变情况下基于零速修正的行人导航系统误差特性近似为随时间的线性函数;将行人导航系统的位置信息作为观测量,通过观测量扩充法实现基于最优估计理论的系统误差估计与修正。
3.根据权利要求2所述的导航方法,其特征在于,所述利用智能移动载体的中高精度惯导系统中较高的传感器精度完成行人导航系统磁航向误差的实时补偿的具体步骤如下: (1)在磁场环境纯净的区域,对与智能移动载体的捷联惯性导航系统中的惯性传感器同轴安装且经过标定的中高精度三轴磁传感器组件进行硬、软磁误差补偿,补偿方法采用基于椭圆约束的多位置最小二乘拟合方法,采用捷联惯性导航系统来测量机器人水平姿态,从而结合磁传感器的输出解算磁航向,并利用当地地理位置信息修正磁偏角; (2)行人与智能移动载体同步进入电磁干扰环境中,利用智能移动载体中高精度捷联惯导系统输出的航向角为航向基准Θ 并以其磁传感器输出与水平姿态数据解算0h,从而求解Λ Θ,并将该值实时通过数据通讯传递给行人导航系统,实现行人导航系统的航向修正。
CN201410020089.8A 2014-01-16 2014-01-16 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 CN103759730B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410020089.8A CN103759730B (zh) 2014-01-16 2014-01-16 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410020089.8A CN103759730B (zh) 2014-01-16 2014-01-16 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法

Publications (2)

Publication Number Publication Date
CN103759730A true CN103759730A (zh) 2014-04-30
CN103759730B CN103759730B (zh) 2016-06-29

Family

ID=50527006

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410020089.8A CN103759730B (zh) 2014-01-16 2014-01-16 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法

Country Status (1)

Country Link
CN (1) CN103759730B (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103954285A (zh) * 2014-05-13 2014-07-30 北京信息科技大学 一种室内自主三维空间定位信息融合方法
CN104034328A (zh) * 2014-05-21 2014-09-10 哈尔滨工程大学 一种基于滤波方法和曲线拟合方法相结合的协同导航方法
CN104613963A (zh) * 2015-01-23 2015-05-13 南京师范大学 基于人体运动学模型的行人导航系统与导航定位方法
CN105259902A (zh) * 2015-09-06 2016-01-20 江苏科技大学 水下机器人惯性导航方法及系统
CN106017454A (zh) * 2016-06-16 2016-10-12 东南大学 一种基于新型多传感器融合技术的行人导航装置和方法
CN106211196A (zh) * 2016-06-22 2016-12-07 西北工业大学 基于马尔科夫随机场的多无人航行体协同一致性方法
CN106595653A (zh) * 2016-12-08 2017-04-26 南京航空航天大学 一种穿戴式行人自主导航系统及其导航方法
CN106767789A (zh) * 2017-01-12 2017-05-31 南京航空航天大学 一种基于自适应卡尔曼滤波的行人航向最优融合方法
CN107218938A (zh) * 2017-05-22 2017-09-29 南京航空航天大学 基于人体运动模型辅助的穿戴式行人导航定位方法和设备
CN107289930A (zh) * 2016-04-01 2017-10-24 南京理工大学 基于mems惯性测量单元的纯惯性车辆导航方法
CN107588772A (zh) * 2017-09-01 2018-01-16 北京臻迪科技股份有限公司 涉水机器人姿态监测方法、装置和监测系统
CN107728629A (zh) * 2017-09-19 2018-02-23 富平县韦加无人机科技有限公司 无人机磁异常检测系统及方法
CN108444473A (zh) * 2018-03-20 2018-08-24 南京华苏科技有限公司 一种行人室内轨迹定位方法
CN109883429A (zh) * 2019-04-15 2019-06-14 山东建筑大学 基于隐马尔科夫模型的零速检测方法以及室内行人惯性导航系统

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US645990A (en) * 1899-07-18 1900-03-27 Richard S Windsor Trolley-wheel.
US6459990B1 (en) * 1999-09-23 2002-10-01 American Gnc Corporation Self-contained positioning method and system thereof for water and land vehicles
CN101413800A (zh) * 2008-01-18 2009-04-22 南京航空航天大学 导航/稳瞄一体化系统的导航、稳瞄方法
US20090254276A1 (en) * 2008-04-08 2009-10-08 Ensco, Inc. Method and computer-readable storage medium with instructions for processing data in an internal navigation system
EP2131147A1 (en) * 2008-05-15 2009-12-09 Honeywell International Inc. systems and methods for improving magnetic heading output from an inertial navigation system
CN102445200A (zh) * 2011-09-30 2012-05-09 南京理工大学 微小型个人组合导航系统及其导航定位方法
CN102980577A (zh) * 2012-12-05 2013-03-20 南京理工大学 一种微型捷联航姿系统及其工作方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US645990A (en) * 1899-07-18 1900-03-27 Richard S Windsor Trolley-wheel.
US6459990B1 (en) * 1999-09-23 2002-10-01 American Gnc Corporation Self-contained positioning method and system thereof for water and land vehicles
CN101413800A (zh) * 2008-01-18 2009-04-22 南京航空航天大学 导航/稳瞄一体化系统的导航、稳瞄方法
US20090254276A1 (en) * 2008-04-08 2009-10-08 Ensco, Inc. Method and computer-readable storage medium with instructions for processing data in an internal navigation system
EP2131147A1 (en) * 2008-05-15 2009-12-09 Honeywell International Inc. systems and methods for improving magnetic heading output from an inertial navigation system
CN102445200A (zh) * 2011-09-30 2012-05-09 南京理工大学 微小型个人组合导航系统及其导航定位方法
CN102980577A (zh) * 2012-12-05 2013-03-20 南京理工大学 一种微型捷联航姿系统及其工作方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
周启帆等: "基于MIMU的行人导航算法研究", 《系统仿真技术》, vol. 6, no. 4, 30 November 2010 (2010-11-30) *
崔潇等: "鞋式个人导航系统算法和试验研究", 《鞋式个人导航系统算法和试验研究》, vol. 32, no. 3, 31 December 2013 (2013-12-31) *
钱伟行等: "基于足部微惯性/地磁测量组件的个人导航方法", 《中国惯性技术学报》, vol. 20, no. 5, 31 October 2012 (2012-10-31) *

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103954285A (zh) * 2014-05-13 2014-07-30 北京信息科技大学 一种室内自主三维空间定位信息融合方法
CN104034328B (zh) * 2014-05-21 2017-03-29 哈尔滨工程大学 一种基于滤波方法和曲线拟合方法相结合的协同导航方法
CN104034328A (zh) * 2014-05-21 2014-09-10 哈尔滨工程大学 一种基于滤波方法和曲线拟合方法相结合的协同导航方法
CN104613963A (zh) * 2015-01-23 2015-05-13 南京师范大学 基于人体运动学模型的行人导航系统与导航定位方法
CN104613963B (zh) * 2015-01-23 2017-10-10 南京师范大学 基于人体运动学模型的行人导航系统与导航定位方法
CN105259902A (zh) * 2015-09-06 2016-01-20 江苏科技大学 水下机器人惯性导航方法及系统
CN107289930A (zh) * 2016-04-01 2017-10-24 南京理工大学 基于mems惯性测量单元的纯惯性车辆导航方法
CN106017454A (zh) * 2016-06-16 2016-10-12 东南大学 一种基于新型多传感器融合技术的行人导航装置和方法
CN106017454B (zh) * 2016-06-16 2018-12-14 东南大学 一种基于多传感器融合技术的行人导航装置和方法
CN106211196A (zh) * 2016-06-22 2016-12-07 西北工业大学 基于马尔科夫随机场的多无人航行体协同一致性方法
CN106211196B (zh) * 2016-06-22 2019-05-10 西北工业大学 基于马尔科夫随机场的多无人航行体协同一致性方法
CN106595653A (zh) * 2016-12-08 2017-04-26 南京航空航天大学 一种穿戴式行人自主导航系统及其导航方法
CN106767789A (zh) * 2017-01-12 2017-05-31 南京航空航天大学 一种基于自适应卡尔曼滤波的行人航向最优融合方法
CN106767789B (zh) * 2017-01-12 2019-12-24 南京航空航天大学 一种基于自适应卡尔曼滤波的行人航向最优融合方法
CN107218938A (zh) * 2017-05-22 2017-09-29 南京航空航天大学 基于人体运动模型辅助的穿戴式行人导航定位方法和设备
CN107588772A (zh) * 2017-09-01 2018-01-16 北京臻迪科技股份有限公司 涉水机器人姿态监测方法、装置和监测系统
CN107588772B (zh) * 2017-09-01 2020-02-21 北京臻迪科技股份有限公司 涉水机器人姿态监测方法、装置和监测系统
CN107728629A (zh) * 2017-09-19 2018-02-23 富平县韦加无人机科技有限公司 无人机磁异常检测系统及方法
CN108444473A (zh) * 2018-03-20 2018-08-24 南京华苏科技有限公司 一种行人室内轨迹定位方法
CN108444473B (zh) * 2018-03-20 2020-08-28 南京华苏科技有限公司 一种行人室内轨迹定位方法
CN109883429A (zh) * 2019-04-15 2019-06-14 山东建筑大学 基于隐马尔科夫模型的零速检测方法以及室内行人惯性导航系统

Also Published As

Publication number Publication date
CN103759730B (zh) 2016-06-29

Similar Documents

Publication Publication Date Title
Zhang et al. Inertial sensor based indoor localization and monitoring system for emergency responders
US10416276B2 (en) Position tracking system and method using radio signals and inertial sensing
Zhuang et al. Tightly-coupled integration of WiFi and MEMS sensors on handheld devices for indoor pedestrian navigation
Gusenbauer et al. Self-contained indoor positioning on off-the-shelf mobile devices
CN102829777B (zh) 自主式水下机器人组合导航系统及方法
EP2909579B1 (en) Surveying system and method
US20150130664A1 (en) Position tracking system and method using radio signals and inertial sensing
Jiancheng et al. Study on innovation adaptive EKF for in-flight alignment of airborne POS
Morales et al. Signals of opportunity aided inertial navigation
CN105628026A (zh) 一种移动物体的定位定姿方法和系统
Iqbal et al. An integrated reduced inertial sensor system—RISS/GPS for land vehicle
CN103314274B (zh) 活动元件或物体的轨迹的估算方法及系统
CN102538781B (zh) 基于机器视觉和惯导融合的移动机器人运动姿态估计方法
Cho et al. Robust positioning technique in low-cost DR/GPS for land navigation
US8005635B2 (en) Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
CN101413800B (zh) 导航/稳瞄一体化系统的导航、稳瞄方法
Storms Magnetic field aided indoor navigation
Georgy et al. Low-cost three-dimensional navigation solution for RISS/GPS integration using mixture particle filter
Sun et al. MEMS-based rotary strapdown inertial navigation system
Fan et al. Performance enhancement of MEMS-based INS/UWB integration for indoor navigation applications
CN103196448B (zh) 一种机载分布式惯性测姿系统及其传递对准方法
US20050203701A1 (en) Walking stick navigator for position determination
US20060287824A1 (en) Interruption free navigator
CN103424114B (zh) 一种视觉导航/惯性导航的全组合方法
Aghili et al. Driftless 3-D attitude determination and positioning of mobile robots by integration of IMU with two RTK GPSs

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