• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 16
    • 下载费用:30 金币  

    重庆时时彩几分钟开一期: 基于重力实时补偿的惯性导航方法及装置.pdf

    摘要
    申请专利号:

    重庆时时彩单双窍门 www.4mum.com.cn CN201610067031.8

    申请日:

    2016.01.29

    公开号:

    CN105606093A

    公开日:

    2016.05.25

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):G01C 21/16申请日:20160129|||公开
    IPC分类号: G01C21/16 主分类号: G01C21/16
    申请人: 北京航空航天大学
    发明人: 杨功流; 周潇; 王晶; 史俊; 蒋杰; 王丽芬; 蔡庆中
    地址: 100191 北京市海淀区学院路37号
    优先权:
    专利代理机构: 北京同立钧成知识产权代理有限公司 11205 代理人: 杨文娟;黄健
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201610067031.8

    授权公告号:

    ||||||

    法律状态公告日:

    2018.04.03|||2016.06.22|||2016.05.25

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    本发明提供一种基于重力实时补偿的惯性导航方法及装置,包括:接收导航请求,所述导航请求中包括运动载体标识;根据所述导航请求,测量获取所述运动载体标识对应的运动载体在惯性参考系统中的加速度;建立重力扰动的卡尔曼状态方程和量测方程,并获取重力扰动的最优估计值;根据所述重力扰动的最优估计值,对所述加速度进行补偿处理,并根据补偿后的加速度,进行相应的导航处理。本发明提供的基于重力实时补偿的惯性导航方法,提高了惯性导航系统的导航精度。

    权利要求书

    1.一种基于重力实时补偿的惯性导航方法,其特征在于,包括:
    接收导航请求,所述导航请求中包括运动载体标识;
    根据所述导航请求,测量获取所述运动载体标识对应的运动载体在惯性
    参考系统中的加速度;
    建立重力扰动的卡尔曼状态方程和量测方程,并获取重力扰动的最优估
    计值;
    根据所述重力扰动的最优估计值,对所述加速度进行补偿处理,并根据
    补偿后的加速度,进行相应的导航处理。
    2.根据权利要求1所述的方法,其特征在于,建立重力扰动的卡尔曼状
    态方程和量测方程,并获取重力扰动的最优估计值,包括:
    采用公式和z=Hx+v计算获取重力扰动的初始最优估计值
    δgnT;
    根据预设的时间采样点,将相邻两个采样点之间的所述重力扰动的初始
    最优估计值进行求平均处理,获取各个采样点的重力扰动的最优估计值;
    其中,
    F S I N S = - ( ω i n n × ) M 1 0 3 × 3 - C b n 0 3 × 3 ( f s f n × ) M 2 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 6 × 15 , ]]>
    M 1 = 0 - 1 R M + h 0 1 R N + h 0 0 tan L R N + h 0 0 , ]]>
    M 2 = ( v n × ) M 1 - ( ( 2 ω i e n + ω e n n ) × ) , ]]>
    w=[wgx,wgy,wgz,wax,way,waz,01×9]T,
    H=[O3×6I3×3O3×6],v=[vL,vλ,vh]T,
    x为状态向量,为姿态角,δvnT为导航坐标系下速度误差,为位置
    误差,εbT为载体坐标系下陀螺漂移,δgnT为导航坐标系下的重力扰动,
    为导航坐标系相对于惯性坐标系的旋转角速度在导航坐标系下投影的叉乘,
    为比力在导航坐标系下投影的叉乘,为载体坐标系到导航坐标系的
    姿态变换矩阵,为地球坐标系相对于惯性坐标系的旋转角速度在导航坐
    标系下的投影,为导航坐标系相对于地球坐标系的旋转角速度在导航坐
    标系下的投影,(vn×)为速度在导航坐标系下投影的叉乘,RM为沿子午圈的
    曲率半径,RN为沿卯酉圈的曲率半径,w为系统噪声阵,wgx,wgy,wgz为陀螺噪
    声,wax,way,waz为加速度计噪声,o3×6为零矩阵,I3×3为单位矩阵,vL,vλ,vh为量
    测信息的噪声,z为观测量,为导航坐标系下惯导的速度误差,为导
    航坐标系下GPS的速度误差,h为载体离大地水准面的高度,L为载体所在
    位置的纬度。
    3.根据权利要求1或2所述的方法,其特征在于,所述根据补偿后的加
    速度,进行相应的导航处理包括:
    将所述补偿后的加速度对时间进行积分;
    将所述补偿后的加速度的积分结果变换到导航坐标系中,以获取在所述
    导航坐标系中的速度以及偏航角和位置;
    根据所述导航坐标系中的速度、偏航角和位置,进行导航处理。
    4.一种基于重力实时补偿的惯性导航装置,其特征在于,包括:
    接收???,用于接收导航请求,所述导航请求中包括运动载体标识;
    获取???,用于根据所述导航请求,测量获取所述运动载体标识对应的
    运动载体在惯性参考系统中的加速度;
    所述获取??榛褂糜诮⒅亓θ哦目ǘ刺匠毯土坎夥匠?,并获
    取重力扰动的最优估计值;
    导航???,用于根据所述重力扰动的最优估计值,对所述加速度进行补
    偿处理,并根据补偿后的加速度,进行相应的导航处理。
    5.根据权利要求4所述的装置,其特征在于,所述获取??榘ǎ?br />计算单元,用于采用公式和z=Hx+v计算获取重力扰动的初
    始最优估计值;
    计算单元还用于根据预设的时间采样点,将相邻两个采样点之间的所述
    重力扰动的初始最优估计值进行求平均处理,获取各个采样点的重力扰动的
    最优估计值;
    其中,
    F S I N S = - ( ω i n n × ) M 1 0 3 × 3 - C b n 0 3 × 3 ( f s f n × ) M 2 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 6 × 15 , ]]>
    M 1 = 0 - 1 R M + h 0 1 R N + h 0 0 tan L R N + h 0 0 , ]]>
    M 2 = ( v n × ) M 1 - ( ( 2 ω i e n + ω e n n ) × ) , ]]>
    w=[wgx,wgy,wgz,wax,way,waz,01×9]T,
    H=[O3×6I3×3O3×6],v=[vL,vλ,vh]T,
    x为状态向量,为姿态角,δvnT为导航坐标系下速度误差,为位置
    误差,εbT为载体坐标系下陀螺漂移,δgnT为导航坐标系下的重力扰动,
    为导航坐标系相对于惯性坐标系的旋转角速度在导航坐标系下投影的叉乘,
    为比力在导航坐标系下投影的叉乘,为载体坐标系到导航坐标系的
    姿态变换矩阵,为地球坐标系相对于惯性坐标系的旋转角速度在导航坐
    标系下的投影,为导航坐标系相对于地球坐标系的旋转角速度在导航坐
    标系下的投影,(vn×)为速度在导航坐标系下投影的叉乘,RM为沿子午圈的
    曲率半径,RN为沿卯酉圈的曲率半径,w为系统噪声阵,wgx,wgy,wgz为陀螺噪
    声,wax,way,waz为加速度计噪声,o3×6为零矩阵,I3×3为单位矩阵,vL,vλ,vh为量
    测信息的噪声,z是观测量,为导航坐标系下惯导的速度误差,为导
    航坐标系下GPS的速度误差,h为载体离大地水准面的高度,L为载体所在
    位置的纬度。
    6.根据权利要求4或5所述的装置,其特征在于,所述导航??榘ǎ?br />补偿单元,用于根据所述重力扰动的最优估计值,对所述加速度进行补
    偿处理;
    积分单元,用于将所述补偿后的加速度对时间进行积分;
    坐标变换单元,用于将所述补偿后的加速度的积分结果变换到导航坐标
    系中,以获取在所述导航坐标系中的速度以及偏航角和位置;
    导航处理单元,用于根据所述导航坐标系中的速度、偏航角和位置,进
    行导航处理。

    说明书

    基于重力实时补偿的惯性导航方法及装置

    技术领域

    本发明涉及运动载体导航技术领域,尤其涉及一种基于重力实时补偿的
    惯性导航方法及装置。

    背景技术

    惯性导航系统(InertialNavigationSystem,简称INS)也称作惯性参考系
    统,是一种不依赖于外部信息、也不向外部辐射能量的自主式导航系统。其
    工作环境不仅包括空中、地面,还可以在水下。INS的基本工作原理是以牛
    顿力学定律为基础,通过测量运动载体在惯性参考系统的加速度,将该加速
    度对时间进行积分,并将该加速度的积分结果变换到导航坐标系中,就能够
    得到在导航坐标系中的速度、偏航角和位置等信息,因此,运动载体在惯性
    参考系统中的加速度的测量,对惯性导航系统起到重要的作用。

    现有技术中,采用加速度计测量运动载体的加速度,但是加速度计输出
    的是比力,比力既包括运动载体相对惯性空间的绝对加速度还包括有害加速
    度,因此,需要从加速度计输出的比力中补偿掉有害加速度从而获得载体相
    对惯性空间的绝对加速度,其中,有害加速度包括重力加速度,一般采用重
    力模型所提供的正常重力加速度对加速度计的输出结果进行重力加速度补
    偿。

    但是,由于真实重力加速度与重力模型所提供的正常重力加速度存在偏
    差,因此,采用现有技术所获得的运动载体的绝对加速度不精确,从而导致
    了惯性导航精度下降。

    发明内容

    本发明提供一种基于重力实时补偿的惯性导航方法及装置,用于解决现
    有技术中惯性导航精度低下的问题。

    本发明第一方面提供一种基于重力实时补偿的惯性导航方法,包括:

    接收导航请求,所述导航请求中包括运动载体标识;

    根据所述导航请求,测量获取所述运动载体标识对应的运动载体在惯性
    参考系统中的加速度;

    建立重力扰动的卡尔曼状态方程和量测方程,并获取重力扰动的最优估
    计值;

    根据所述重力扰动的最优估计值,对所述加速度进行补偿处理,并根据
    补偿后的加速度,进行相应的导航处理。

    本发明第二方面提供一种基于重力实时补偿的惯性导航装置,包括:

    接收???,用于接收导航请求,所述导航请求中包括运动载体标识;

    获取???,用于根据所述导航请求,测量获取所述运动载体标识对应的
    运动载体在惯性参考系统中的加速度;

    所述获取??榛褂糜诮⒅亓θ哦目ǘ刺匠毯土坎夥匠?,并获
    取重力扰动的最优估计值;

    导航???,用于根据所述重力扰动的最优估计值,对所述加速度进行补
    偿处理,并根据补偿后的加速度,进行相应的导航处理。

    本发明提供一种基于重力实时补偿的惯性导航方法及装置,包括,接收
    导航请求,导航请求中包括运动载体标识;根据导航请求,测量获取运动载
    体标识对应的运动载体在惯性参考系统中的加速度,建立重力扰动的卡尔曼
    状态方程和量测方程,并获取重力扰动的最优估计值;根据所述重力扰动的
    最优估计值,对所述加速度进行补偿处理,并根据补偿后的加速度,进行相
    应的导航处理,这样,可以实时地获取运动载体重力扰动的最优估计值,并
    对测量获取的运动载体标识对应的运动载体在惯性参考系统中的加速度进行
    补偿处理,根据补偿后的加速度,进行相应的导航处理,提高了惯性导航系
    统的导航精度。

    附图说明

    为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实
    施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下
    面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在
    不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。

    图1为本发明提供的基于重力实时补偿的惯性导航方法实施例一的流程
    图;

    图2为本发明提供的基于重力实时补偿的惯性导航方法实施例二的流程
    图;

    图3为本发明提供的基于重力实时补偿的惯性导航方法实施例三的流程
    图;

    图4为本发明提供的基于重力实时补偿的惯性导航装置实施例一的结构
    示意图;

    图5为本发明提供的基于重力实时补偿的惯性导航装置实施例二的结构
    示意图;

    图6为本发明提供的基于重力实时补偿的惯性导航装置实施例三的结构
    示意图。

    具体实施方式

    为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发
    明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,
    显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例?;?br />本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获
    得的所有其他实施例,都属于本发明?;さ姆段?。

    图1为本发明提供的基于重力实时补偿的惯性导航方法实施例一的流程
    图,如图1所示,该方法包括:

    步骤101、接收导航请求,导航请求中包括运动载体标识。

    在本实施例中,运动载体可以包括但并不限于以下几种:汽车、飞机、
    潜艇等,其中,每一个运动载体具有唯一的标识。

    步骤102、根据导航请求,测量获取运动载体标识对应的运动载体在惯
    性参考系统中的加速度。

    在本实施例中,具体地,采用加速度计测量运动载体在惯性参考系统中
    的加速度。

    步骤103、建立重力扰动的卡尔曼状态方程和量测方程,并获取重力扰
    动的最优估计值。

    步骤104、根据重力扰动的最优估计值,对加速度进行补偿处理,并根
    据补偿后的加速度,进行相应的导航处理。

    在本实施例中,重力扰动是指空间中同一点实际重力加速度与正常重力
    加速度之差,这样根据重力模型所提供的正常重力加速度和重力扰动可以获
    取运动载体的实际重力加速度,并根据运动载体的实际重力加速度对测量获
    取的运动载体标识对应的运动载体在惯性参考系统中的加速度进行补偿处
    理。

    在本实施例中,接收导航请求,导航请求中包括运动载体标识;根据导
    航请求,测量获取运动载体标识对应的运动载体在惯性参考系统中的加速
    度,建立重力扰动的卡尔曼状态方程和量测方程,并获取重力扰动的最优估
    计值;根据重力扰动的最优估计值,对加速度进行补偿处理,并根据补偿后
    的加速度,进行相应的导航处理,这样,可以实时地获取运动载体重力扰动
    的最优估计值,并对测量获取的运动载体标识对应的运动载体在惯性参考系
    统中的加速度进行补偿处理,根据补偿后的加速度,进行相应的导航处理,
    提高了惯性导航系统的导航精度。

    图2为本发明提供的基于重力实时补偿的惯性导航方法实施例二的流程
    图,如图2所示,该方法包括:

    步骤201、接收导航请求,导航请求中包括运动载体标识。

    在本实施例中,运动载体可以包括但并不限于以下几种:汽车、飞机、
    潜艇等,其中,每一个运动载体具有唯一的标识。

    步骤202、根据导航请求,测量获取运动载体标识对应的运动载体在惯
    性参考系统中的加速度。

    在本实施例中,具体地,采用加速度计测量运动载体在惯性参考系统中
    的加速度。

    步骤203、采用公式(1)和(2)

    x · = F S I N S x + w - - - ( 1 ) ]]>

    z=Hx+v(2)

    计算获取重力扰动的初始最优估计值。

    其中,

    F S I N S = - ( ω i n n × ) M 1 0 3 × 3 - C b n 0 3 × 3 ( f s f n × ) M 2 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 6 × 15 , ]]>

    M 1 = 0 - 1 R M + h 0 1 R N + h 0 0 tan L R N + h 0 0 , ]]>

    M 2 = ( v n × ) M 1 - ( ( 2 ω i e n + ω e n n ) × ) , ]]>

    w=[wgx,wgy,wgz,wax,way,waz,01×9]T,

    H=[O3×6I3×3O3×6],v=[vL,vλ,vh]T,

    x为状态向量,为姿态角,δvnT为导航坐标系下速度误差,为位置
    误差,εbT为载体坐标系下陀螺漂移,δgnT为导航坐标系下的重力扰动,
    为导航坐标系相对于惯性坐标系的旋转角速度在导航坐标系下投影的叉乘,
    为比力在导航坐标系下投影的叉乘,为载体坐标系到导航坐标系的
    姿态变换矩阵,为地球坐标系相对于惯性坐标系的旋转角速度在导航坐
    标系下的投影,为导航坐标系相对于地球坐标系的旋转角速度在导航坐
    标系下的投影,(vn×)为速度在导航坐标系下投影的叉乘,RM为沿子午圈的
    曲率半径,RN为沿卯酉圈的曲率半径,w为系统噪声阵。wgx,wgy,wgz为陀螺噪
    声,wax,way,waz为加速度计噪声,o3×6为零矩阵,I3×3为单位矩阵,vL,vλ,vh为量
    测信息的噪声,z为观测量,为导航坐标系下惯导的速度误差,为导
    航坐标系下GPS的速度误差,h为载体离大地水准面的高度,L为载体所在
    位置的纬度。

    在本实施例中,根据公式(1)和(2)采用迭代算法计算获取重力扰动
    的最优估计值。

    步骤204、根据预设的时间采样点,将相邻两个采样点之间的重力扰动
    的初始最优估计值进行求平均处理,获取各个采样点的重力扰动的最优估计
    值。

    在本实施例中,将相邻两个采样点之间的重力扰动的初始最优估计值进
    行求平均处理,获取的是这两个相邻采样点中靠前的采样点对应的重力扰动
    的最优估计值。

    步骤205、根据重力扰动的最优估计值,对加速度进行补偿处理,并根
    据补偿后的加速度,进行相应的导航处理。

    在本实施例中,采用公式(1)和(2)计算获取重力扰动的初始最优估
    计值,并根据预设的时间采样点,将相邻两个采样点之间的重力扰动的初始
    最优估计值进行求平均处理,获取各个采样点的重力扰动的最优估计值,这
    样可以实时地获取重力扰动的最优估计值,并提高了重力扰动的最优估计值
    的准确度。

    图3为本发明提供的基于重力实时补偿的惯性导航方法实施例三的流程
    图,如图3所示,该方法包括:

    步骤301、接收导航请求,导航请求中包括运动载体标识。

    在本实施例中,运动载体可以包括但并不限于以下几种:汽车、飞机、
    潜艇等,其中,每一个运动载体具有唯一的标识。

    步骤302、根据导航请求,测量获取运动载体标识对应的运动载体在惯
    性参考系统中的加速度。

    在本实施例中,具体地,采用加速度计测量运动载体在惯性参考系统中
    的加速度。

    步骤303、采用公式(1)和(2)

    x · = F S I N S x + w - - - ( 1 ) ]]>

    z=Hx+v(2)

    计算获取重力扰动的初始最优估计值。

    其中,

    F S I N S = - ( ω i n n × ) M 1 0 3 × 3 - C b n 0 3 × 3 ( f s f n × ) M 2 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 6 × 15 , ]]>

    M 1 = 0 - 1 R M + h 0 1 R N + h 0 0 tan L R N + h 0 0 , ]]>

    M 2 = ( v n × ) M 1 - ( ( 2 ω i e n + ω e n n ) × ) , ]]>

    w=[wgx,wgy,wgz,wax,way,waz,01×9]T,

    H=[O3×6I3×3O3×6],v=[vL,vλ,vh]T,

    x为状态向量,为姿态角,δvnT为导航坐标系下速度误差,为位置
    误差,εbT为载体坐标系下陀螺漂移,δgnT为导航坐标系下的重力扰动,
    为导航坐标系相对于惯性坐标系的旋转角速度在导航坐标系下投影的叉乘,
    为比力在导航坐标系下投影的叉乘,为载体坐标系到导航坐标系的
    姿态变换矩阵,为地球坐标系相对于惯性坐标系的旋转角速度在导航坐
    标系下的投影,为导航坐标系相对于地球坐标系的旋转角速度在导航坐
    标系下的投影,(vn×)为速度在导航坐标系下投影的叉乘,RM为沿子午圈的
    曲率半径,RN为沿卯酉圈的曲率半径,w为系统噪声阵。wgx,wgy,wgz为陀螺噪
    声,wax,way,waz为加速度计噪声,o3×6为零矩阵,I3×3为单位矩阵,vL,vλ,vh为量
    测信息的噪声,z为观测量,为导航坐标系下惯导的速度误差,为导
    航坐标系下GPS的速度误差,h为载体离大地水准面的高度,L为载体所在
    位置的纬度。

    步骤304、根据预设的时间采样点,将相邻两个采样点之间的重力扰动
    的初始最优估计值进行求平均处理,获取各个采样点的重力扰动的最优估计
    值。

    步骤305、根据重力扰动的最优估计值,对加速度进行补偿处理。

    步骤306、将补偿后的加速度对时间进行积分。

    步骤307、将补偿后的加速度的积分结果变换到导航坐标系中,以获取
    在导航坐标系中的速度以及偏航角和位置。

    步骤308、根据导航坐标系中的速度、偏航角和位置,进行导航处理。

    在本实施例中,根据重力扰动的最优估计值,对加速度进行补偿处理,
    将补偿后的加速度对时间进行积分,并将补偿后的加速度的积分结果变换到
    导航坐标系中,以获取在导航坐标系中的速度以及偏航角和位置,并根据导
    航坐标系中的速度、偏航角和位置等信息,进行导航处理,从而提高了惯性
    导航系统的导航精度。

    图4为本发明提供的基于重力实时补偿的惯性导航装置实施例一的结构
    示意图,如图4所示,该装置包括:接收???0、获取???1和导航???br />12。

    接收???0,用于接收导航请求,导航请求中包括运动载体标识。

    获取???1,用于根据导航请求,测量获取运动载体标识对应的运动载
    体在惯性参考系统中的加速度。

    获取???1还用于建立重力扰动的卡尔曼状态方程和量测方程,并获取
    重力扰动的最优估计值。

    导航???2,用于根据重力扰动的最优估计值,对加速度进行补偿处理,
    并根据补偿后的加速度,进行相应的导航处理。

    本实施例中的基于重力实时补偿的惯性导航装置可以执行图1所示方法
    实施例的技术方案,其实现原理和有益效果相类似,此处不再赘述。

    图5为本发明提供的基于重力实时补偿的惯性导航装置实施例二的结构
    示意图,如图5所示,在图4所示实施例的基础上,该装置的获取???1包
    括:

    计算单元20,用于采用公式(1)和(2)

    x · = F S I N S x + w - - - ( 1 ) ]]>

    z=Hx+v(2)

    计算获取重力扰动的初始最优估计值。

    其中,

    F S I N S = - ( ω i n n × ) M 1 0 3 × 3 - C b n 0 3 × 3 ( f s f n × ) M 2 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 6 × 15 , ]]>

    M 1 = 0 - 1 R M + h 0 1 R N + h 0 0 tan L R N + h 0 0 , ]]>

    M 2 = ( v n × ) M 1 - ( ( 2 ω i e n + ω e n n ) × ) , ]]>

    w=[wgx,wgy,wgz,wax,way,waz,01×9]T,

    H=[O3×6I3×3O3×6],v=[vL,vλ,vh]T,

    x为状态向量,为姿态角,δvnT为导航坐标系下速度误差,为位置
    误差,εbT为载体坐标系下陀螺漂移,δgnT为导航坐标系下的重力扰动,
    为导航坐标系相对于惯性坐标系的旋转角速度在导航坐标系下投影的叉乘,
    为比力在导航坐标系下投影的叉乘,为载体坐标系到导航坐标系的
    姿态变换矩阵,为地球坐标系相对于惯性坐标系的旋转角速度在导航坐
    标系下的投影,为导航坐标系相对于地球坐标系的旋转角速度在导航坐
    标系下的投影,(vn×)为速度在导航坐标系下投影的叉乘,RM为沿子午圈的
    曲率半径,RN为沿卯酉圈的曲率半径,w为系统噪声阵。wgx,wgy,wgz为陀螺噪
    声,wax,way,waz为加速度计噪声,o3×6为零矩阵,I3×3为单位矩阵,vL,vλ,vh为量
    测信息的噪声,z为观测量,为导航坐标系下惯导的速度误差,为导
    航坐标系下GPS的速度误差,h为载体离大地水准面的高度,L为载体所在
    位置的纬度。

    计算单元20还用于根据预设的时间采样点,将相邻两个采样点之间的重
    力扰动的初始最优估计值进行求平均处理,获取各个采样点的重力扰动的最
    优估计值。

    本实施例中的基于重力实时补偿的惯性导航装置可以执行图2所示方法
    实施例的技术方案,其实现原理和有益效果相类似,此处不再赘述。

    图6为本发明提供的基于重力实时补偿的惯性导航装置实施例三的结构
    示意图,如图6所示,在图4所述实施例的基础上,导航???2包括:补偿
    单元30、积分单元31、坐标变换单元31和导航处理单元33。

    补偿单元30,用于根据重力扰动的最优估计值,对加速度进行补偿处理。

    积分单元31,用于将补偿后的加速度对时间进行积分。

    坐标变换单元32,用于将补偿后的加速度的积分结果变换到导航坐标系
    中,以获取在导航坐标系中的速度以及偏航角和位置。

    导航处理单元33,用于根据导航坐标系中的速度、偏航角和位置,进行
    导航处理。

    本实施例中的基于重力实时补偿的惯性导航装置可以执行图3所示方法
    实施例的技术方案,其实现原理和有益效果相类似,此处不再赘述。

    最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对
    其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通
    技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修
    改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替
    换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

    关 键 词:
    基于 重力 实时 补偿 惯性 导航 方法 装置
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    关于本文
    本文标题:基于重力实时补偿的惯性导航方法及装置.pdf
    链接地址://www.4mum.com.cn/p-5886318.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03