摘 要：SMC6400运动控制器不但具有PLC的I/O控制功能，而且在多轴联动控制等功能上具有明显优势；本文通过一个特殊绕线机运动控制系统的案例，详细介绍了采用G代码指令控制SMC6400实现多轴联动的方法。

关键词：运动控制器、G代码、绕线机

因PLC工作可靠、编程方便，目前中、小型PLC已广泛应用于自动化设备中。但PLC要实现多轴联动等复杂的运动控制，则代价很高。为此，雷泰公司开发了SMC6400独立式运动控制器，将运动控制卡优良的运动控制功能与PLC稳定可靠的工作性能、简单的编程方式有机地结合起来。自动化设备研发工程师不需要掌握复杂的VB、VC软件，只用简单的G代码就可以开发出动作复杂的运动控制系统。

下面以一种6轴全自动绕线机的控制系统为例，详细介绍SMC6400独立式运动控制器的特点及应用方法。

1. SMC6400控制器的特点

l 以32位RISC为核心，可控制4轴步进电机、伺服电机，完成各种复杂的单轴、多轴运动；

l 各轴最高脉冲输出频率可达8MHz；

l 多达28路输入28路输出的通用I/O口；

l 采用ISO国际标准G代码编程，易学易用；

l G代码支持2~4轴直线插补、2轴圆弧插补、3轴螺旋插补，多任务、子程序、条件控制、循环控制、变量运算等功能；

l 控制器上可存贮16个程序，程序切换方便；G代码程序最长可达5000行。

2. 六轴全自动绕线机控制系统结构

某公司新近开发的一款特种电机线圈全自动绕线机的外形如图1所示。由于在整个绕线过程中，有大量的直线插补、圆弧插补运动，若选用带有插补功能的PLC，则成本高昂，且程序开发比较复杂。故选用SMC6400运动控制器来弥补PLC的不足。

该设备在一个工作周期内，机器主要完成绞线与绕线两部分动作。为了便于调试与操作，客户要求绞线与绕线两部分动作必须分开控制。

                                         图1 六轴全自动绕线机外形

绕线部分有四个轴。X、Y、Z三轴正好在左右、上下及前后三个方向构成一个空间直角坐标系，分别由三个交流伺服电机驱动滚珠丝杆使导针实现直线插补或螺旋插补轨迹。U轴为旋转轴，即绕线轴，绕线时与排线轴（即前后运动的Z轴）作直线插补运动。

而绞线部分只有两个轴，且动作比较简单，故选用一款普通的小型PLC即可。

该设备的控制系统结构图如图2所示。

图2中的各轴专用数字输入信号包括：原点、限位、伺服报警、位置完成等信号；各轴专用数字输出信号包括：电机脉冲及方向信号，伺服使能、报警清除等信号。通用数字输入信号包括：启动、停止、复位按钮、急停开关；气缸位置传感器信号、PLC给出的绞线完成信号。通用数字输出信号包括：发给PLC的绞线启动信号、电磁阀开关信号等。



3. G代码编程

3.1 绘制流程图、时序图

为了使编程思路更加清晰明了，在编写程序之前，根据绕线机工作流程及控制要求，绘制流程图与时序图，如图3、图4所示。

                                                          图3 绕线机动作流程图

                                                    图4 绕线机动作时序图

3.2 程序编写

根据绕线机动作流程图与时序图进行G代码编程。其中，程序中相关参数及各轴坐标可先估算设定，取比较保险、安全的数值为好。

下面针对绕线机控制程序中几个重要部分进行详细分析。



①气缸动作可用M80、M81、M82、M83四条指令进行控制。其中M80、M81控制电磁阀通断；M82、M83读取位置传感器信号的有无。若需要延时，可用G04指令设定延迟时间。

控制下料动作的代码及注释如下：



N50 M80 S5 ;指定Output5开(下料气缸将线圈推出)

N60 M82 S13 ;等待Input13有效(等待下料气缸到位，即：下料传感器ON)

N65 G04 P100 ;延时100毫秒

N70 M81 S5 ;指定Output5关(下料气缸返回)

N75 M83 S13 ;等待Input13无效(下料传感器OFF)



M82、M83指令不断地检测指定的输入信号的状态，直到输入信号有效或无效时，才继续执行下面的指令。



②电机运动可用G00、G01、G02、G03进行控制，或可用G26、G28进行回零操作。此外，为方便编程与调试，还可用G90、G91进行绝对坐标与相对坐标间的切换。

缠绕线圈