[发明专利]惯导系统采样方法、采样系统有效
申请号: | 202011565536.X | 申请日: | 2020-12-25 |
公开(公告)号: | CN112729311B | 公开(公告)日: | 2023-07-07 |
发明(设计)人: | 唐琼;李良君;刘兆梅;李永满;郭剑锋 | 申请(专利权)人: | 湖南航天机电设备与特种材料研究所 |
主分类号: | G01C21/20 | 分类号: | G01C21/20 |
代理公司: | 长沙正奇专利事务所有限责任公司 43113 | 代理人: | 郭立中;王娟 |
地址: | 410205 *** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 系统 采样 方法 采样系统 | ||
本发明公开了一种惯导系统采样方法、采样系统,判断惯导系统BISS是否出现时钟MA,若是,则在每个时钟MA的下降沿读取惯导系统BISS的数据SLO。本发明仅使用一套圆光栅BISS采集硬件系统,实现电机控制部件和导航解算部件的同步高速采样功能,降低硬件风险及成本,不影响电机控制部件性能,同时也解决了不确定延时造成导航解算部件采样的角度信息与陀螺加速度计信息的不同步问题。
技术领域
本发明涉及数据采集领域,特别是一种圆光栅惯导系统采样方法及系统。
背景技术
惯导系统中的圆光栅角度信息通过BISS通讯方式采集,BISS通讯模式为主从模式,即主机发送时钟信号MA,驱动从机输出数据信号SLO,主机芯片通过已知频率的MA信号,以及接收到的SLO信号,按照BISS通讯格式实现数据解码。在惯导系统中,电机控制部件需要实时采集当前圆光栅角度信息,来实现对被控机构的精准稳定的转动控制;同时导航解算部件也需实时获取当前的角度信息来实现姿态解算。
传统的解决方案有如下两种:方案1、电机控制部件作为主机,获取到当前圆光栅角度后立即通过专用的通讯接口转发给导航解算部件;方案2、设计两套独立的圆光栅采样系统,分别供电机控制部件和导航解算部件使用。其中方案1方式中,电机控制部件首先接收解码BISS信息,然后将角度信息按照约定波特率格式的通讯格方式发送给导航解算部件,这一方面使得导航解算部件接收到的圆光栅角度信息增加了一部分延时,直接影响导航解算的结果;另一方面也限制了角度信息采样频率,高频的角度采样与数据转发增加了电机控制部件的工作量,也受限于两部件间的传输波特率。方案2方式避免了上述问题,但这样额外需要一套BISS采集的硬件设备,增加了产品成本,提高了硬件风险,另一方面两套系统安装误差因素不同,采集的数据也不同,导致两者之间存在不确定偏差,影响后续的滤波补偿处理。因此有必要为惯导系统研制一种经济实用的圆光栅BISS采样方案。
发明内容
本发明所要解决的技术问题是,针对现有技术不足,提供一种圆光栅惯导系统采样方法、采样系统,解决监测到的SLO相对MA存在导线传输延时的问题。
为解决上述技术问题,本发明所采用的技术方案是:一种圆光栅惯导系统采样方法,包括以下步骤:
1)判断惯导系统BISS是否出现时钟MA,若是,则进入步骤2);否则,重复步骤1);
2)在每个时钟MA的下降沿读取惯导系统BISS的数据SLO。
本发明在每个时钟MA的下降沿来读取SLO的数据位,解决了监测到的SLO相对MA存在导线传输的延时的问题,从而可以解决不确定延时造成导航解算部件采样的角度信息与陀螺加速度计信息的不同步问题,改善提高惯组产品的性能。
步骤2)的具体实现过程包括:
A)判断是否读取到SLO的确认信息ack,若是,则进入步骤B);否则,重复执行步骤A);
B)查询SLO信息是否由0变为1,若是,则进入步骤C);否则,返回步骤A);
C)读取SLO的start位,在时钟MA的下降沿读取SLO的0位、数据位、状态位以及CRC校验信息;
D)利用所述CRC校验信息判断校验是否通过,若通过,则更新BISS数据;否则,返回步骤1)。
本发明还提供了一种圆光栅BISS采样系统,其包括:
电机控制模块,用于发送惯导系统BISS时钟MA至光栅读数头;
光栅读数头,用于在接收到时钟MA后,将惯导系统BISS的数据SLO回传至电机控制部件;
导航解算模块,用于在每个时钟MA的下降沿,从所述光栅读数头同步读取惯导系统BISS的数据SLO的信息。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于湖南航天机电设备与特种材料研究所,未经湖南航天机电设备与特种材料研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011565536.X/2.html,转载请声明来源钻瓜专利网。