[发明专利]一种基于四环惯导平台的载体姿态角速度测量方法有效
申请号: | 202011157855.7 | 申请日: | 2020-10-26 |
公开(公告)号: | CN112611378B | 公开(公告)日: | 2022-12-20 |
发明(设计)人: | 陈志豪;王庭军;关艳霞;乔相伟;裴纺霞 | 申请(专利权)人: | 西安航天精密机电研究所 |
主分类号: | G01C21/18 | 分类号: | G01C21/18;G01C21/20 |
代理公司: | 西安智邦专利商标代理有限公司 61211 | 代理人: | 唐沛 |
地址: | 710100 陕*** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 四环惯导 平台 载体 姿态 角速度 测量方法 | ||
1.一种基于四环惯导平台的载体姿态角速度测量方法,其特征在于:包括以下步骤:
步骤1:在惯导平台计算机里创建角偏差补偿的双自适应跟踪微分运算模块;
所述角偏差补偿的双自适应跟踪微分运算模块的输入为四环惯导平台的四个框架角,分别为台体框架角、内框框架角、外框框架角和随动框框架角;其输出为四个框架角速度;
该模块具体包括第一自适应跟踪微分器、第一比较器、第二自适应跟踪微分器以及第二比较器;
步骤2:在惯导平台计算机里创建角速度转换矩阵实时计算模型;
所述角速度转换矩阵实时计算模型为:
式中:βyk、βxk、βzk、βsk分别为台体框架角、内框框架角、外框框架角和随动框框架角;Ck为角速度转换矩阵;
步骤3:通过惯导平台计算机实时采集四环惯导平台中角传感器角度信息,分别获取实时的台体框架角、内框框架角、外框框架角和随动框框架角;
步骤4:将四个框架角输入至角偏差补偿的双自适应跟踪微分运算模块中进行处理,分别得到台体框架角速度、内框框架角速度、外框框架角速度和随动框框架角速度;
具体为:任一框架角β(t)进入第一自适应跟踪微分器,得到第一自适应跟踪微分器的跟踪信号β′(t)和微分信号任一框架角β(t)与第一自适应跟踪微分器的跟踪信号β′(t)进入第一比较器,相减得到差值e(t),差值e(t)进入第二自适应跟踪微分器,得到第二自适应跟踪微分器的微分信号第一自适应跟踪微分器的微分信号和第二自适应跟踪微分器的微分信号进入第二比较器,相加得到任一框架角速度
步骤5:将步骤4得到的台体框架角速度内框框架角速度外框框架角速度和随动框框架角速度组成框架角速度列向量ωk,具体表达式为:
步骤6:将步骤3实时获取的台体框架角、内框框架角、外框框架角和随动框框架角代入步骤2的角速度转换矩阵计算模块中,得到实时的角速度转换矩阵Ck;
步骤7:将步骤6获取的当前时刻角速度转换矩阵Ck乘以步骤5中获得的框架角速度列向量ωk,从而得到载体角速度列向量ωb。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西安航天精密机电研究所,未经西安航天精密机电研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011157855.7/1.html,转载请声明来源钻瓜专利网。