一种用于单轴旋转调制惯导系统的转位机构的控制方法技术方案

本发明专利技术公开了一种用于单轴旋转调制惯导系统的转位机构的控制方法，方法包括：确定单轴旋转调制惯导系统的调制模式；根据调制模式确定参考角度位置；基于参考角度位置，设置目标角度位置和下次目标角度位置；在转位机构处于旋转状态时，监听导航计算机发送的中断信号，在中断期间，基于目标角度位置、下次目标角度位置、参考角度位置确定转位机构的驱动信息，基于转位机构的当前转动角速度及中断时长，更新目标角度位置和下次目标角度位置；中断结束后，基于驱动信息驱动转位机构。本发明专利技术的方法，在每个中断内计算得到设定目标角度位置以及获取实际角度位置，准确实时计算出PWM值实现IMU按特定规律转动。

【技术实现步骤摘要】

本专利技术涉及惯性导航，具体涉及一种用于单轴旋转调制惯导系统的转位机构的控制方法。

技术介绍

1、捷联惯性导航系统采集陀螺和加速度计数据，通过导航计算机解算出载体的实时速度、位置、姿态、航向等信息，但其误差随时间积累，长时间工作后误差会逐渐发散。因此，对于长航时的应用场合，其导航精度往往不能满足任务需求。在现有的惯性器件成本基础上，采用单轴旋转调制惯导系统可以有效抑制惯性器件的常值偏差造成的误差发散问题，从而提高系统的长时间导航能力，具有结构实现相对简单、可靠性强的优点，在实际得到了广泛的运用。

2、单轴旋转调制惯导系统由imu、导航计算机和转位机构等组成，转位机构包括直流力矩电机、光栅编码器和电机驱动器等。imu安装在转位机构上，导航计算机读取光栅编码器的角位置信息，通过转动规律计算出pwm值，再经由fpga向电机驱动器发送指令，电机驱动器根据指令驱动直流力矩电机转动，实现惯导的单轴旋转调制过程。其中导航计算机如何准确在每个中断内实时计算出pwm值实现imu按特定规律转动是整个系统的关键。

技术实现思路...

【技术保护点】

1.用于单轴旋转调制惯导系统的转位机构的控制方法，其特征在于，包括：

2.如权利要求1所述的方法，其特征在于，所述步骤S3，在中断期间，基于目标角度位置、下次目标角度位置、参考角度位置确定转位机构的驱动信息，包括：

3.如权利要求2所述的方法，其特征在于，所述步骤S3，基于转位机构的当前转动角速度及中断时长，更新目标角度位置和下次目标角度位置，包括：

4.如权利要求3所述的方法，其特征在于，所述步骤S4，所述预设退出条件为所述转位机构计算得到的角度值小于下次目标角度位置和所述目标角度位置差值的绝对值或所述转位机构的当前转动角速度小于预设阈值，其中，所述...

【技术特征摘要】

1.用于单轴旋转调制惯导系统的转位机构的控制方法，其特征在于，包括：

2.如权利要求1所述的方法，其特征在于，所述步骤s3，在中断期间，基于目标角度位置、下次目标角度位置、参考角度位置确定转位机构的驱动信息，包括：

3.如权利要求2所述的方法，其特征在于，所述步骤s3，基于转位机构的当前转动角速度及中断时长，更新目标角度位置和下次目标角度位置，包括：

4.如权利要求3所述的方法，其特征在于，所述步骤s4，所述预设退出条件为所述转位机构计算得到的角度值小于下次目标角度位置和所述目标角度位置差值的绝对值或所述转位机构的当前转动角速度小于预设阈值，其中，所述转位机构计算得到的角度值为所述转位机构的当前转动角速度和本次中断的时长相乘得到的角度值。

5.如权利要求1所述的方法，其特征在于，所述步骤s3还包括：驱动转位机构后，所述转位机构在从静止状态转换到旋转状态过程中，第一阶段为加速运动，在所述第一阶段所述转位机构的转动加速度为设定角...

【专利技术属性】
技术研发人员：韩袁昭，姜校亮，可伟，牛亚辉，黄科，
申请(专利权)人：河北汉光重工有限责任公司，
类型：发明
国别省市：