机器人数控机床自动上下料项目

加工装配工作站由上下料工业机器人，机器人控制柜，PLC 控制柜，仓库，上料输送线工作站等构成，机器人完成对工件的搬运和入仓装配，而数控机床则对搬运的工件进行加工处理，机器人与数控机床配合零件的加工入仓。

加工装配工作站运行的准备条件（1）物料台八个凹槽检测有，仓库八个凹槽检测无，且配件台待装配零件放满。

转盘旋转到位，即工件到达机器人抓取的指定位置（运行前用手动模式触摸屏校正）。

（2）机器人选择远程模式，机器人在作业原点,机器人运行无。

（3）机器人报警无，CNC 报警无。

（4）CNC 卡盘上无工件，CNC 就绪。

）（1）按下启动按钮，机器人伺服使能，机器人启动，发出机器人上料开始信号。

（2）机器人接到上料开始信号，机器人搬运工件到达CNC 正前方50cm 处，发出机器人上料完成信号。

（3）CNC 接到上料完成信号，CNC 门打开，CNC 门开到位，发出机器人送料开始信号。

（4）机器人接到送料开始信号，机器人将工件送入CNC，返回CNC 正前方50cm 处，发出机器人送料完成信号。

（5）CNC 接到送料完成信号，CNC 门关闭，CNC 门关到位，CNC 加工开始，CNC 加工完成，CNC 门打开，CNC 门开到位，发出机器人取料开始信号。

（6）机器人接到取料开始信号，机器人将CNC 内的工件取出，发出机器人取料完成信号。

）（7）CNC 接到机器人取料完成信号，CNC 门关闭，CNC 门关闭到位，发出机器人入仓装配开始信号。

（8）机器人接到入仓装配开始信号，机器人把工件放入仓库的凹槽中，机器人移动到装配台夹取配件，待装配完成，发出机器人装配完成信号。

（9）机器人接到装配完成信号，机器人回原点，若仓库装配完的工件数超过八个（含八个）则机器人停止搬运，待清仓与加料加配件后，按下复位按钮，系统继续运行。

若仓库装配完的工件数低于八个则系统继续运行。

（10）暂停：按下暂停按钮，机器人停止搬运，按下复位键后一切运行正常。

急停：拍下急停按钮，红灯常亮，机器人停止搬运，PLC 输出复位（除警示灯（红）、机器人急停、CNC急停外），待按下复位按钮，警示灯（红）灭，机器人及CNC急停清除，旋转转换开关，手动恢复各部分为初始状态，机器人选择示教模式回原点，仓库清空，按下启动按钮工作站运作重新开始。

注：条件没准备好时，黄灯1HZ 闪烁，条件准备好时，黄灯常亮。

待按下启动按钮设备运行绿灯常亮，急停时红灯常亮。

转换开关用于手动与自动间的切换，以及急停后各部件初始状态的恢复。

上下料装配工作站系统配置上下料装配工作站硬件的系统设计包括工作站主电路的设计，控制柜及其内部设备的配置，PLC 的i/o 表，外围设备（传感器、按钮、驱动器）与PLC 的接口电路，机器人与PLC 的接口电路。

控制柜及其设备配置}PLC 控制柜的设计包括空开、PLC、驱动器、开关电源、端子排等元器件安放位置的设计。

控制柜设计如图所示。

控制柜设备配置！机器人工作站i/o表上下料装配工作站软件系统设计上下料装配工作站PLC程序设计机器人上下料工作站PLC程序分为：手动、状态准备、主程序、暂停、急停五个部分。

程序框架如图手动》手动程序部分主要是为了测试各部件的动作正常及急停后初始状态的恢复，程序如图状态准备主要包括：自动手动切换、满足条件指示灯情况、不满足条件指示灯情况及按钮启动。

状态准备PLC 程序如图主程序部分主要包括：机器人启动、机器人上料、机器人送料、机器人取料、CNC 加工、机器人入仓装配、对于加工工件数目的判断等。

机器人启动程序需先接通伺服使能，具体程序如图.机器人夹取物料台上的工件在数控机床正前方50cm出停下，并通知CNC把门打开，程序如图机器人将工件送入数控机床，CNC 门关闭通知机床加工开始，程序如图。

CNC 加工之后门开通知机器人来取料，程序如图机器人将料取出，CNC门关闭开始进入装配阶段，程序如图~机器人将工件夹取放入仓库指定位置，并夹取配料台上的工件装配进仓库的工件上，入仓装配程序如图机器人回原点位置，旋转盘旋转45 度将新的工件转到机器人夹取位置，程序如图序根据加工的个数判断机器人是否接着上下料，程序如图(暂停PLC程序需单列，暂停只是机器人运动的暂停，程序如图工作站遇到特殊情况，按下急停按钮机器人伺服、启动断开，警示灯（红）常亮，CNC急停加工停止，机器人各信号点复位，PLC具体程序如图机床上下料机器人程序序号程序注释1 NOP；2 *L0 程序标号3 CLEAR B000 1CLEAR B001 1 置记忆存储器B000和B001为0；初始化4 DOUT OUT#（12）=OFF 清除“机器人装配完成”信号；初始化5 CALL JOB：HANDOPEN 手爪松开；初始化6 *L10 程序标号7 WAIT IN#(9)=ON 等待PLC“机器人上料开始”指令。

8 MOVJ VJ=10.00 PL=0 机器人作业原点，关键示教点9 JUMP *L1 IF B000=0 如果夹取第一块工件，跳转至*L110 JUMP *L2 IF B000=1 如果夹取第二块工件，跳转至*L211 JUMP *L3 IF B000=2 如果夹取第三块工件，跳转至*L312 JUMP *L4 IF B000=3 如果夹取第四块工件，跳转至*L413 JUMP *L5 IF B000=4 如果夹取第五块工件，跳转至*L514 JUMP *L6 IF B000=5 如果夹取第六块工件，跳转至*L6 .15 JUMP *L7 IF B000=6 如果夹取第七块工件，跳转至*L716 JUMP *L8 IF B000=7 如果夹取第八块工件，跳转至*L817 *L1 夹取第1个工件时程序标号18 MOVJ VJ=15.00 PL=3 中间移动点19 MOVJ VJ=15.00 PL=3 中间移动点20 MOVL V=83.3 开始夹取第1个工件21 JUMP *L9 跳转至*L9￥22 *L2 夹取第2个工件时程序标号23 MOVJ VJ=15.00 PL=3 中间移动点24 MOVJ VJ=15.00 PL=3 中间移动点25 MOVL V=83.3 开始夹取第2个工件26 JUMP *L9 跳转至*L928 MOVJ VJ=15.00 PL=3 中间移动点{29 MOVJ VJ=15.00 PL=3 中间移动点30 MOVL V=83.3 开始夹取第3个工件31 JUMP *L9 跳转至*L932 *L4 夹取第4个工件时程序标号33 MOVJ VJ=15.00 PL=3 中间移动点34 MOVJ VJ=15.00 PL=3 中间移动点35 MOVL V=83.3 开始夹取第4个工件$36 JUMP *L9 跳转至*L937 *L5 夹取第5个工件时程序标号38 MOVJ VJ=15.00 PL=3 中间移动点39 MOVJ VJ=15.00 PL=3 中间移动点40 MOVL V=83.3 开始夹取第5个工件41 JUMP *L9 跳转至*L942 *L6 夹取第6个工件时程序标号43 MOVJ VJ=15.00 PL=3 中间移动点%44 MOVJ VJ=15.00 PL=3 中间移动点46 JUMP *L9 跳转至*L947 *L7 夹取第7个工件时程序标号48 MOVJ VJ=15.00 PL=3 中间移动点49 MOVJ VJ=15.00 PL=3 中间移动点50 MOVL V=83.3 开始夹取第7个工件,51 JUMP *L9 跳转至*L952 *L8 夹取第8个工件时程序标号53 MOVJ VJ=15.00 PL=3 中间移动点54 MOVJ VJ=15.00 PL=3 中间移动点55 MOVL V=83.3 开始夹取第8个工件56 JUMP *L9 跳转至*L957 *L9 程序标号—58 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序59 INC B000 上料数加160 MOVJ VJ=15.00 PL=3 中间移动点61 MOVJ VJ=15.00 PL=3 中间移动点62 MOVL V=83.3 中间移动点63 MOVL V=83.3 夹取工件移动到CNC正前方0.5m处停下64 PULSE OUT#(9) T=1 向PLC发出1s“机器人上料完成”信号65 WAIT IN#(10)=ON 等待PLC“机器人送料开始”指令66 MOVJ VJ=15.00 PL=3 中间移动点67 MOVJ VJ=15.00 PL=3 中间移动点68 MOVL V=83.3 机器人接近卡盘，关键示教点69 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序70 MOVJ VJ=15.00 PL=3 中间移动点71 MOVJ VJ=50.00 PL=3 中间移动点，72 MOVJ VJ=5.00 PL=3 中间移动点（返回CNC正前方0.5m处）73 PULSE OUT#(10) T=1 向PLC发出1s“机器人送料完成”信号74 WAIT IN#(11)=ON 等待PLC“机器人取料开始”指令75 MOVJ VJ=15.00 PL=3 中间移动点76 MOVJ VJ=50.00 PL=3 中间移动点77 MOVJ VJ=5.00 PL=3 机器人接近卡盘，关键示教点78 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序、79 MOVJ VJ=50.00 PL=3 中间移动点80 MOVJ VJ=5.00 PL=3 中间移动点（返回CNC正前方0.5m处）81 PULSE OUT#(11) T=1 向PLC发出1s“机器人取料完成”信号82 WAIT IN#(12)=ON 等待PLC“机器人入仓装配开始”指令83 MOVJ VJ=15.00 PL=3 中间移动点85 JUMP *L11 IF B001=0 如果入仓第一块工件，跳转至*L11《86 JUMP *L12 IF B001=1 如果入仓第二块工件，跳转至*L1287 JUMP *L13 IF B001=2 如果入仓第三块工件，跳转至*L1388 JUMP *L14 IF B001=3 如果入仓第四块工件，跳转至*L1489 JUMP *L15 IF B001=4 如果入仓第五块工件，跳转至*L1590 JUMP *L16 IF B001=5 如果入仓第六块工件，跳转至*L1691 JUMP *L17 IF B001=6 如果入仓第七块工件，跳转至*L1792 JUMP *L18 IF B001=7 如果入仓第八块工件，跳转至*L18-93 *L11 入仓装配第1个工件时程序标号94 MOVJ VJ=15.00 PL=3 中间移动点95 MOVJ VJ=50.00 PL=3 中间移动点96 MOVL V=250 PL=1 接近仓库，重要示教点97 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序98 MOVJ VJ=15.00 PL=3 中间移动点99 MOVJ VJ=50.00 PL=3 中间移动点!100 MOVL V=250 PL=1 接近配件，重要示教点101 CALL JOB：HANDCLOSE 手爪夹紧配件，调用手爪夹紧子程序104 MOVL V=250 PL=1 接近工件，重要示教点105 MOVJ VJ=15.00 PL=3 中间移动点106 CALL JOB：HANDOPEN 手爪释放配件，调用手爪释放子程序107 MOVJ VJ=50.00 PL=3 中间移动点？108 MOVJ VJ=50.00 PL=3 中间移动点109 JUMP *L19 跳转至*L9110 *L12 入仓装配第2个工件时程序标号111 MOVJ VJ=15.00 PL=3 中间移动点112 MOVJ VJ=50.00 PL=3 中间移动点113 MOVL V=250 PL=1 接近仓库，重要示教点114 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序—115 MOVJ VJ=15.00 PL=3 中间移动点116 MOVJ VJ=50.00 PL=3 中间移动点117 MOVL V=250 PL=1 接近配件，重要示教点118 CALL JOB：HANDCLOSE 手爪夹紧配件，调用手爪夹紧子程序119 MOVJ VJ=15.00 PL=3 中间移动点120 MOVJ VJ=50.00 PL=3 中间移动点121 MOVL V=250 PL=1 接近工件，重要示教点123 CALL JOB：HANDOPEN 手爪释放配件，调用手爪释放子程序124 MOVJ VJ=50.00 PL=3 中间移动点125 MOVJ VJ=50.00 PL=3 中间移动点126 JUMP *L19 跳转至*L9127 *L13 入仓装配第3个工件时程序标号128 MOVJ VJ=15.00 PL=3 中间移动点?129 MOVJ VJ=50.00 PL=3 中间移动点130 MOVL V=250 PL=1 接近仓库，重要示教点131 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序132 MOVJ VJ=15.00 PL=3 中间移动点133 MOVJ VJ=50.00 PL=3 中间移动点134 MOVL V=250 PL=1 接近配件，重要示教点135 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序\136 MOVJ VJ=15.00 PL=3 中间移动点137 MOVJ VJ=50.00 PL=3 中间移动点138 MOVL V=250 PL=1 接近工件，重要示教点139 MOVJ VJ=15.00 PL=3 中间移动点142 MOVJ VJ=50.00 PL=3 中间移动点《143 JUMP *L19 跳转至*L9144 *L14 入仓装配第4个工件时程序标号145 MOVJ VJ=15.00 PL=3 中间移动点146 MOVJ VJ=50.00 PL=3 中间移动点147 MOVL V=250 PL=1 接近仓库，重要示教点148 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序149 MOVJ VJ=15.00 PL=3 中间移动点《150 MOVJ VJ=50.00 PL=3 中间移动点151 MOVL V=250 PL=1 接近配件，重要示教点152 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序153 MOVJ VJ=15.00 PL=3 中间移动点154 MOVJ VJ=50.00 PL=3 中间移动点155 MOVL V=250 PL=1 接近工件，重要示教点156 MOVJ VJ=15.00 PL=3 中间移动点,157 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序158 MOVJ VJ=50.00 PL=3 中间移动点160 JUMP *L19 跳转至*L9161 *L15 入仓装配第5个工件时程序标号162 MOVJ VJ=15.00 PL=3 中间移动点163 MOVJ VJ=50.00 PL=3 中间移动点\164 MOVL V=250 PL=1 接近仓库，重要示教点165 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序166 MOVJ VJ=15.00 PL=3 中间移动点167 MOVJ VJ=50.00 PL=3 中间移动点168 MOVL V=250 PL=1 接近配件，重要示教点169 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序170 MOVJ VJ=15.00 PL=3 中间移动点171 MOVJ VJ=50.00 PL=3 中间移动点—172 MOVL V=250 PL=1 接近工件，重要示教点173 MOVJ VJ=15.00 PL=3 中间移动点174 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序175 MOVJ VJ=50.00 PL=3 中间移动点176 MOVJ VJ=50.00 PL=3 中间移动点177 JUMP *L19 跳转至*L9178 *L16 入仓装配第6个工件时程序标号179 MOVJ VJ=15.00 PL=3 中间移动点180 MOVJ VJ=50.00 PL=3 中间移动点181 MOVL V=250 PL=1 接近仓库，重要示教点182 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序183 MOVJ VJ=15.00 PL=3 中间移动点184 MOVJ VJ=50.00 PL=3 中间移动点185 MOVL V=250 PL=1 接近配件，重要示教点{186 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序187 MOVJ VJ=15.00 PL=3 中间移动点188 MOVJ VJ=50.00 PL=3 中间移动点189 MOVL V=250 PL=1 接近工件，重要示教点190 MOVJ VJ=15.00 PL=3 中间移动点191 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序192 MOVJ VJ=50.00 PL=3 中间移动点193 MOVJ VJ=50.00 PL=3 中间移动点194 JUMP *L19 跳转至*L9195 *L17 入仓装配第7个工件时程序标号196 MOVJ VJ=15.00 PL=3 中间移动点197 MOVJ VJ=50.00 PL=3 中间移动点199 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序200 MOVJ VJ=15.00 PL=3 中间移动点201 MOVJ VJ=50.00 PL=3 中间移动点202 MOVL V=250 PL=1 接近配件，重要示教点203 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序204 MOVJ VJ=15.00 PL=3 中间移动点205 MOVJ VJ=50.00 PL=3 中间移动点206 MOVL V=250 PL=1 接近工件，重要示教点207 MOVJ VJ=15.00 PL=3 中间移动点208 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序209 MOVJ VJ=50.00 PL=3 中间移动点210 MOVJ VJ=50.00 PL=3 中间移动点211 JUMP *L19 跳转至*L9212 *L18 入仓装配第8个工件时程序标号213 MOVJ VJ=15.00 PL=3 中间移动点214 MOVJ VJ=50.00 PL=3 中间移动点215 MOVL V=250 PL=1 接近仓库，重要示教点216 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序217 MOVJ VJ=15.00 PL=3 中间移动点218 MOVJ VJ=50.00 PL=3 中间移动点219 MOVL V=250 PL=1 接近配件，重要示教点220 CALL JOB：HANDCLOSE 手爪夹紧，调用手爪夹紧子程序221 MOVJ VJ=15.00 PL=3 中间移动点222 MOVJ VJ=50.00 PL=3 中间移动点223 MOVL V=250 PL=1 接近工件，重要示教点224 MOVJ VJ=15.00 PL=3 中间移动点225 CALL JOB：HANDOPEN 手爪释放，调用手爪释放子程序226 MOVJ VJ=50.00 PL=3 中间移动点227 MOVJ VJ=50.00 PL=3 中间移动点228 JUMP *L19 跳转至*L9229 *L19 程序标号*L19230 INC B001 装配数加1231 MOVJ VJ=50.00 PL=3 中间移动点232 MOVJ VJ=50.00 PL=3 中间移动点（返回原点）233 PULSE OUT#(12) T=1 向PLC发出1s“机器人装配完成”信号234 JUMP *L10，IF B001<8 跳转至*L10，等待上料开始235 JUMP *L0，IF B001>=8 跳转至*L0，初始化236 END工件夹紧子程序工件夹紧子程序“HANDCLOSE”工件释放子程序工件释放子程序“HANDOPEN”。