【正文】 及編程軟件 要將各設備聯(lián)系起來，總控設備必須要強大，還要具有較高的運行的穩(wěn)定性， 本系統(tǒng)的總控 設備采用西門 子 plc1200。這里我們只介紹 V13 版本的軟件基本應用。 配置和分配設備參數(shù)使設備相互連接等等 14 創(chuàng)建 HMI 畫面 在已創(chuàng)建項目里創(chuàng)建 HMI 畫面。 通訊模塊應為整個系統(tǒng)采用的是 modbus通信協(xié)議 ， 所以程序中建立的通訊選擇也是modbus通信塊 ， 并對每個通信塊進行相應的配置 ， 例如相機 通信模塊參數(shù)，如下圖所示，“ CONNECT_ID”是相機的站號，為 3； 2 中的 IP 地址是相機的地址， 。“ IP_PORT”是默認的， 502；“ MB_MODE”是工作模式， 1 表示“寫”， 0 表示“讀”；“ MB_DATA_ADDR”是工業(yè)機器人寫入數(shù)據(jù)的起始地址， 40001，在工業(yè)機器人中預留了 16 個輸入寄存器，所以一次最多只能向工業(yè)機器人寫入 16 個數(shù)據(jù)，且工業(yè)機器人只接收和發(fā)送帶符號的整形數(shù)據(jù)；“ MB_DATA_LEN”是讀取數(shù)據(jù)的長度；“ MB_DATA_PTR”是 PLC 存放讀入的數(shù)據(jù)的緩存區(qū)，從 MW100 開始。 17 配置變頻器設備子模塊，雙擊上圖中的變 頻器設備，進入變頻器設備視圖，如下圖所示。 變頻器字節(jié)數(shù)（ QW） :16047F/0C7F(啟動 )164000==50HZ“”（頻率） 16047E（停止） 1647FE==報警清除 ， QW68 是變頻器啟停寄存器， QW70 是變頻器的運行速度寄存器。其余默認。 工件盒生產(chǎn)線的程序編輯 工件盒生產(chǎn)線采用步進電機控制， 所以它的運動需要調(diào)用工藝塊如下圖。 END_IF。 X_SIGHT 軟件程序的編寫 打開軟件如下圖，在 XSIGHT STUDIO 后面，顯示“智能相機開發(fā)軟件”。 信息欄：顯示工具使用結(jié)果和輸出。 } 相機總控軟件上程序編寫 如下圖，相機在生產(chǎn)線復位過程中將數(shù)據(jù)清空， 當物體觸發(fā) 相機拍照工位托盤檢測光電開關(guān) 時，相機在圖像識別工位氣缸升起后拍照。 示教器程序編寫 MAIN 主程序 := 100 上傳機器人當前狀態(tài)： 100=待機 WHILE TRUE DO 當 TRUE 時運行程序（循環(huán)） WAIT = 103 等待機器人啟動信號： 103=啟動 CALL inttoreal() 調(diào)用程序 inttoreal（整型到實數(shù)轉(zhuǎn)換） WaitIsFinished() 等待完成 IF = 0 THEN 如果工具號 =0，然后 := 200 機器人狀態(tài)： 200=運行 CALL pick() 調(diào)用程序 pick（禮物拾?。? CALL put() 調(diào)用程序 put（禮物裝箱） := 100 機器人狀態(tài)：待機 ELSIF = 1 THEN 如果工具號 =1 := 200 機器人狀態(tài)：運行 CALL tuopan_pick_put() 調(diào)用程序托盤進棧 := 100 機器人狀態(tài)：待機 := 101 程序結(jié)束 END_IF END_WHILE INTTOREAL 整數(shù)轉(zhuǎn)實數(shù) dx_pick := 拾取點 X 軸偏移量轉(zhuǎn)為實數(shù) dx_pick := dx_pick / 10 拾取點 X 軸偏移量除以 10 得到實際偏移，單位 mm dy_pick := 拾取點 Y 軸偏移量轉(zhuǎn)為實數(shù) dy_pick := dy_pick / 10 拾取點 Y 軸實際偏移量 dz_pick := 拾取點 Z 軸偏移量轉(zhuǎn)為實數(shù) dz_pick := dz_pick / 10 拾取點 Z 軸實際偏移量 oz_pick := 拾取點旋轉(zhuǎn)角度轉(zhuǎn)為實數(shù) oz_pick := oz_pick / 10 拾取點實際旋轉(zhuǎn)角度 dx_put := 放置點 X 軸偏移量轉(zhuǎn)為實數(shù) 24 dx_put := dx_put / 10 dy_put := dy_put := dy_put / 10 dz_put := dz_put := dz_put / 10 oz_put := oz_put := oz_put / 10 PICK 禮品拾取 PTP(xipan_tool_pos) 切換到禮物拾取工具位置 Tool(xipan_tool) 切換到禮物拾取工具坐標系 WaitIsFinished() 等待完成 //Lin(inipoint) 拾取坐標偏移基準點（不參與實際動作） Pickpot := inipoint 拾取點賦值 := ‐ dx_pick 拾取點 X 軸偏移計算 := ‐ dy_pick ‐ laser_offset 拾取點 Y 軸偏移計算 := + dz_pick + 100 拾取點 Z 軸偏移計算 (增加 100mm 作為 準備點 WaitIsFinished() 等待完成 Lin(pickpot) 以直線方式運行到拾取準備點 WaitIsFinished() 等待完成 := ‐ 100 減少 100mm 到拾取點 WaitIsFinished() 等待完成 Lin(pickpot, lin300) 以 300cm/min 的速度運行到拾取點 WaitIsFinished() 等待完成 (TRUE) 真空打開 (TRUE) 吸盤 1 打開 WaitTime(2021) 延時 2 秒 WaitIsFinished() 等待完成 IF = TRUE THEN 如果真空檢測為 TRUE := + 100 上升 100mm 作為退出點 WaitIsFinished() 等待完成 Lin(pickpot) 運動到退出位置 25 ELSIF = FALSE THEN 如果真空檢測為 FALSE := 300 機器人狀態(tài)： 300=吸取錯誤 PAUSE 暫停 END_IF PUT 禮物裝箱 Tool(xipan_tool) 切換到禮物拾取工具坐標系 //Lin(put_inipoint) 放置坐標偏移基準點（不參與實際動作） putpot := put_inipoint 放置點賦值 := + dx_put 放置點 X 軸坐標計算 := + dy_put ‐ laser_offset 放置點 Y 軸坐標計算 := + dz_put + 150 放置點 Z 軸坐標計算 (增加 150mm 作為準備點 WaitIsFinished() 等待完成 Lin(putpot) 運動到放置準備點 WaitIsFinished() 等待完成 IF = TRUE THEN 如果真空檢測為 TRUE := ‐ 100 高度下降 100mm 作為姿態(tài)調(diào)整點 := + oz_pick 旋轉(zhuǎn)角度計算 WaitIsFinished() 等待完成 Lin(putpot) 運動到姿態(tài)調(diào)整點 WaitIsFinished() 等待完成 := ‐ 50 高度減少 50mm（實際放置點） WaitIsFinished() Lin(putpot) 運動到放置位置 WaitIsFinished() (FALSE) 真空關(guān)閉 (FALSE) 吸盤 1 關(guān)閉 WaitIsFinished() := + 200 高度上升 200mm 作為退出點 WaitIsFinished() Lin(putpot) 運動到退出點 26 WaitIsFinished() ELSIF = FALSE THEN 如果真空檢測為 FALSE := 400 機器人狀態(tài)： 400=放置錯誤 PAUSE END_IF tuopan_pick_put 托盤進棧 PTP(tupan_tool) 切換到托盤拾取工具位置 Tool(tuopan_tool) 切換到托盤拾取工具坐標系 Lin(pick_ready) 運行到拾取準備位置 Lin(pick_up) 運行到拾取位置 WaitIsFinished() (TRUE) 真空打開 (TRUE) 吸盤 2 打開 WaitTime(2021) WaitIsFinished() IF = TRUE THEN *如果真空檢測為 TRUE Lin(pick_after)