[发明专利]一种基于逆向解算编排的快速对准方法在审
| 申请号: | 201911398192.5 | 申请日: | 2019-12-30 |
| 公开(公告)号: | CN111024129A | 公开(公告)日: | 2020-04-17 |
| 发明(设计)人: | 粟伟;刘晓东;王福亮;袁野;于志鋐;罗先泉 | 申请(专利权)人: | 重庆华渝电气集团有限公司 |
| 主分类号: | G01C25/00 | 分类号: | G01C25/00 |
| 代理公司: | 重庆博凯知识产权代理有限公司 50212 | 代理人: | 胡逸然 |
| 地址: | 401120*** | 国省代码: | 重庆;50 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 基于 逆向 编排 快速 对准 方法 | ||
1.一种基于逆向解算编排的快速对准方法,其特征在于,包括如下步骤:
S1、系统启动后,采集预设时间内的陀螺加速度信息,并持续利用预设时间内采集到的陀螺加速度信息进行粗对准;
S2、存储所述预设时间内采集到的陀螺加速度信息,持续采集并存储预设时间之后的陀螺加速度信息;
S3、按照采集时间的先后顺序从存储空间内提取陀螺加速度信息进行精对准,直至精对准的陀螺加速度信息与采集的陀螺加速度信息同步。
2.如权利要求1所述的基于逆向解算编排的快速对准方法,其特征在于,在进行对准的过程中,动基座对准的东向通道离散算法包括
δvEk=vEk-1-vREk
δPEk=δPEk-1+KE3δvEkTs
ωcNk=δvEk(1+KE1)/Re+δPEk
式中,δvEk表示k时刻的东向速度误差,vEk-1表示k-1时刻解算出的东向速度,vREk表示k时刻的载体的真实东向速度,vEk表示k时刻解算出的东向速度,表示东向加速度计在东向投影,KE1表示东向滤波参数,Ts表示解算频率为s的解算周期,δPEk表示k时刻解算位置与真实位置的东向位置差,δPEk-1表示k-1时刻的解算东向位置,KE3表示东向滤波参数,ωcNk表示k时刻的北向角速度,Re表示地球自转曲率半径;
动基座对准的北向通道离散算法包括
δvNk=vNk-1-vRNk
δPNk=δPNk-1+KN3δvNkTs
ωcEk=δvNk(1+KN1)/Re+δPNk
式中,δvNk表示k时刻的北向速度误差,vNk-1表示k-1时刻解算出的北向速度,vRNk表示k时刻的载体的真实北向速度,vNk表示k时刻解算出的北向速度,表示东向加速度计在北向投影,KN1表示北向滤波参数,Ts表示解算频率为s的解算周期,δPNk表示k时刻解算位置与真实位置的北向位置差,δPNk-1表示北-1时刻的解算东向位置,KN3表示北向滤波参数,ωcEk表示k时刻的东向角速度;
动基座对准的方位通道离散算法包括
δvNk=vNk-1-vRNk
ωcEk=-δvNk(1+KU2)/Re
ωcUk=(KU3δvNkTs/ωN+ωcUk-1)/(1+KU4Ts)
式中,KU2表示天向滤波参数,ωcUk表示天向角速度,KU3表示天向滤波参数,ωN表示北向地球自转角速度,ωcUk-1表示k-1时刻的天向角速度,KU4表示天向滤波参数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于重庆华渝电气集团有限公司,未经重庆华渝电气集团有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911398192.5/1.html,转载请声明来源钻瓜专利网。





