[发明专利]基于加速度计的飞行器姿态三角修正模型有效
申请号: | 201210047296.3 | 申请日: | 2012-02-28 |
公开(公告)号: | CN102607593A | 公开(公告)日: | 2012-07-25 |
发明(设计)人: | 史忠科 | 申请(专利权)人: | 西安费斯达自动化工程有限公司 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 710075 陕西省西安*** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 加速度计 飞行器 姿态 三角 修正 模型 | ||
1.基于加速度计的飞行器姿态三角修正模型,其特点是包括以下步骤:
1) 建立飞行器参考状态方程:
和观测方程:
其中: ,,为参考状态,,,分别为沿飞行器机体轴系轴的过载;为飞行器质心与地球表面垂线方向的过载,为高度;为重力加速度,为地球自转的修正量,分别为滚转、俯仰、偏航角速度,全申请书符号定义相同;
2) 采用滤波估计方法估计三个参考状态得到测量更新;
3) 根据三个参考状态估计俯仰、滚转角:
,如果,则;如果,则;
其中:分别指俯仰、滚转角;
4) 根据以下方程组中的某一个估计偏航角
其中:指飞行器偏航角,分别指GPS测得的飞行器东向和北向速度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西安费斯达自动化工程有限公司,未经西安费斯达自动化工程有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210047296.3/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种灯光控制器
- 下一篇:基于图像修复和矢量预测算子的帧内预测视频编码方法