[发明专利]一种小型电动舵机的控制系统及控制方法

说明书

技术领域

本发明属于伺服控制技术领域，具体涉及一种小型电动舵机的控制系统及控制方法。

背景技术

现有的舵机数字控制器一般包含处理器、驱动电路、隔离电路、信号调理电路、功率驱动电路、H桥逆变电路、总线收发器及DC/DC模块等电路。由于处理器PWM输出端口的驱动能力有限，不能直接驱动光耦，需要增加驱动电路；处理器内部的AD转换精度不高，需要软件补偿或者外扩AD转换器；舵偏角模拟量的输入范围多为正负电压，不能直接接入处理器，需要在前级增加信号调理电路；当控制器驱动舵机的通道数增加时，控制器的体积、重量会增加很多，同时成本也增加较多。

以往舵机数字控制器设计存在体积大、成本高的问题。目前有一些电机控制专用DSP处理器内部AD转换器精度不高，需要软件补偿，不仅增加了软件开销，而且使得数字控制器的实现变得复杂。

发明内容

本发明的目的在于克服上述不足，提供一种小型电动舵机的控制系统及控制方法，充分利用处理器内部资源，结构简单，降低成本。

为了达到上述目的，一种小型电动舵机的控制系统，包括采集舵偏角当前值的MCU处理器，MCU处理器还连接有第一光耦、第二光耦和总线收发器，总线收发器接收舵偏角目标值，第一光耦、第二光耦均连接第一功率驱动器和第二功率驱动器，第一功率驱动器和第二功率驱动器均连接H桥逆变电路，H桥逆变电路输出电机驱动信号，总线收发器、MCU处理器、两个光耦、两个功率驱动器和H桥逆变电路均连接电源。

所述总线收发器、MCU处理器和两个光耦连接第一DC/DC模块，两个光耦和两个功率驱动器连接第二DC/DC模块，第一DC/DC模块和第二DC/DC模块均连接有浪涌抑制及滤波电路，浪涌抑制及滤波电路连接28V电源，第一DC/DC模块输出±5V电源，第二DC/DC模块输出+12V电源，H桥逆变电路连接28V电源。

所述第一DC/DC模块和第二DC/DC模块的型号分别为MSDW1035和MAW01-24S12。

所述MCU处理器的型号为C8051F041。

所述第一光耦和第二光耦的型号为HCPL0531，总线收发器的型号为MAX490。

所述第一功率驱动器和第二功率驱动器的型号均为IR2302S。

一种小型电动舵机的控制系统的控制方法，包括以下步骤：

步骤一：通过MCU处理器采集舵偏角当前值，舵偏角目标值经422总线收发器接入处理器；

步骤二：MCU处理器将舵偏角当前值与目标值进行比较，根据偏差计算控制量输出两路同向PWM信号，同向PWM信号经第一光耦隔离后变为反向PWM信号分别输出给第一功率驱动器和第二功率驱动器；

处理器输出的关断保护信号经第二光耦隔离后输出至第一功率驱动器和第二功率驱动器；

步骤三：第一功率驱动器和第二功率驱动器输出的高、低压侧驱动信号输出给H桥逆变电路；

步骤四：H桥逆变电路输出两路直流电机驱动信号，驱动电机转动，实现对舵面偏转角的控制。

所述MCU处理器为C8051F041，其中24.5MHz晶振频率为系统时钟；内部电源监视器监控电源产生上电及掉电复位；内部1.2V带隙电压基准及两倍增益缓冲放大器输出2.4V参考电压；ADC0电压基准取自DAC0；DAC1输出1.2V电压作为高压差分放大器HVDA的参考电压；HVDA的增益为0.5；ADC0内部放大器增益为1；交叉开关将UART0的TX和RX引脚分配到P0.0和P0.1，脉宽调制信号PWM1和PWM2引脚分配到P0.2和P0.3；P0.6为数字输出端口，并将所有输出引脚配置成推挽方式。

所述步骤二中，MCU处理器工作流程如下，启动AD转换器采用查询方式读取舵偏角当前值，连采5次，去掉最大和最小值，中间3个值取平均，作为当前舵偏值；根据角度偏差计算控制量，更新PWM输出信号的占空比；延迟500us，再启动AD获取当前舵偏角，计算控制量，更新PWM占空比。