1 控制器原理及设计方案
1.1 控制器原理及硬件设计
控制器分为3个单元:中央处理单元即DSP用于接受控制指令,计算并校正控制信号;电机驱动单元驱动电机工作;执行机构执行主控指令并反馈伺服机构状态给中央处理单元以校正伺服机构状态。工作原理如图1所示。
1.2 电源电路
由于DSP和外围芯片工作电压为5 V和3.3 V。电位器输入电压为+12 V和-12 V。因此使用DC/DC电压转换器将+27 V输入电压转换成+12 V和-12 V 工作电压,用CW78L05将+12 V电压转换成5 V工作电压。同理用FW431将5 V电压转换成4 V的基准电压和3.3 V芯片工作电压。
1.3 中央处理单元
由TMS320F2812作为中央处理芯片由RS422接口和SCI通信接口接收主控指令信号并转换成控制指令信号。由SPI总线接口接收执行机构反馈回来的执行机构的位置信号与控制信号一起通过控制算法转换成PWM输出。
DSP的外围电路通常由时钟电路、JTAG接口电路组成。时钟电路使用20 MHz晶振,5倍频后DSP工作在100 MHz的频率。每个电源入口用0.1μF的电容滤波及隔离。
伺服控制电路与主控之间的通信采用RS422异步全双工传输方式,采用MAX3160通信芯片实现。
1.4 反馈电路
反馈部分采用在执行机构安装同步电位计,通过电位计反馈电压信号,经过信号调理后,经由A/D转换器将数字信号反馈给DSP。
反馈信号信号渊理电路选用LM148,并存输入信号端加入由10 kΩ电阻和0.1μF电容组成的RC低通滤波电路。由于DSP中A/D转换的位数不足,因此选用TLC2574将放大后的反馈模拟信号转换成数字信号,并通过SDI和SDO端口与DSP传递数字信号。
1.5 驱动电路
DSP输出的PNM和DIR信号为3.3 V,为避免驱动能力不足,DSP的输出信号经SN74ALVC164245由3.3 V上拉至5 V,输山电流为24 mA。
光耦隔离电路用于将功率驱动电路的信号与DSP控制信号进行隔离,避免功率电源对数字控制电路造成干扰。光耦选用HCPL2231,该芯片由两路独立光耦组成,当输入为低时,二极管导通,输出为高。输出信号+15 V上拉。
由于驱动板中运放LM193和FN3140,以及逻辑门电路4069、4070、4073、4081的工作电压为+15 V,因此需要将系统工作电压+27 V经由电源模块转换成驱动板中芯片工作电压+15 V。逻辑门电路根据电机霍尔位置信号HA、HB、HC和电机方向信号DIR产生控制6个MOS管开关的控制信号。并且将PWM信号合成到功率开关管的导通相序中。
驱动部分前级驱动电路采用IR2103,以提高逻辑电路输出信号的驱动能力,用来开启和关闭后级的大功率晶体管。芯片输出采用自举方式。功率电路采用6个IRFP250功率管组成全桥式电路。最大供电电压90 V,最大持续工作电流33A。
当伺服系统中出现持续过载情况或者逆变电路出现直通时,电路输出电流过大,会烧坏电机或损坏功率器件,因此需加入过流保护电路。将采样电阻采集的信号进行滤波处理后与设定值比较,以限定电机的最大工作电流。
2 软件系统
控制软件采用模块化设计,针对各个功能设计相应的程序模块。主程序通过对各个子函数的合理调用和控制最终实现整个伺服系统的合理工作。
当系统开始工作时,首先完成对各个程序模块的初始化,包括CPU时钟、看门狗、中断、SCI口、定时器、控制参数、PWM等。完成各个模块的初始化后,在最后的死循环中,执行伺服机构控制算法等待串口中断:首先启动AD采集,采样结束后,读取AD的采样结果。利用采样结果和通过中断接收的伺服控制指令控制电机工作。如果判断通信出现,则执行SCI口初始化,重新复位串口。控制软件采用C语言编写,各个模块可以相互调用,工作效率高,可以实现实时控制。
3 测试系统及试验结果
测试系统采用直流稳压电源提供+27 V控制电,两个直流电源提供电机工作电压,其中-45 V为工作电压,+45 V为补偿电压。测试平台采用研华的数据采集和控制平台,由LabCVI实现对控制电路的仿真测试控制和数据采集。试验结果如下图所示。
4 结论
与传统的伺服控制系统相比,基于DSP的数字伺服机构控制系统既有数字系统精度高、灵活性强的优点,又充分发挥了无刷直流电机可靠性高、快速性好的优点,大幅提升了伺服系统的整体性能。同时该系统的建模、仿真、测试、维修等与传统伺服控制系统相比更加快捷、有效,具有较高的工程应用价值。该伺服控制系统可以同时控制多个直流无刷电机同时工作,已在某型伺服机构中验证并应用。