1 交流伺服电机控制系统设计方案
系统使用的交流伺服电机为三相交流电机;驱动器控制U/V/W三相电形成电磁场;转子在此磁场的作用下转动,同时电机由接近传感器将转速信号反馈给驱动器;驱动器根据反馈值与目标值进行比较,调整转子转动的角度。伺服电动机又称执行电动机,在自动控制系统中,用作执行元件,把所收到的电信号转换成电动机轴上的角位移或角速度输出。
2 系统硬件设计
本项目实质上采用STC89C52RC单片机构建一个最小系统,实现脉宽可调输出控制两个继电器,实现电机正反转智能控制,从而实现伺服电机的精确位移控制。控制系统组成如图1所示。
通过按键输入电机所需的转速值并与转速传感器反馈回来的电机转速相比较,采用PID算法,经单片机处理后,转化成相应的脉冲信号,再经光电耦合器调节继电器的开度,通过调节继电器的脉冲宽度,达到脉宽的调制,从而控制伺服电机上的磁块正负位移,使电机达到给定的转速值,同时单片机接受固定在伺服电机转轴上的转速传感器随着电机转动而产生的反馈脉冲信号,并在LED实时显示电机的实际转速。
2.1 单片机控制器的硬件设计
在此开发了一套运动控制器的软件系统。该系统的硬件结构是基于单片机而开发的,所用功能为外部中断、定时中断、检测传感器脉冲信号、及输入/输出等。STC89C52RC的P0.0,P0.1,P0.2端口分别作为按键SET、按键MOVE、按键UP的输入口,通过STC89C52定时器T0的定时中断控制脉冲发送频率,进而控制电机的转速。系统原理图如图2所示。
2.2 驱动部分电路的硬件设计
由于单片机属于TTL电路(逻辑1和0的电平分别为2.4 V和0.4 V),其I/O口输出的开关量控制信号电平无法直接驱动电机,所以在P2.6口控制升速信号输出端需加入驱动电路;同理该驱动电路也应用于P2.7口的降速输出端。系统采用光耦耦合器和晶体管作驱动,由光电耦合器输出通道传入控制电机,所以具有很强的抑制噪声干扰能力,起隔离作用,可防止强电磁干扰;晶体管主要起功率放大作用。电机驱动电路如图3所示。
3 系统软件设计
控制器的软件主要完成LED显示,接受键盘输入,实现伺服电机匀速运行和继电器控制几项功能,包括主程序、按键中断服务程序、定时器T0中断服务程序及LED显示子程序。在交流伺服电机控制系统中,单片机的主要作用是产生脉冲序列,它是通过STC89C52RC的P3.2口发送的。系统软件编制采用定时器定时中断产生周期性脉冲序列,不使用软件延时,不占用CPU。CPU在非中断时间内可以处理其他事件,惟有到了中断时间,才驱动伺服电机转动一步。系统程序流程图如图4所示。