[发明专利]一种组合惯导姿态计算方法在审

专利信息
申请号: 201911267984.9 申请日: 2019-12-11
公开(公告)号: CN111006660A 公开(公告)日: 2020-04-14
发明(设计)人: 曲国福 申请(专利权)人: 陕西瑞特测控技术有限公司
主分类号: G01C21/16 分类号: G01C21/16
代理公司: 西安弘理专利事务所 61214 代理人: 弓长
地址: 710077 陕西省西安市高*** 国省代码: 陕西;61
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 一种 组合 姿态 计算方法
【说明书】:

本发明公开了一种组合惯导姿态计算方法,包括在第一采样周期,通过三轴加速度传感器和三轴磁力计采集载体第一加速度数据和磁力计数据,并据此计算第一姿态,第一姿态发送至姿态融合模块,第一姿态作为三轴陀螺仪的初始姿态;在第二采样周期,通过三轴陀螺传感器和三轴加速度传感器采集载体角速度和加速度;通过卫星信号强度检测模块对天线束波指向卫星方向的信号强度进行检测,并获得航向误差和俯仰角误差;通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号强度进行姿态融合,得到姿态的估算值并据此控制天线电机对卫星进行跟踪,将跟踪卫星检测的信号强度信息反馈至姿态融合模块进行姿态融合。本发明为提高了导航精度和可靠性。

技术领域

本发明属于姿态测量技术领域,具体涉及一种组合惯导姿态计算方法。

背景技术

陀螺仪和加速度计相结合,并通过导航信息修正航向的方法是现有技术 中常用的方法。由于陀螺仪动态性能好,但由于其存在零漂,经过长时间累 积,姿态估算将不准确,而加速度计测量值随时间变化较小,因此通常将陀 螺仪和加速度计结合,采用互补滤波器或扩展卡尔曼滤波估算姿态。

现有技术采用导航信息进行航向修正,而惯性导航设备得到准确航向要 求设备在单位时间内得到不同载体位置信息,即要求载体运动,因而当载体 静止或者低速时,惯性导航信息不准确;若需在载体静止时提高惯导导航信 息准确度,需采用双天线测向接收机,其原理:利用前后天线卫星信号进行 自身位置信息解算,结合卫星接收天线间距不变的条件,估算航向角,采用 双天线的安装间隔(基线)有距离要求,对小型的动中通无法部署;在某些特 性情况,如作战环境下,若需卫星动中通进行通信,此时惯性导航信息可能被干扰或是引导,将导致航向无法修正而使卫星动中通最终不可用。

申请号为CN201611224529.7的中国专利《基于卫星通信的组合惯导姿 态计算方法》,采用卫星信号强度进行航向修正,不论载体处于静止或运动, 只要卫星动中通处于对星状态,便可根据接收的卫星信号强度,检测出天线 波束指向与卫星方向的误差,反馈给惯导进行航向修正,并且与天线电机之 间形成闭环控制,降低对惯导姿态估算准确度的要求。但是其在导航精度和 可靠度方面仍具有提高空间。

发明内容

本发明的目的是提供一种组合惯导姿态计算方法,能够提高导航精度和 可靠度。

本发明所采用的技术方案是:一种组合惯导姿态计算方法,其特征在于, 包括如下步骤:

步骤一、在第一采样周期,通过三轴加速度传感器采集载体x轴、y轴 和z轴的第一加速度数据,通过三轴磁力计采集载体x轴、y轴和z轴的磁 力计数据;

步骤二、根据磁力计数据和所述第一加速度计数据计算第一姿态,第一 姿态发送至姿态融合模块,所述第一姿态作为三轴陀螺仪的初始姿态;

步骤三、在第二采样周期,通过三轴陀螺传感器采集载体x轴、y轴和 z轴的角速度,并对角速度积分获得三轴角度变化;三轴加速度传感器采集 载体x轴、y轴和z轴的加速度,获得加速度变化;

步骤四、通过卫星信号强度检测模块对天线束波指向卫星方向的信号强 度进行检测,并对信号强度进行解调后获得航向误差和俯仰角误差;

步骤五、通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号 强度进行姿态融合,得到姿态的估算值;

步骤六、通过姿态的估算值控制天线电机对卫星进行跟踪,再将跟踪卫 星检测的信号强度信息反馈至姿态融合模块进行姿态融合,形成闭环。

本发明的特点还在于:

三轴磁力计采用Metrolab TFM1186三轴磁力计。

三轴加速度传感器采用ADXL335BCPZ加速度传感器。

三轴加速度传感器采用LIS3DH三轴加速度计。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于陕西瑞特测控技术有限公司,未经陕西瑞特测控技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201911267984.9/2.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code