捷联惯性设备的低成本速率闭环转位控制方法及控制装置的制造方法
【技术领域】
[0001]本发明涉及一种捷联惯性设备的自动控制方法及控制装置，特别是涉及一种捷联惯性设备的定位定向信号的自动控制方法及控制装置。
【背景技术】
[0002]在捷联式惯性导航设备中，通常包括东、北、天向陀螺仪及相应加速计，为消除惯性器件(陀螺、加速度计)的零偏对导航参数的影响，常采用转位对偶测量的方式，承载惯性器件的转位机构的位置精度、转位时间等是影响初始对准性能的主要因素。一般来说，上述转位机构采用两种方案，一种是开环控制方案，其位置精度靠机械定位保证，转位机构包括力矩电机和位于0°和180°的两个限位挡块；通过控制力矩电机转动速率实现高速转位，通过限位挡块使转位到位，通过力矩电机的堵转率判断转位到位。开环控制的优势是结构简单、成本低，但由于控制过程中无反馈量，力矩电机高速转动容易造成对机械限位的撞击，引起机械限位精度的降低，进而影响寻北精度。
[0003]另外一种是闭环控制方案，其位置精度靠闭环回路中的角度传感器精度以及主控板中的控制算法保证，角度传感器适时反馈转位角度，主控板适时调整转动速率。闭环控制方案一般控制稳定性高、精度高，但需要较昂贵的位置反馈元件，制造成本的和调试时间成本都会增加，整体可靠性有所下降。
[0004]如何实现带转位机构的捷联导航设备中低成本、高精度的转位控制方案，对于批量生产产品的寻北精度尤为重要。
【发明内容】
[0005]本发明的目的是提供一种捷联惯性设备的低成本速率闭环转位控制方法，解决现有转位机构的控制过程中硬件结构、反馈元件成本与控制精度无法有效协调的技术问题。
[0006]本发明的另一个目的是提供一种用于捷联惯性设备的低成本速率闭环转位的控制装置，解决转位机构转动过程中多类型反馈信号不易及时处理的技术问题。
[0007]本发明的捷联惯性设备的低成本速率闭环转位控制方法，包括以下步骤:
[0008]驱动板接收主控板的使能控制信号、方向控制信号后，利用功率放大器生成功率信号驱动力矩电机带动转位机构转动，转向目标方向；转向过程中驱动板将天向陀螺测量的角速率变化信息发送给驱动板实现转动速率控制，在转向至相应行程开关触发位置时，执行速率切换，按照预设的角速度转动，靠紧限位挡块。
[0009]还包括以下步骤:
[0010]步骤51、主控板、驱动板、功率放大器初始化，天向陀螺初始化，力矩电机初始化，
第一行程开关接近0°位置设置，第二行程开关接近180°位置设置，各行程开关加电处于打开状态；
[0011]步骤52、主控板持续采集天向陀螺数据，预处理后发送给驱动板；
[0012]步骤53、主控板接收指令确定转位机构转向位置；
[0013]还包括以下步骤:
[0014]步骤54、主控板向驱动板发送使能控制信号、方向控制信号；
[0015]步骤55、判断是否自180°转向0°位置，是则执行步骤63，否则执行步骤56 ；
[0016]步骤63、驱动板根据控制逻辑生成PffM数据，经功率放大器生成功率信号驱动力矩电机带动转位机构转动；
[0017]步骤64、驱动板接收天向陀螺数据，根据PID策略I调整速率控制信号，驱动板将控制信号转换为PWM数据，经功率放大器生成功率信号驱动力矩电机转动；
[0018]步骤65、判断是否达到第一行程开关触发位置，否则执行步骤64，是则执行步骤66 ；
[0019]步骤66、驱动板根据PID策略2形成实时PffM数据，经功率放大器生成功率信号驱动力矩电机减速转动；
[0020]步骤67、转位机构与180°限位挡块靠紧，力矩电机堵转，等待后续指令或执行步骤68 ；
[0021]步骤68、转位结束。
[0022]还包括以下步骤:
[0023]步骤54、主控板向驱动板发送使能控制信号、方向控制信号；
[0024]步骤56、判断是否自0°转向180°位置，是则执行步骤57，否则执行步骤54 ;
[0025]步骤57、驱动板根据控制逻辑生成PffM数据，经功率放大器生成功率信号驱动力矩电机带动转位机构转动；
[0026]步骤58、驱动板接收天向陀螺数据，根据PID策略I调整速率控制信号，驱动板将控制信号转换为PWM数据，经功率放大器生成功率信号驱动力矩电机提速转动；
[0027]步骤59、判断是否达到第二行程开关触发位置？否则执行步骤58，是则执行步骤60 ；
[0028]步骤60、驱动板根据PID策略2形成实时PffM数据，经功率放大器生成功率信号驱动力矩电机减速转动；
[0029]步骤61、转位机构与180°限位挡块靠紧，力矩电机堵转，等待后续指令或执行步骤68。
[0030]还包括以下步骤:
[0031]本控制方法中的PID策略I形成以下控制参数:
[0032]相应行程开关触发前，以45° /s的角速率转向目标位置；
[0033]本控制方法中的PID策略2形成以下控制参数:
[0034]相应行程开关触发后，以20° /s的角速率转向目标位置；
[0035]转位机构与相应限位挡块靠紧角速率小于0.1° /s时，位置靠紧，力矩电机堵转。
[0036]用于捷联惯性设备的低成本速率闭环转位的控制装置，包括:
[0037]主控板用于生成控制转位装置的使能控制信号、方向控制信号和，接收天向陀螺反馈的转速信号，预处理后转发给驱动板；
[0038]驱动板用于接收转速信号，采集行程开关的触发信号，根据控制逻辑形成修正速率的PffM控制信号；
[0039]功率放大器用于将接收的控制信号转换为相应的功率信号并输出；
[0040]力矩电机用于接收功率信号，带动承载惯性器件的转位机构完成相应速率的转动，与限位挡块配合，保持安全的堵转；
[0041]天向陀螺用于向主控板实时反馈同轴向转动的承载惯性器件的力矩电机转动速率;
[0042]行程开关用于向主控板反馈力矩电机转动过程中的单一确定角度。
[0043]行程开关包括第一行程开关和第二行程开关，第一行程开关用于在接近0°的转动位置提供触发信号；第二行程开关用于在接近180°的转动位置提供触发信号；
[0044]主控板通过其第一数据端口与天向陀螺的数据输出端口连接，主控板通过其第二数据端口与驱动板的第一数据端口连接，驱动板通过其第二数据端口与功率放大器的数据输入端口连接，功率放大器的信号输出端口与力矩电机的信号输入端口连接，第一行程开关和第二行程开关的信号输出端分别连接驱动板的相应信号输入端。模拟信号和功率表信号的传输主要采用信号端口。
[0045]本发明的捷联惯性设备的低成本速率闭环转位控制方法，不需要引入专门角位置传感器，而是利用捷联惯性设备中的转位轴向陀螺作为反馈元件，在以机械限位保证精度的开环转位机构方案基础上实现简易、低成本闭环控制的方案。从而简化了系统结构、提高了转位控制精度和平稳性、节约了系统成本。
[0046]本发明的低成本速率反馈闭环转位控制系统主要由控制板、驱动板、限位的行程开关、捷联惯组的天向陀螺、力矩电机构成。接收到转位控制指令后，闭环控制算法以最大角速率转向目标位置，此时闭环控制系统由捷联惯组的天向陀螺作为角速率传感器，与驱动板中的数字控制算法、PID策略配合力矩电机构成速率闭环控制，转位过程中，转位机构受速率闭环控制算法的控制，其转动角速率始终稳定在固定误差范围内。当转位机构接近目标位置时，行程开关闭合，表示转位机构即将到达目标位置，此时速率闭环控制回路将转位速率转换为小速率转位模式，防止转位机构撞击机械限位挡块。
【附图说明】
[0047]图1为本发明捷联惯性设备的低成本速率闭环转位控制方法的信号反馈示意图；
[0048]图2为本发明捷联惯性设备的低成本速率闭环转位控制装置的连接结构示意图；
[0049]图3为本发明捷联惯性设备的低成本速率闭环转位控制方法的主要控制流程图。
【具体实施方式】
[0050]下面结合附图对本发明的【具体实施方式】进行详细说明。
[0051]如图1所示，本实施例中的主控板01用于生成控制力矩电机的使能控制信号、方向控制信号，接收天向陀螺反馈的转速信号，预处理后转发给驱动板；
[0052]驱动板12用于接收转速信号，采集行程开关的触发信号，根据控制逻辑形成修正速率的PffM控制信号；
[0053]功率放大器13用于将接收的控制信号转换为相应的功率信号并输出；
[0054]力矩电机02用于接收功率信号，带动承载惯性器件的转位机构完成相应速率的转动，与限位挡块配合，保持安全的堵转；
[0055]天向陀螺03用于向主控板OI实时反馈同轴向转动的承载惯性器件的力矩电机02转动速率；
[0056]行程开关04用于向主控板01反馈力矩电机02转动过程中的单一确定角度。
[0057]主控板01根据将天向陀螺03实时反馈的速率信号传送至驱动板，驱动板根据控制策略与功率放大器13配合，相应调整力矩电机02速率控制信号，保证转位机构实现最短的转位时长；驱动板根据行程开关04在单一确定角度形成的触发信号，结合控制策略实现速率切换，相应调整力矩电机02速率控制信号，保证转位机构平稳的与限位挡块靠近，保持到位。
[0058]本实施例的速率闭环转位控制方法，可以利用天向陀螺03的转动速率反馈在转动初始提供较高的转动速率，根据转动行程调高转动速率，满足高速转位过程，提高寻北精度。同时还可以利用行程开关04触发信号启动转动速率下降控制，快速控制转动速率下降，提高可靠性，满足转位到位时与限位挡块的稳定停靠，保证机械结构的高可用性。
[0059]如图2所示，本实施例的具体电路中包括第一行程开关41和第二行程开关42，第一行程开关41用于在接近0°的转动位置提供触发信号；第二行程开关42用于在接近180°的转动位置提供触发信号；
[0060]主控板01通过其第一数据端口与天向陀螺03的数据输出端口连接，主控板01通过其第二数据端口与驱动板12的第一数据端口连接，驱动板12通过其第二数据端口与功率放大器13的数据输入端口连接，功率放大器13的信号输出端口与力矩电机02的信号输入端口连接，第一行程开关41和第二行程开关42的信号输出端分别连接驱动板12的相应信号输入端。模拟信号和功率表信号的传输主要采用信号端口。
[0061]本实施例中主控板01采用TI 6700系列DSP芯片，驱动板12采用C8051F系列单片机，功率放大器13采用LMD18245芯片。
[0062]驱动板12接收主控板01的使能控制信号、方向控制信号后，利用功率放大器13生成功率信号驱动力矩电机02带动转位机构转动，转向目标方向；转向过程中主控板01将