四余度舵机电流均衡控制装置及电流均衡方法
【专利摘要】本发明属于航空飞行器飞行控制技术，涉及一种四余度舵机电流均衡控制装置及电流均衡方法。控制装置由第一DSP控制器(1)、第二DSP控制器(2)、第一路功放电路(3)、第二路功放电路(4)、第三路功放电路(5)、第四路功放电路(6)、第一电机位置传感器(7)、电机Ⅰ(8)、舵机位置传感器(9)、电机Ⅱ(10)、第二电机位置传感器(11)和输出机构(12)组成。本发明大大提高了舵机系统工作的可靠性，保证了飞行安全。
【专利说明】四余度舵机电流均衡控制装置及电流均衡方法
【技术领域】
[0001]本发明属于航空飞行器飞行控制技术，涉及一种四余度舵机电流均衡控制装置及电流均衡方法。
【背景技术】
[0002]当前直升机飞控系统发展的重点是提高直升机的敏捷性和大机动能力，以电传方式作为飞行控制系统的基础，极大的方便于主动控制功能的应用，使飞机操纵响应迅速并能精准控制。现有的电传飞行控制系统，毫无例外的采用了多余度配置方式，操纵控制执行系统采用多余度技术可实现高可靠、高精度、大力矩和宽频响，可以提高直升机飞控系统操纵的稳定性、快速性和可靠性。伺服作动器作为飞机的要害部件，其余度配制等级可以认定为系统的基本余度等级。国际上已经利用先进水平的多余度技术完成直升机操纵四余度舵机位置伺服系统研究，但是具体的技术内容并未公开。国内现有的航空飞行控制系统普遍采用单通道舵回路，一旦出现故障，就失去对舵面的操纵，而且单通道舵回路可靠性低，严重影响飞行安全。
【发明内容】
[0003]本发明的目的在于克服上述现有技术的缺点，提供一种四余度舵机电流均衡控制装置及电流均衡方法，其能够以提高舵机系统工作的可靠性，保证飞行安全。
[0004]本发明的目的是通过以下技术方案来实现的:
[0005]四余度舵机电流均衡控制装置，其特征在于，它由第一 DSP控制器1、第二 DSP控制器2、第一路功放电路3、第二路功放电路4、第三路功放电路5、第四路功放电路6、第一电机位置传感器7、电机工8、舵机位置传感器9、电机II 10、第二电机位置传感器11和输出机构12组成；舵机位置指令《I分别与第一 DSP控制器11和第二 DSP控制器2的相应输入端连接，第一 DSP控制器I和第二 DSP控制器2通过总线连接，第一路功放电路3和第二路功放电路4的输入端分别与第一 DSP控制器I相应的I / O接口连接，其输出端分别与电机18的相应输入端连接，电机18的输出轴与输出机构12机械连接；第三路功放电路5和第四路功放电路6的输入端分别与第二 DSP控制器2相应的I / O接口连接，其输出端分别与电机II 10的相应输入端连接，电机II 10的输出轴与输出机构12机械连接；安装在电机18上的第一电机位置传感器7的输出端与第一 DSP控制器I的相应输入端连接，安装在电机II 10上的第二电机位置传感器11的输出端与第二 DSP控制器2的相应输入端连接；安装在输出机构12上的舵机位置传感器9分别与第一 DSP控制器I和第二 DSP控制器2的相应输入端连接。
[0006]如上面所述的四余度舵机电流均衡控制装置的电流均衡控制方法，其特征在于，控制步骤如下:
[0007]1、预置电流差值门限；该门限电流i为四余度舵机满功率状态电流值I的0.5%?1%;[0008]2、功放电路的输出电流交叉互比；接通电源后，首先由第一 DSP控制器I比较第一路功放电路3和第二路功放电路4的输出电流数值大小，由第二 DSP控制器2比较第三路功放电路5和第四路功放电路6的输出电流数值大小；然后由第一 DSP控制器I和第二DSP控制器2将第一路功放电路3和第二路功放电路4与第三路功放电路5和第四路功放电路6的输出电流数值大小进行比较；
[0009]3、表决；从步骤2.2的比较结果出挑出差值最大的电流值Λ i,将Λ i与门限电流i进行比较，若Λ i〈i，则视为四路电流均衡；若八i > i,则视为电流不均衡，确认电流最大值所在的功放电路序号A，该功放电路的输出电流为i。-，该功放电路的输入信号为iinA;
[0010]4、电流均衡处理；将除去A路功放电路以外的其他三路功放电路的电流值进行运算，求出三路电流的均方根值I1，然后按下式计算修正信号i2:
_] i2=iinA+ (i1-10utA> ；
[0012]令i2取代A路功放原来的输入信号iinA ;
[0013]5、重复步骤2?步骤4，直到四路电流均衡为止。
[0014]本发明的四余度舵机电流均衡控制装置及电流均衡方法大大提高了舵机系统工作的可靠性，保证了飞行安全。
【专利附图】
【附图说明】
[0015]图1是本发明四余度舵机电流均衡控制装置的结构原理图。
【具体实施方式】
[0016]下面对本发明做进一步详细说明。参见图1，四余度舵机电流均衡控制装置，其特征在于，它由第一 DSP控制器1、第二 DSP控制器2、第一路功放电路3、第二路功放电路4、第三路功放电路5、第四路功放电路6、第一电机位置传感器7、电机工8、舵机位置传感器9、电机II 10、第二电机位置传感器11和输出机构12组成；舵机位置指令wl分别与第一 DSP控制器11和第二 DSP控制器2的相应输入端连接，第一 DSP控制器I和第二 DSP控制器2通过总线连接，第一路功放电路3和第二路功放电路4的输入端分别与第一 DSP控制器I相应的I / O接口连接，其输出端分别与电机18的相应输入端连接，电机18的输出轴与输出机构12机械连接；第三路功放电路5和第四路功放电路6的输入端分别与第二 DSP控制器2相应的I / O接口连接，其输出端分别与电机II 10的相应输入端连接，电机II 10的输出轴与输出机构12机械连接；安装在电机18上的第一电机位置传感器7的输出端与第一DSP控制器I的相应输入端连接，安装在电机II 10上的第二电机位置传感器11的输出端与第二 DSP控制器2的相应输入端连接；安装在输出机构12上的舵机位置传感器9分别与第一 DSP控制器I和第二 DSP控制器2的相应输入端连接。
[0017]如上面所述的四余度舵机电流均衡控制装置的电流均衡控制方法，其特征在于，控制步骤如下:
[0018]1、预置电流差值门限；该门限电流i为四余度舵机满功率状态电流值I的0.5%?1%;
[0019]2、功放电路的输出电流交叉互比；接通电源后，首先由第一 DSP控制器I比较第一路功放电路3和第二路功放电路4的输出电流数值大小，由第二 DSP控制器2比较第三路功放电路5和第四路功放电路6的输出电流数值大小；然后由第一 DSP控制器I和第二DSP控制器2将第一路功放电路3和第二路功放电路4与第三路功放电路5和第四路功放电路6的输出电流数值大小进行比较；
[0020]3、表决；从步骤2.2的比较结果出挑出差值最大的电流值Λ i,将Λ i与门限电流i进行比较，若Λ i〈i，则视为四路电流均衡；若八i > i,则视为电流不均衡，确认电流最大值所在的功放电路序号A，该功放电路的输出电流为i。-，该功放电路的输入信号为iinA;
[0021]4、电流均衡处理；将除去A路功放电路以外的其他三路功放电路的电流值进行运算，求出三路电流的均方根值I1，然后按下式计算修正信号i2:
[0022]i2=iinA+ (i1-10utA> ；
[0023]令i2取代A路功放原来的输入信号iinA ;
[0024]5、重复步骤2?步骤4，直到四路电流均衡为止。
[0025]在本发明的一个实施例中，第一 DSP控制器I和第二 DSP控制器2采用数字信号处理器TMS320F2812，它集成度高、运算能力强，并且两组六路PWM能够满足两套电机绕组控制及电流均衡的快速性能要求。所采用的功放电路、电机位置传感器、电机、舵机位置传感器都是现有的成品。门限电流i为四余度舵机满功率状态电流值I的0.6 %。
【权利要求】
1.四余度舵机电流均衡控制装置，其特征在于，它由第一DSP控制器(I)、第二 DSP控制器⑵、第一路功放电路(3)、第二路功放电路(4)、第三路功放电路(5)、第四路功放电路(6)、第一电机位置传感器(7)、电机工(8)、舵机位置传感器(9)、电机II (10)、第二电机位置传感器(11)和输出机构(12)组成；舵机位置指令wl分别与第一 DSP控制器(11)和第二 DSP控制器(2)的相应输入端连接，第一 DSP控制器(I)和第二 DSP控制器(2)通过总线连接，第一路功放电路(3)和第二路功放电路(4)的输入端分别与第一 DSP控制器(I)相应的I / O接口连接，其输出端分别与电机I⑶的相应输入端连接，电机I⑶的输出轴与输出机构(12)机械连接；第三路功放电路(5)和第四路功放电路(6)的输入端分别与第二 DSP控制器(2)相应的I / O接口连接，其输出端分别与电机II (10)的相应输入端连接，电机II (10)的输出轴与输出机构(12)机械连接；安装在电机I (8)上的第一电机位置传感器(X)的输出端与第一 DSP控制器(I)的相应输入端连接,安装在电机II (10)上的第二电机位置传感器(11)的输出端与第二DSP控制器(2)的相应输入端连接；安装在输出机构(12)上的舵机位置传感器(9)分别与第一 DSP控制器(I)和第二 DSP控制器(2)的相应输入端连接。
2.如权利要求1所述的四余度舵机电流均衡控制装置的电流均衡控制方法，其特征在于，控制步骤如下: 2.1、预置电流差值门限；该门限电流i为四余度舵机满功率状态电流值I的0.5%~1% ； 2.2、功放电路的输出电流交叉互比；接通电源后，首先由第一DSP控制器(I)比较第一路功放电路⑶和第二路功放电路⑷的输出电流数值大小，由第二 DSP控制器⑵比较第三路功放电 路(5)和第四路功放电路(6)的输出电流数值大小；然后由第一 DSP控制器(I)和第二 DSP控制器(2)将第一路功放电路(3)和第二路功放电路(4)与第三路功放电路(5)和第四路功放电路(6)的输出电流数值大小进行比较； 2.3、表决；从步骤2.2的比较结果出挑出差值最大的电流值Λ i,将Λ i与门限电流i进行比较，若Λ i〈i，则视为四路电流均衡；若八i > i,则视为电流不均衡，确认电流最大值所在的功放电路序号A，该功放电路的输出电流为i。-，该功放电路的输入信号为iinA ； 2.4、电流均衡处理；将除去A路功放电路以外的其他三路功放电路的电流值进行运算，求出三路电流的均方根值I1，然后按下式计算修正信号i2:
?2_--ηΑ+ (ifioutA); 令i2取代A路功放原来的输入信号iinA ； 2.5、重复步骤2.2~步骤2.4，直到四路电流均衡为止。
【文档编号】B64C13/50GK103879552SQ201410081656
【公开日】2014年6月25日 申请日期:2014年3月6日 优先权日:2014年3月6日
【发明者】郭华 申请人:西安邮电大学