基于PLC的机器人伺服控制系统

　　2.2 系统工作原理
　　系统原理如图2所示，可控环流可逆调速系统的主电路采用交叉联接方式，整流变压器的一个副边绕组接成Y型，另一个接成△ 型，2个交流电源的相位错开30°，其环流电压的频率为l2倍工频。为了抑交流环流，在2组可控整流桥之间接放了2只均衡电抗器，电枢回路中仍保留一只平波电抗器。
　　控制电路主要由转速调节器ASR、电流调节器ACR、环流调节器ARR， 正组触发器GTD、反组触发器GTS、电流反馈器TCV组成(见图2)，其中2组触发器的同步信号分别取自与整流变压器相对应的同步变压器。
　　  
　　图2 工业机器人关节直流伺服系统原理图

　　系统给定为零时，转速调节器ASR、电流调节器ACR被零速封锁信号锁零。此时，系统主要由环流调节器ARR组成交叉反馈的恒流系统。由于环流给定的影响，2组可控硅均处于整流状态，输出的电压大小相等、极性相反，直流电机电枢电压为零，电机停转，输出的电流流经2组可控硅形成环流。环流不宜过大，一般限制在电机额定电流的5%左右。正向启动时，随着转速信号Ugn的增大，封锁信号解除，转速调节器ASR输正， 电机正向运行。此时，正组电流反馈电压+Ufi2反映电机电枢电流与环流电流之和; 反组电流反馈电压-Uril反映了电枢电流， 因此可以对主电流进行调节。而正组环流调节器输入端所加的环流给定信号-Ugih和交叉电流反馈信号-Ufil对这个调节过程影响极小。反组环流调节器的输入电压为(+Uk)+(-Ugih)+(Ufi2)，随着电枢电流的不断增大，当达到一定程度时，环流自动消失，反组可控硅进入待逆变状态。反向启动时情况相反。另外，可控环流可逆调速系统制动时仍然具有本桥逆变，反接制动和反馈制动等过程。由于启动过程也是环流逐渐减小的过程， 因此， 电机停转时，系统的环流达最大值。环流有助于系统越过切换死区，改善过渡特性。
3、 系统程序设计
　　程序设计方案为手动输入一个角度值，让电机转动，通过与电动机相联的光电码盘来检测电动机转的角度，将转动角度变成脉冲信号。由于电动机的转速非常快，所以只能把脉冲信号送往PLC的高速计数器。然后将计数器的脉冲记录与手输入的进行比较，如果两者相等说明电动机已经到达指定角度位置，否则继续进行修正。值得注意的是，由于电动机从转动突变到停止会有一定的惯性， 因此在进行信号比较时应允许有一定的误差，不然电动机就会始终处在修正位置状态。系统程序框图如图3所示。

 
 　　图3 系统程序框图