一种小型电动舵机的控制系统及控制方法技术方案

本发明专利技术公开了一种小型电动舵机的控制系统及控制方法，处理器接收舵偏角目标值，并采集舵偏角当前值，根据偏差计算控制量输出PWM，经功率电路放大后驱动电机转动，实现对舵面偏转角的随动控制，并通过总线上传舵偏角当前值。本发明专利技术通过采用高集成度的MCU处理器，充分利用其内部资源，只需少量的外围电路，就能实现对舵面偏转角度的随动控制，本发明专利技术采用高集成度MCU处理器加H桥逆变电路的实现方法，只需少量外围器件，简单有效的实现了对舵面偏转角的随动控制，具有体积小、重量轻、低成本、易实现等优点，本发明专利技术是一种通用直流伺服控制驱动电路，可满足一般小功率舵机控制驱动器的需求。

【技术实现步骤摘要】
一种小型电动舵机的控制系统及控制方法
本专利技术属于伺服控制
，具体涉及一种小型电动舵机的控制系统及控制方法。
技术介绍
现有的舵机数字控制器一般包含处理器、驱动电路、隔离电路、信号调理电路、功率驱动电路、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占空比。与现有技术相比，本专利技术MCU处理器输出的PWM信号及关断保护信号经光耦隔离后送给两个功率驱动器，两个功率驱动器将信号发送给H桥逆变电路，H桥逆变电路输出两路直流电机驱动信号，驱动电机转动，实现对舵面偏转角的控制，通过采用高集成度的MCU处理器，充分利用其内部资源，只需少量的外围电路，就能实现对舵面偏转角度的随动控制，本专利技术采用高集成度MCU处理器加H桥逆变电路的实现方法，只需少量外围器件，简单有效的实现了对舵面偏转角的随动控制，具有体积小、重量轻、低成本、易实现等优点，本专利技术是一种通用直流伺服控制驱动电路，可满足一般小功率舵机控制驱动器的需求。附图说明图1为专利技术的系统框图。具体实施方式下面结合附图对本专利技术做进一步说明。参见图1，一种小型电动舵机的控制系统，包括采集舵偏角当前值的MCU处理器，MCU处理器还连接有第一光耦、第二光耦和总线收发器，总线收发器接收舵偏角目标值，第一光耦、第二光耦均连接第一功率驱动器和第二功率驱动器，第一功率驱动器和第二功率驱动器均连接H桥逆变电路，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占空比。选用高集成度处理器：处理器选型从主本文档来自技高网...

【技术保护点】
一种小型电动舵机的控制系统，其特征在于：包括采集舵偏角当前值的MCU处理器，MCU处理器还连接有第一光耦、第二光耦和总线收发器，总线收发器接收舵偏角目标值，第一光耦、第二光耦均连接第一功率驱动器和第二功率驱动器，第一功率驱动器和第二功率驱动器均连接H桥逆变电路，H桥逆变电路输出电机驱动信号，总线收发器、MCU处理器、两个光耦、两个功率驱动器和H桥逆变电路均连接电源。

【技术特征摘要】
1.一种小型电动舵机的控制系统，其特征在于：包括采集舵偏角当前值的MCU处理器，MCU处理器还连接有第一光耦、第二光耦和总线收发器，总线收发器接收舵偏角目标值，第一光耦、第二光耦均连接第一功率驱动器和第二功率驱动器，第一功率驱动器和第二功率驱动器均连接H桥逆变电路，H桥逆变电路输出电机驱动信号，总线收发器、MCU处理器、两个光耦、两个功率驱动器和H桥逆变电路均连接电源；所述总线收发器、MCU处理器和两个光耦连接第一DC/DC模块，两个光耦和两个功率驱动器连接第二DC/DC模块，第一DC/DC模块和第二DC/DC模块均连接浪涌抑制及滤波电路，浪涌抑制及滤波电路连接28V电源，第一DC/DC模块输出±5V电源，第二DC/DC模块输出+12V电源，H桥逆变电路连接28V电源。2.根据权利要求1所述的一种小型电动舵机的控制系统，其特征在于：所述第一DC/DC模块和第二DC/DC模块的型号分别为MSDW1035和MAW01-24S12。3.根据权利要求1所述的一种小型电动舵机的控制系统，其特征在于：所述MCU处理器的型号为C8051F041。4.根据权利要求1所述的一种小型电动舵机的控制系统，其特征在于：所述第一光耦和第二光耦的型号为HCPL0531，总线收发器的型号为MAX490。5.根据权利要求1所述的一种小型电动舵机的控制系统，其特征在于：所述第一功率驱动器和第二功率驱动器的型号均为IR2302S。6.权利要求1所述的一种小型电动舵机的控制系统的控制方法，其特征在于：包括以下步骤：步骤一：通过MCU处理器采集舵偏角当前值，舵偏角目标值经422总线收...

【专利技术属性】
技术研发人员：赵亚妮，王琛，
申请(专利权)人：中国航天科技集团公司第九研究院第七七一研究所，
类型：发明
国别省市：陕西;61