[实用新型]数字化舵机控制器

说明书

技术领域

本实用新型涉及飞行器控制领域，具体涉及舵机控制器。

背景技术

随着飞行器速度、飞行高度和机动性的不断增加，电动舵系统必然要向快速响应、能在高空条件下可靠工作、实现精确控制的方向发展。已有的电动舵系统的控制电路主要采用模拟电路，电路体积较大、很难采用先进的控制算法、因元器件参数变化控制电路长时间工作后还会导致性能变差。相反，采用数字控制方式却不存在这些问题，因此，电动舵系统的全数字化是今后的重点发展方向。目前，由于DSP技术快速发展，一些高速、专用电机控制高速数据处理器(DSP)的出现，为电动舵系统的数字化控制奠定了基础，使得长期以来构建在现代控制理论或其它一些复杂控制算法基础上的控制理论能够实用化。

在由DSP直接控制直流无刷电机时，对于每一个无刷电机，需要6路PWM信号，这样，由于DSP输出端口个数有限，一个DSP只能控制2个无刷电机，要同时控制4个无刷电机，就需增加一个DSP，这样2个DSP之间还需要通讯，导致硬件及软件结构复杂，方案不优。

发明内容

本实用新型目的在于设计数字化舵机控制器，使用1个DSP来控制4个以及更多无刷电机，用于多种采用永磁无刷直流伺服电机的舵机控制。

本实用新型是一种数字化舵机控制器，包括：CPU处理器，对于无刷电机进行控制，实现舵机控制，其中：对于1个无刷电机，CPU处理器输出1路PWM信号，通过逻辑电路进行扩展，得到无刷电机的6路控制信号；逻辑电路表达式如下所述：

其中，A：A相霍尔信号；B：B相霍尔信号；C：C相霍尔信号；来自无刷电机；

ENABLE：使能控制信号；

PWM1、PWM2、PWM3、PWM4、PWM5、PWM6：无刷电机6路控制信号。

如上所述的一种数字化舵机控制器，其中，所述CPU处理器为DSP，逻辑电路由CPLD芯片实现。

如上所述的一种数字化舵机控制器，其中：所述的CPLD采用Altem公司MAX7000。

本实用新型的优点在于：采用DSP+CPLD结构，完成对舵机的直接控制。通常，无刷电机的数字控制是根据霍尔信号状态在软件中查询正、反转的2个换相表来实现无刷电机的正、反转控制，当4个舵机同时控制时，软件相对复杂。本方案中利用CPLD，结合PWM信号扩展实现无刷电机的硬件换相，同时方案中无需考虑电机的正、反转，因此，软件设计只需考虑算法，结构合理，并且可完全实现无刷电机与有刷电机控制的软件兼容。

附图说明

图1是系统总体数字控制电路功能结构框图；

图2是通过CPLD扩展实现的逻辑电路结构图。

具体实施方式

下面结合附图和实施例对本实用新型进行进一步描述。

以下结合附图说明和具体实施例对本实用新型做进一步的说明；DSP的外设资源有限，一个DSP只能控制2个无刷电机，要同时控制4个无刷电机，就需增加一个DSP,这样2个DSP之间还需要通讯，导致硬件及软件结构复杂，方案不优。针对此种情况，本实用新型设计了DSP+CPLD方案，通过CPLD扩展DSP的外设资源，使得一个DSP能够满足同时控制4个及以上无刷电机的资源要求，优化了系统的方案。

本实用新型控制器采用DSP+CPLD结构，对外通讯采用1553B总线，控制算法采用基于控制对象特性的非线性PID，很好的实现了对大功率电动舵机的数字控制。

如图1所示，系统总体数字控制电路主要由以下几部分组成：

CPU单元：主要完成数据通信以及数据处理、控制规律解算、控制量输出以及控制参数的上传与存储，包括DSP处理器、外围时钟电路以及参数存储电路；

CPLD扩展单元：采用Altera公司MAX7000系列可编程逻辑芯片，主要完成PWM波形扩展、复位控制以及其它模块的控制逻辑处理；

AD采样单元：完成4个舵回路反馈信息采集，设计采用2片AD7656芯片，实现12路模拟电压采集，输入信号范围±5V，数据传输采用并口模式；

1553B总线通信单元：与上位机通信采用1553B数据总线，通信速率4Mbps，电路组成为1个总线控制器、2个隔离变压器和1个时钟电路；

供电单元：实现对电路板各部分供电，提供电源包括数字体系的+5V、+3.3V、+1.8V,模拟体系的+15V、-15V、+5V以及+2.5V。