[发明专利]惯测组合自标定测控装置及测控方法

摘要

本发明公开了一种惯测组合自标定测控装置，包括转位锁紧机构，该转位锁紧机构包括第一转动轴转位控制电机、第二转动轴转位控制电机、锁紧解锁轴控制电机、第一步进电机驱动器、第二步进电机驱动器、设置在第一转动轴上的第一红外传感器、设置在第二转动轴上的第二红外传感器、设置在锁紧解锁轴上的第三红外传感器、设置在锁紧解锁轴上的行程开关、控制器、二次电源、晶振、存储芯片、磁隔离器、电平转换及驱动器、与惯测组合连接的CAN收发器、计算机、第一切换继电器、第二切换继电器和四个DC/DC隔离电源。本发明在相对较低的成本之下能灵活、可靠、准确并快速的实现惯测组合的自标定测试。

主权项

一种惯测组合自标定测控装置，它包括转位锁紧机构，该转位锁紧机构包括第一转动轴转位控制电机（3）、第二转动轴转位控制电机（4）、锁紧解锁轴控制电机（5）、第一步进电机驱动器（6）、第二步进电机驱动器（7）、设置在第一转动轴上的第一红外传感器（1）、设置在第二转动轴上的第二红外传感器（24）、设置在锁紧解锁轴上的第三红外传感器（9）、设置在锁紧解锁轴上的行程开关（2），其特征在于：它还包括控制器（8）、第一DC/DC隔离电源（10）、第二DC/DC隔离电源（11）、第三DC/DC隔离电源（12）、第四DC/DC隔离电源（13）、二次电源（14）、晶振（15）、存储芯片（16）、磁隔离器（17）、电平转换及驱动器（18）、与惯测组合（19）连接的CAN收发器（20）、计算机（21）、第一切换继电器（22）、第二切换继电器（23）；其中，所述CAN收发器（20）的第一通信端连接计算机（21），CAN收发器（20）的第二通信端通过磁隔离器（17）连接控制器（8）的CAN信号通信端，控制器（8）的输入/输出端口连接电平转换及驱动器（18）的第一输入/输出端口，第一红外传感器（1）、第二红外传感器（24）、第三红外传感器（9）和行程开关（2）的信号输出端分别连接电平转换及驱动器（18）对应的信号输入端，电平转换及驱动器（18）的第一步进电机控制信号输出端连接第一步进电机驱动器（6）的步进电机控制信号输入端，电平转换及驱动器（18）的第二输入/输出端口连接第一切换继电器（22）线圈的一端，电平转换及驱动器（18）的第三输入/输出端口连接第二切换继电器（23）线圈的一端；第一步进电机驱动器（6）的步进电机驱动信号输出端连接第一切换继电器（22）常开触点的一端，第一切换继电器（22）常开触点的另一端连接锁紧解锁轴控制电机（5）的信号输入端，第一步进电机驱动器（6）的步进电机驱动信号输出端连接第二切换继电器（23）常开触点的一端，第二切换继电器（23）常开触点的另一端连接第二转动轴转位控制电机（4）的信号输入端；所述电平转换及驱动器（18）的第二步进电机控制信号输出端连接第二步进电机驱动器（7）的步进电机控制信号输入端，第二步进电机驱动器（7）的步进电机驱动信号输出端连接第一转动轴转位控制电机（3）的信号输入端；所述存储芯片（16）的串行外设接口通信端连接控制器（8）的串行外设接口通信端，晶振（15）的信号输出端连接控制器（8）的时钟信号输入端；所述第一DC/DC隔离电源（10）的供电端分别向第一红外传感器（1）、第二红外传感器（24）、第三红外传感器（9）、行程开关（2）、二次电源（14）、晶振（15）、存储芯片（16）、电平转换及驱动器（18）、磁隔离器（17）的隔离端电源输入端、第一步进电机驱动器（6）的步进电机控制电源输入端、第二步进电机驱动器（7）的步进电机控制电源输入端供电，第一DC/DC隔离电源（10）的供电端还分别与第一切换继电器（22）线圈的另一端及第二切换继电器（23）线圈的另一端连接，二次电源（14）分别向控制器（8）的第一供电端和第二供电端供电；所述电平转换及驱动器（18）的电源切换控制端连接第二DC/DC隔离电源（11）的控制端，第二DC/DC隔离电源（11）的步进电机驱动电源输出端连接第一步进电机驱动器（6）的步进电机驱动电源输入端；所述第三DC/DC隔离电源（12）的步进电机驱动电源输出端连接第二步进电机驱动器（7）的步进电机驱动电源输入端；所述第四DC/DC隔离电源（13）分别向磁隔离器（17）的被隔离端电源和CAN收发器（20）的电源输入端供电。