一种微型姿态模块的动态精度测试系统及其方法

xiaoxiao2020-10-23  12

一种微型姿态模块的动态精度测试系统及其方法
【技术领域】
[0001]本发明属于飞行器姿态系统性能测试技术领域,具体涉及一种微型姿态模块的动态精度测试系统及其方法。
【背景技术】
[0002]随着微电子系统技术的全面发展,小型化、低成本和低功耗的微型姿态模块已经成为导航领域的一个发展趋势。在飞行器技术领域,微型姿态模块通常作为导航测量系统,其基本功能是实现对角速度、比力等信息的直接测量并解算得到飞行器的俯仰角、横滚角等姿态,最终将传感器数据和计算结果发送到外部,用于载体的姿态控制或显示。微型姿态模块的输出姿态精度是其性能中最重要的部分。微型姿态模块的姿态精度测试包括高温、低温和常温下的静态精度测试和动态精度测试。其中,动态精度是指微型姿态模块在动态情况下姿态输出与转台基准角之间的误差,动态测试的主要内容包括:输出俯仰角、横滚角动态精度。为了最大限度地接近实际飞行载体的动态特性,通常选择摆动实验为动态测试的手段。
[0003]在目前实际工程应用中,微型姿态模块的所有标定、试验均在高精度双轴转台上完成,其动态精度测试实验,通常以转台输出角度作为对比基准。这种微型姿态模块的动态精度测试系统及方法,主要是通过双轴转台激励微型姿态模块,通过PC机采集转台和微型姿态模块在动态环境下的输出,由两者的输出之差计算出微型姿态模块的动态精度指标。这种测试系统及方法存在以下问题:一是要分别采集转台和微型姿态模块数据,导致两者数据不能同步;二是无法对微型姿态模块和转台数据的不同步性进行处理,造成测试精度较低、可靠性差;三是在精度指标计算中对微型姿态模块与转台安装误差不做处理,使测试结果可靠性低。

【发明内容】

[0004]本发明所要解决的技术问题是提供一种微型姿态模块的动态精度测试系统及其方法,可以同步采集转台和微型姿态模块的数据,也可以对微型姿态模块和转台数据的不同步性进行处理,并能有效对微型姿态模块与转台安装误差进行处理,测试精度高,可靠性好。
[0005]为了解决上述技术问题,本发明所采用的技术方案是:
一种微型姿态模块的动态精度测试系统,包括:
高精度双轴转台,实现动态运行规划,为测试系统提供位置、速率、摇摆动态基准,以串行方式输出动态参数;
微型姿态模块,由夹具固定在所述的高精度双轴转台上,为飞行器提供实时的加速度、角速度和姿态信息;
PC机数据处理模块,由PC机和数据处理软件组成,实现数据的接收与存储并完成动态精度指标的解算及输出; 其特征在于,还包括一个数据同步采集板,由单片机和接口电路组成;所述的数据同步采集板在动态测试中采集高精度双轴转台和微型姿态模块的数据,在所述的单片机中完成数据的同步,同时将此数据以串行方式输出到PC机数据处理模块。
[0006]所述的微型姿态模块通过第一接口电路与所述的高精度双轴转台串行连接;所述的数据同步采集板通过第二接口电路、第三接口电路分别串行连接到所述的微型姿态模块和高精度双轴转台的输出接口,实现微型姿态模块与高精度双轴转台的同步数据采集;数据同步采集板通过第四接口电路串行连接到所述的PC机数据处理模块,PC机接收并存储所述的同步采集数据,数据处理软件通过对该记录数据的进一步分析,计算微型姿态模块的动态精度指标。
[0007]所述的数据同步采集板的单片机采用STM32F407型ARM处理器。
[0008]所述的第二接口电路和第四接口电路采用RS422接口 MAX490芯片,第三接口电路采用RS232接口 MAX232芯片。
[0009]一种微型姿态模块的动态精度测试的方法,其特征在于,具体步骤如下:
步骤一、通过高精度夹具将微型姿态模块固定在高精度双轴转台的内框安装平面上; 步骤二、将数据同步采集板的第二接口电路、第三接口电路分别连接微型姿态模块和高精度双轴转台的输出接口;
步骤三、启动微型姿态模块和转台并设置转台内框动态运动条件,设置测试时间并启动测试;
步骤四、启动数据同步采集板,实现微型姿态模块和转台的同步数据采集,同时单片机完成数据的粗同步;
步骤五、将粗同步后的数据发送到PC机数据处理模块;
步骤六、PC机数据处理模块进行数据的精同步;分析处理存储数据,计算微型姿态模块的动态精度。
[0010]在步骤四中,所述数据粗同步的过程是:所述的数据同步采集板启动后,单片机处理器延时初始化并启动开机时间,利用同步采集程序将接收到的微型姿态模块和转台的数据分别添加时间标志后,再将添加了时间标志的微型姿态模块和转台数据进行解码、整合并输出给PC机储存。
[0011]在步骤六中,所述数据精同步的过程是:
PC机数据处理模块读取精同步数据,并对添加了时间标志的微型姿态模块的横滚角信息、俯仰角信息数据以及转台的内外框位置信息数据进行拟合;将微型姿态模块横滚角、俯仰角数据小量平移,使微型姿态模块信息的基准与转台输出信息的基准之间的同步性更精确。
[0012]在所述步骤六中,所述的计算微型姿态模块的动态精度的过程是:
用PC机数据处理模块的MATLAB对精同步后的数据进行处理,利用转台静止阶段采集的微型姿态模块数据求平均,得到微型姿态模块的横滚角初始安装误差、俯仰角初始安装误差;扣除安装误差后,对每一时刻的微型姿态模块横滚角和转台内框角求差值,得到该时刻的微型姿态模块横滚角误差;将每一时刻的横滚角误差平方相加再开根即可得到微型姿态模块横滚角动态精度结果。
[0013]本发明与现有技术相比,具有以下优点和有益效果: 1.本发明通过嵌入式数据同步采集板对微型姿态模块数据和转台数据进行实时同步采集和实时粗同步处理,从而提高了动态情况下采集得到的微型姿态模块的实时数据的可信度,采用该方法测试出的微型姿态模块动态精度更加可靠和精确;
2.本发明通过PC机MATLAB数据处理软件,采用精同步软件算法对粗同步后的数据进行精同步处理,进一步提高了动态情况下高频采集得到的微型姿态模块数据和转台数据的同步性,从而提高了该方法测试得到的微型姿态模块的动态精度。
[0014]3、本发明可拓展至对多个微型姿态模块同时进行动态精度测试,进一步提高测试效率。本发明所测试的微型姿态模块,是通过高精度夹具固定在双轴转台内框中,如需同时对多个微型姿态模块进行批量动态精度测试,可改用批量测试专用夹具,数据同步采集板可同时采集多个微型姿态模块数据和转台数据并完成同步,同时发送给PC机。S卩,若实现多个模块批量测试,仅仅需改装原有夹具,减少了成本,提高了测试效率。
[0015]下面结合附图和具体实施例对本发明做进一步详细说明。
【附图说明】
[0016]图1是现有技术的微型姿态模块的动态精度测试方法示意图。
[0017]图2是本发明测试系统示意图。
[0018]图3是本发明测试系统的主要信号流程图。
[0019]图4是本发明测试方法流程图。
[0020]图5是本发明的微型姿态模块与转台数据处理流程图。
[0021]图6是本发明测试系统的数据同步方法。
[0022]图7是本发明测试系统的动态精度指标计算方法。
[0023]图8— 11是本发明测试系统的微型姿态模块横滚角、俯仰角动态精度测试结果曲线,分别为:
图8是转台内框角与产品横滚角位置曲线图。
[0024]图9是横滚角位置误差。
[0025]图10是转台内框角与产品俯仰角位置曲线图。
[0026]图11是俯仰角位置误差图。
[0027]其中,I高精度双轴转台,2微型姿态模块,3数据同步采集板,4 PC机数据处理模块,5第一接口电路,6第二接口电路,7第三接口电路,8第四接口电路。
【具体实施方式】
[0028]如图1所示,现有技术的微型姿态模块动态精度测试主要通过PC机分别采集微型姿态模块和提供基准的转台的数据,同时计算精度指标。该方法不能保证双方数据的同步,造成了微型姿态模块动态精度测试指标的准确度低,可靠性差。
[0029]如图2所示,为本发明微型姿态模块的动态精度测试系统,包括:
高精度双轴转台(1),实现动态运行规划,为测试系统提供位置、速率、摇摆动态基准,以串行方式输出动态参数;
微型姿态模块(2),由夹具固定在所述的高精度双轴转台(I)上,为飞行器提供实时的加速度、角速度和姿态信息; PC机数据处理模块(4),由PC机和数据处理软件组成,实现数据的接收与存储并完成动态精度指标的解算及输出;
其特征在于,还包括一个数据同步采集板(3),由单片机和接口电路组成;所述的数据同步采集板(3 )在动态测试中采集高精度双轴转台(I)和微型姿态模块(2 )的数据,在所述的单片机中完成数据的同步,同时将此数据以串行方式输出到PC机数据处理模块(4)。该数据同步采集板有效保证了测量工具一高精度双轴转台和被测量物一微型姿态模块数据的高度同步,保证了测量指标的可靠性。
[0030]图3是本发明测试系统的主要信号流程图。其中,所述的微型姿态模块(2)通过第一接口电路(5)与所述的高精度双轴转台(I)串行连接;所述的数据同步采集板(3)通过第二接口电路(6)、第三接口电路(7)分别串行连接到所述的微型姿态模块(2)和高精度双轴转台(I)的输出接口,实现微型姿态模块(2)与高精度双轴转台(I)的同步数据采集;数据同步采集板(3 )通过第四接口电路(8 )串行连接到所述的PC机数据处理模块(4 ),PC机接收并存储所述的同步采集数据,数据处理软件通过对该记录数据的进一步分析,计算微型姿态模块(2)的动态精度指标。
[0031]所述的数据同步采集板(3)的单片机采用STM32F407型ARM处理器。
[0032]所述的第二接口电路(6)和第四接口电路(8)采用RS422接口 MAX490芯片,第三接口电路(7 )采用RS232接 口 MAX232芯片。
[0033]如图4所示,本发明所述的测试方法的具体步骤如下:
步骤一、通过高精度夹具将微型姿态模块(2)固定在高精度双轴转台(I)的内框安装平面上;
步骤二、将数据同步采集板(3)的第二接口电路(6)、第三接口电路(7)分别连接微型姿态模块(2)和高精度双轴转台(I)的输出接口 ;
步骤三、启动微型姿态模块(2)和转台(I)并设置转台内框动态运动条件,设置测试时间并启动测试;
步骤四、启动数据同步采集板(3),实现微型姿态模块(2)和转台(I)的同步数据采集,同时单片机完成数据的粗同步;
步骤五、将粗同步后的数据发送到PC机数据处理模块(4);
步骤六、PC机数据处理模块(4)进行数据的精同步;分析处理存储数据,计算微型姿态模块(2)的动态精度。
[0034]图5是本发明的微型姿态模块与转台数据处理流程图。
[0035]图6是本发明测试系统的数据同步方法,本发明所述的数据同步方法包括数据粗同步和数据精同步。
[0036]所述数据粗同步的过程是:所述的数据同步采集板(3)启动后,单片机处理器延时初始化并启动开机时间,利用同步采集程序将接收到的微型姿态模块(2)和转台(I)的数据分别添加时间标志后,再将添加了时间标志的微型姿态模块(2)和转台(I)数据进行解码、整合并输出给PC机储存。该过程中,单片机内部给高精度双轴转台和微型姿态模块分别添加了时间标志位,并将同一时间标志位的双方的数据打包发出,在发给PC机处理之前,保证了双方数据在源头上的同步性和一致性。
[0037]所述数据精同步的过程是:PC机数据处理模块(4)读取精同步数据,并对添加了时间标志的微型姿态模块(2)的横滚角信息、俯仰角信息数据以及转台(I)的内外框位置信息数据进行拟合;将微型姿态模块横滚角、俯仰角数据小量平移,使微型姿态模块信息的基准与转台输出信息的基准之间的同步性更精确。精同步的过程避免了单片机时钟误差造成的双方数据的不同步,进一步提高了高精度转台和微型姿态模块数据的真实性和同步性,使后续的精度指标计算结果更加准确。
[0038]图7是本发明测试系统的动态精度指标计算方法。在本发明步骤六中,所述的计算微型姿态模块(2)的动态精度的过程是:
用PC机数据处理模块(4)的MATLAB对精同步后的数据进行处理,利用转台(I)静止阶段采集的微型姿态模块(2)数据求平均,得到微型姿态模块(2)的横滚角初始安装误差、俯仰角初始安装误差;扣除安装误差后,对每一时刻的微型姿态模块(2)横滚角和转台(I)内框角求差值,得到该时刻的微型姿态模块(2)横滚角误差;将每一时刻的横滚角误差平方相加再开根即可得到微型姿态模块横滚角动态精度结果。
[0039]本发明通过实验室进行了微型姿态模块进行横滚角、俯仰角动态检测试验,验证了该方法用于测试微型姿态模块动态精度的可行性。如图8 —11所示,是本发明测试系统的微型姿态模块横滚角、俯仰角动态精度测试结果曲线。其中,图8是转台内框角与产品横滚角位置曲线图,图9是横滚角位置误差,图10是转台内框角与产品俯仰角位置曲线图,图11是俯仰角位置误差图。本发明所测得的微型姿态模块横滚角动态精度优于0.75°,俯仰角动态精度优于1.0°。
[0040]本发明的原理是:微型姿态模块动态精度测试要求将微型姿态模块的输出与高精度双轴转台的输出进行对比,因此需要同步采集微型姿态系统和转台的数据。现有技术的精度测试中常用的方法是通过一台电脑的多个串口同时采集两个系统的输出,根据双方的输出频率对数据进行对齐,但该方法的实现过于依赖双方时钟的一致性和精确性,因此无法进行双方时钟的同步。本发明的数据同步采集板可同时采集微型姿态模块数据和高精度转台方位角数据,在内部完成数据转换和合并,通过串口发送至计算机。在该数据采集的过程中,最重要的是保证系统输出和转台输出的同步性,为了达到这一目的,在数据同步采集板内部接收数据时,同时记下数据同步采集板接收到双方数据的时间,并将该时间发送出来。在外部处理数据时,通过该时间将系统输出和转台方位对齐,以减少时间同步带来的精度误差。本发明所使用的数据同步采集板也可扩展多个串口,其单片机处理器可提供精准的时钟,可同时采集多个微型姿态模块的数据,在处理器内部完成数据同步与对齐,实现数据同步采集与发送。本发明的微型姿态模块,是基于MEMS惯性传感器,由DSP微处理器、单轴MEMS加速度计、单轴MEMS陀螺、三维磁传感器组成的集成模块;DSP微处理器对三维磁传感器的输出进行采样,并进行滤波、补偿解算,同时完成微惯性姿态的解算和输出。
[0041 ] 本发明说明书中未作详细描述的内容属于本领域技术人员公知的现有技术。
【主权项】
1.一种微型姿态模块的动态精度测试系统,包括: 高精度双轴转台(1),实现动态运行规划,为测试系统提供位置、速率、摇摆动态基准,以串行方式输出动态参数; 微型姿态模块(2),由夹具固定在所述的高精度双轴转台(I)上,为飞行器提供实时的加速度、角速度和姿态信息; PC机数据处理模块(4),由PC机和数据处理软件组成,实现数据的接收与存储并完成动态精度指标的解算及输出; 其特征在于,还包括一个数据同步采集板(3),由单片机和接口电路组成;所述的数据同步采集板(3 )在动态测试中采集高精度双轴转台(I)和微型姿态模块(2 )的数据,在所述的单片机中完成数据的同步,同时将此数据以串行方式输出到PC机数据处理模块(4)。2.根据权利要求1所述的一种微型姿态模块的动态精度测试系统,其特征在于,所述的微型姿态模块(2)通过第一接口电路(5)与所述的高精度双轴转台(I)串行连接;所述的数据同步采集板(3)通过第二接口电路(6)、第三接口电路(7)分别串行连接到所述的微型姿态模块(2)和高精度双轴转台(I)的输出接口,实现微型姿态模块(2)与高精度双轴转台(O的同步数据采集;数据同步采集板(3)通过第四接口电路(8)串行连接到所述的PC机数据处理模块(4),PC机接收并存储所述的同步采集数据,数据处理软件通过对该记录数据的进一步分析,计算微型姿态模块(2)的动态精度指标。3.根据权利要求1所述的一种微型姿态模块的动态精度测试系统,其特征在于,所述的数据同步采集板(3)的单片机采用STM32F407型ARM处理器。4.根据权利要求2所述的一种微型姿态模块的动态精度测试系统,其特征在于,所述的第二接口电路(6 )和第四接口电路(8 )采用RS422接口 MAX490芯片,第三接口电路(7 )采用RS232接口 MAX232芯片。5.一种采用如权利要求1至4任一项所述系统实施微型姿态模块的动态精度测试的方法,其特征在于,具体步骤如下: 步骤一、通过高精度夹具将微型姿态模块(2)固定在高精度双轴转台(I)的内框安装平面上; 步骤二、将数据同步采集板(3)的第二接口电路(6)、第三接口电路(7)分别连接微型姿态模块(2)和高精度双轴转台(I)的输出接口 ; 步骤三、启动微型姿态模块(2)和转台(I)并设置转台内框动态运动条件,设置测试时间并启动测试; 步骤四、启动数据同步采集板(3),实现微型姿态模块(2)和转台(I)的同步数据采集,同时单片机完成数据的粗同步; 步骤五、将粗同步后的数据发送到PC机数据处理模块(4); 步骤六、PC机数据处理模块(4)进行数据的精同步;分析处理存储数据,计算微型姿态模块(2)的动态精度。6.根据权利要求5所述的一种微型姿态模块的动态精度测试方法,其特征在于,在步骤四中,所述数据粗同步的过程是: 所述的数据同步采集板(3)启动后,单片机处理器延时初始化并启动开机时间,利用同步采集程序将接收到的微型姿态模块(2)和转台(I)的数据分别添加时间标志后,再将添加了时间标志的微型姿态模块(2)和转台(I)数据进行解码、整合并输出给PC机储存。7.根据权利要求5所述的一种微型姿态模块的动态精度测试方法,其特征在于,在步骤六中,所述数据精同步的过程是: PC机数据处理模块(4)读取精同步数据,并对添加了时间标志的微型姿态模块(2)的横滚角信息、俯仰角信息数据以及转台(I)的内外框位置信息数据进行拟合;将微型姿态模块横滚角、俯仰角数据小量平移,使微型姿态模块信息的基准与转台输出信息的基准之间的同步性更精确。8.根据权利要求5所述的一种微型姿态模块的动态精度测试方法,其特征在于,在所述步骤六中,所述的计算微型姿态模块(2)的动态精度的过程是: 用PC机数据处理模块(4)的MATLAB对精同步后的数据进行处理,利用转台(I)静止阶段采集的微型姿态模块(2)数据求平均,得到微型姿态模块(2)的横滚角初始安装误差、俯仰角初始安装误差;扣除安装误差后,对每一时刻的微型姿态模块(2)横滚角和转台(I)内框角求差值,得到该时刻的微型姿态模块(2)横滚角误差;将每一时刻的横滚角误差平方相加再开根即可得到微型姿态模块横滚角动态精度结果。
【专利摘要】本发明公开了一种微型姿态模块的动态精度测试系统及其方法,其主要特点是:在动态测试中,通过数据同步采集板(3)同时采集动态环境下的高精度双轴转台(1)和微型姿态模块(2)的数据,并在数据同步采集板内部完成双方数据的粗同步,同时将高精度双轴转台(1)和微型姿态模块(2)数据打包发送给PC机数据处理模块(4);PC机数据处理模块(4)对双方数据进行精同步,同时计算出微型姿态模块(2)的动态精度指标。该精度测试系统及其方法提出了数据的二次同步方法,克服了现有技术的测试系统及方法中转台和微型姿态模块数据不同步的现象,保证了高精度双轴转台和微型姿态模块数据的同步性和一致性,提高了测试系统的精确性和可靠性。
【IPC分类】G01C25/00
【公开号】CN104897169
【申请号】CN201510056183
【发明人】孔超, 李荣冰, 孙永荣, 刘建业, 常健, 刘浩, 周彬
【申请人】南京航空航天大学
【公开日】2015年9月9日
【申请日】2015年2月3日

最新回复(0)