[发明专利]一种双冗余电动舵机控制系统及方法

说明书

技术领域

本发明涉及高可靠性飞行器的电动舵机控制，具体为一种双冗余电动舵机控制系统及方法。

背景技术

现在的双冗余舵机多为电机为双绕组无刷直流电机驱动型式，控制MCU为单个的结构形式。比如公布号：CN 103279128 A的专利《用于双余度无刷直流电动舵机的滑模控制方法和驱动装置》。这种设计需要对两个绕组进行电流平衡，系统结构复杂，控制算法复杂，存在MCU单点等不足的问题，可靠性较低。

发明内容

针对现有技术中存在的问题，本发明提供一种可靠性高，控制简单，操作方便的双冗余电动舵机控制系统及方法。

本发明是通过以下技术方案来实现：

本发明一种双冗余电动舵机控制系统，包括用于分别对控制舵机的差动周转轮系减速机进行动力输入的第一、二电机，用于采集舵机运动状态的第一位置传感器和第二位置传感器；用于分别接受第一、二位置传感器信号的第一、二数字控制单元；第一、二电机上分别设置第一、二制动器，第一、二制动器分别与第一、二数字控制单元的输出端连接；第一、二数字控制单元分别通过第一、二逆变器向第一、二电机发送控制信号；第一、二逆变器上分别设置第一、二桥路电流传感器，用于向第一、二数字控制单元传输桥路电流采样信号；第一、二数字控制单元分别通过引出CAN总线接口接收控制计算机的打舵指令信号，第一、二数字控制单元之间相互连接通讯互为热备份。

优选的，数字控制单元采用单片机，两个单片机之间的UART互连进行通讯。

优选的，逆变器采用分立的VDMOS组成，由具有电荷泵的桥路集成芯片驱动。

优选的，桥路电流传感器采用霍尔电流传感器。位置传感器采用导电塑料电位器。制动器采用失电制动电磁制动器；电机采用直流有刷电机。

优选的，差动周转轮系减速器的输出端连接丝杠或谐波减速器。

本发明一种基于本发明所述控制系统的双冗余电动舵机控制方法，包括如下步骤，

步骤1，对控制系统进行初始化，判断系统是否由指定的主控单元实现控制；如果是指定的主控单元则执行步骤2，如果不是则禁止备份控制单元输出，然后进行接受主控权前的准备；

步骤2，进行主控单元的故障判断，如果无故障，则主控单元使能输出，执行主控单元的控制算法后重复步骤2；如果有故障则执行步骤3；

步骤3，进行主控单元和备份控制单元的切换，由备份控制单元执行主控权，则备份控制单元使能输出，执行备份控制单元算法后继续由备份控制单元执行主控权。

与现有技术相比，本发明具有以下有益的技术效果：

本发明所述系统通过独立的两个直流有刷电机作为动力源，每个电机可以独立工作，避免了使用双绕组电机的电流平衡处理，使用两个互相通讯的MCU作为主控单元，避免了MCU的单点缺陷；利用全闭环链进行热备份并在全控制回路设置两套装置，大大提高舵机系统的可靠性。通过控制回路和制动器完成对舵机系统制动动作，进行了故障隔离，切断故障的主控回路，平稳切换到热备回路工作，结构简单，设计合理，能够实现主备控制单元的无缝切换。

本发明所述方法，通过主控权的检测保证了主控单元和备份单元的工作衔接，利用故障诊断保证了对舵机的实时稳定控制，利用两路相对独立的控制回路保证舵机工作的稳定可靠，通过各自控制算法的执行，利用制动器实现故障隔离，切断故障的主控回路，平稳切换到热备回路工作；无需电流平衡及能完成对舵机的准确控制，方法简单，操作可靠。

附图说明

图1为本发明实例中所述的双冗余电动舵机控制系统结构图。

图2为本发明实例中所述的双冗余电动舵机控制方法流程图。

图3为本发明实例中所述控制系统中的差动周转轮系减速机结构简图。

具体实施方式

下面结合具体的实施例对本发明做进一步的详细说明，所述是对本发明的解释而不是限定。