[发明专利]一种基于转位寻北技术的抗扰动快速寻北仪及其寻北方法

说明书

技术领域

本发明涉及一种寻北仪，特别是涉及一种用于车载定向的高精度快速寻北仪及其寻北方法。

背景技术

传统陀螺寻北技术是依靠惯性元件在静止条件下感应地球自转角速率水平分量完成寻北功能，它通常最多需要二轴挠性陀螺和二轴加速度计，且无抗扰动寻北能力。然而，由于仪表误差等测量因素，其测量误差为216″，测量时间为5分钟，难以满足应用于测绘、矿山、隧道、军事、航空、航天等领域的高精度需求，特别在军用车载导弹定位寻北装置中，即国内武器系统、各型战车和运载器中。快速、准确、抗扰动的寻北成为行业内的研究课题。

中国实用新型专利高精度陀螺寻北仪，申请号为201420205532.4，申请日期为2014年4月25日，为一种通过精确地将一种陀螺指北针前后旋转一个准确的180°后，通过计算测量一个较为精确的寻北值。然而其对于旋转180°的高精度定位，则对测量器材的材料和使用寿命有较高的要求，使用几个月即需要更换旋转限位装置才能在往复的转动过程中达到一个准确的180°定位。其为延长使用寿命，特在两个限位块之间加装双U形弹簧来延长使用寿命，但也只能延长数月。

发明内容

本发明要解决的技术问题是提供一种结构简单、测量误差小、测量时间短、不怕外界扰动、使用寿命长的一种基于转位寻北技术的抗扰动快速寻北仪及其寻北方法。

本发明一种基于转位寻北技术的抗扰动快速寻北仪，包括底座和转位装置，所述底座与转位装置的定子固定连接，所述转位装置的定子的前后两端设有限位座，转位装置的转子设有与限位座相配合的限位块，限位块和限位座用于将定位转子相对定子前后旋转180°，还包括三轴IMU组件、I/F板和主控板，所述三轴IMU组件固定在转位装置的转子上，三轴IMU组件是由三轴激光陀螺和三轴加速度计构成，所述三轴激光陀螺用于测量底座的角速度，所述三轴加速度计用于测量底座的加速度，三轴加速度计将电流信号传递给I/F板，所述I/F板用于将三轴加速度计输出的电流信号转换成频率信号，I/F板将频率信号传递给主控板，三轴激光陀螺将频率信号传递给主控板，所述主控板采用了DSP+FPGA架构，主控板用于完成寻北指令接收、转位寻北算法的计算、数据采集和外设控制。

本发明一种基于转位寻北技术的抗扰动快速寻北仪，其中所述底座上固定有驱动板。所述驱动板用于接收IMU组件的信号，驱动板通过闭环PID控制算法生产PWM方波控制电机转动。

本发明一种基于转位寻北技术的抗扰动快速寻北仪，其中所述底座为长方体形状，转位装置为圆柱体形状。

本发明一种使用基于转位寻北技术的抗扰动快速寻北仪的寻北方法，其中包括如下步骤：

A)、主控板接收寻北指令；

B)、主控板下达控制信号到转位装置，转位装置控制IMU组件在13秒内，即0～13秒时从0°转向180°位置，并在转动过程中全程采集IMU组件的加速度和角速度数据；

C)、主控板在13～88秒时采集180°位置的三轴IMU组件的加速度和角速度，并计算出IMU组件姿态角、线速度和位置；

D)、主控板下达控制信号到转位装置，转位装置控制IMU组件在88～101秒时，从180°转向0°位置，并在转动过程中全程采集IMU组件的加速度和角速度数据，并进行卡尔曼Kalman滤波计算；

E)、主控板在101～176秒时采集0°位置的三轴IMU组件的加速度和角速度，并计算出IMU组件姿态角、线速度和位置，再进行卡尔曼Kalman滤波计算；

F)、主控板将卡尔曼Kalman滤波计算的结果(即寻北结果)向外输出，完成寻北。

本发明一种基于转位寻北技术的抗扰动快速寻北仪与现有技术不同之处在于本发明一种基于转位寻北技术的抗扰动快速寻北仪将二轴IMU组件改为三轴IMU组件进行寻北，因数据采集更加丰富，因此通过计算可对寻北定位更加准确快速，并且通过主控板的算法还能抵抗外界的扰动(如车的震动、晃动、大风扰动)，从而减少测量误差。

本发明一种基于转位寻北技术的抗扰动快速寻北仪中驱动板根据主控板的信号控制电机转动，实现转位装置的平稳转动。

本发明一种基于转位寻北技术的抗扰动快速寻北仪中因为寻北仪是要安装在长方形凹槽或长方形平台上，所以为了合理利用安装处的形状，故寻北仪的底座为长方体形状，因转位装置需要转动，故为了合理利用空间并且减轻重量，则转位装置为圆柱体形状。