器人KAREL Socket通信實(shí)戰(zhàn)：從原理到代碼實(shí)現(xiàn))
搞工業(yè)機(jī)器人的朋友十有八九會碰到一個需求機(jī)器人得跟外部系統(tǒng)說上話。視覺系統(tǒng)要告訴它“工件找到了坐標(biāo)是多少”MES要下發(fā)當(dāng)前工單上位機(jī)要查機(jī)器人狀態(tài)。FANUC的TP示教器程序?qū)戇壿?、走點(diǎn)位很順手可一旦牽扯到字符串解析、自定義報文、斷線重連TP就明顯吃力了。這時候就得請出KARELFANUC控制器里真正能干“臟活累活”的高級語言而KAREL里最實(shí)用的網(wǎng)絡(luò)能力就是SOCKET指令。這篇文章把我實(shí)踐過的KAREL Socket通信套路完整整理了一遍包括一條能直接用的思路、一份完整的.KL源文件、從編譯到加載再到聯(lián)調(diào)的流程還有現(xiàn)場排查問題的經(jīng)驗(yàn)。做FANUC集成的電氣工程師、機(jī)器人應(yīng)用工程師或者正在研究機(jī)器人網(wǎng)絡(luò)通信的朋友這篇應(yīng)該能幫你少走不少彎路。1. 為什么KAREL成了Socket通信的最佳選擇1.1 場景需求機(jī)器人為什么要連外部設(shè)備工業(yè)現(xiàn)場不是一臺機(jī)器人單打獨(dú)斗設(shè)備之間總要交換信息。最常見的幾類場景我隨便舉幾個。視覺引導(dǎo)場景相機(jī)拍完照通過TCP把坐標(biāo)發(fā)給機(jī)器人。機(jī)器人收到坐標(biāo)后算偏移量再走修正點(diǎn)位。這個過程中報文的格式可能是一行字符串比如“X123.4,Y56.7,Z-10.2”也可能是一段JSON或者自定義結(jié)構(gòu)體。TP程序雖然能做簡單的IF判斷但你讓它去“拆字符串”“截字段”“轉(zhuǎn)浮點(diǎn)數(shù)”那是一場災(zāi)難。MES和上位機(jī)場景機(jī)器人完成任務(wù)后要上報結(jié)果或者接收下發(fā)的料號、任務(wù)號。這類通信往往要求一定的協(xié)議比如幀頭幀尾、校驗(yàn)位、超時重發(fā)。純TP實(shí)現(xiàn)會非常痛苦代碼寫出來長到你自己都不想維護(hù)。PLC網(wǎng)關(guān)和掃碼槍場景很多第三方設(shè)備支持TCP/IP通過Socket方式直接收發(fā)數(shù)據(jù)。雖然Profinet、EtherNet/IP這些總線協(xié)議在FANUC上也能用但配置起來要添加GSD文件、分配Device ID整體笨重。如果你只是傳幾十個字節(jié)的報文Socket直連是更輕巧的方案。這些場景的共同點(diǎn)是數(shù)據(jù)不是簡單的0/1信號而是有格式、有長度、有內(nèi)容的“報文”。KAREL天生就是干這個的。1.2 KAREL和TP程序的定位差異用一句話概括TP是給現(xiàn)場調(diào)試用的KAREL是給工程師寫邏輯用的。TP程序基于“指令點(diǎn)位”模型面向運(yùn)動控制和開關(guān)量邏輯簡單直觀但缺少復(fù)雜語言特性。你寫不出循環(huán)嵌套、動態(tài)數(shù)組、字符串函數(shù)也很難處理網(wǎng)絡(luò)通信中的異常分支。KAREL則是一門類Pascal的高級語言運(yùn)行在FANUC控制器內(nèi)部。它有完整的變量聲明、流程控制、子程序、數(shù)組、字符串處理還能調(diào)用系統(tǒng)級功能。很多TP實(shí)現(xiàn)不了的功能比如文件讀寫、Socket通信、復(fù)雜數(shù)學(xué)運(yùn)算都是KAREL的標(biāo)準(zhǔn)能力。打一個不恰當(dāng)?shù)N切的比方TP是空調(diào)遙控器按幾個鍵就能用KAREL是萬能遙控器能學(xué)習(xí)、能編程但需要你花時間研究說明書?，F(xiàn)場改點(diǎn)用TP系統(tǒng)級功能用KAREL這才是一個成熟工程師的工作方式。在FANUC生態(tài)里KAREL通常是一個獨(dú)立選件。控制器上有沒有開這個功能直接決定了你后面能不能編譯運(yùn)行。這一點(diǎn)我后面單獨(dú)說很多人剛開始搞就卡在這一步。1.3 開工前的環(huán)境準(zhǔn)備動手寫代碼之前先把環(huán)境捋清楚不然到后面會反復(fù)返工。軟件方面建議準(zhǔn)備Roboguide用于離線新建工作單元、導(dǎo)入KAREL源文件、做編譯驗(yàn)證。Roboguide版本盡量和現(xiàn)場控制器軟件版本對應(yīng)版本差太遠(yuǎn)容易出兼容問題。代碼編輯器推薦Notepad或者VS Code純文本保存避免Word這類工具插入奇怪格式。硬件方面一臺有網(wǎng)口的電腦一根網(wǎng)線最好再準(zhǔn)備一個工業(yè)交換機(jī)。調(diào)試初期機(jī)器人、電腦、服務(wù)端設(shè)備都在同一個局域網(wǎng)里簡單方便。網(wǎng)絡(luò)規(guī)劃是很多人忽視的點(diǎn)。機(jī)器人控制柜上一般有多個以太網(wǎng)口常用的一個用來連接外部網(wǎng)絡(luò)。IP地址要提前規(guī)劃比如機(jī)器人設(shè)192.168.0.10電腦設(shè)192.168.0.20服務(wù)端設(shè)192.168.0.30子網(wǎng)掩碼統(tǒng)一255.255.255.0。地址沖突、子網(wǎng)掩碼不一致是最常見的連接失敗原因。還有一個隱性問題很多控制器出廠時網(wǎng)絡(luò)參數(shù)是自動獲取DHCP狀態(tài)現(xiàn)場沒有DHCP服務(wù)器時會導(dǎo)致IP不對。所以在寫代碼之前建議先確認(rèn)機(jī)器人自身的網(wǎng)絡(luò)配置。FANUC一般在MENU→SETUP→HOST COMM→TCP/IP里改IP地址改完重啟網(wǎng)絡(luò)服務(wù)或控制柜。2. KAREL Socket指令細(xì)節(jié)先吃透再寫碼2.1 Socket基本原理用電話比喻講清楚做網(wǎng)絡(luò)通信軟件的人對Socket都不陌生但工業(yè)現(xiàn)場很多工程師是從PLC轉(zhuǎn)過來的對TCP/IP不太熟。我用電話比喻解釋一下。Socket通信就是兩臺設(shè)備之間建立一條“電話線路”。設(shè)備A通常是服務(wù)端先“接電話”也就是監(jiān)聽一個端口設(shè)備B客戶端主動“撥號”也就是連接服務(wù)端的IP和端口。線路建立后雙方你一句我一句地說話這就是發(fā)送和接收數(shù)據(jù)。說完了掛斷電話就是關(guān)閉連接。TCP和UDP的區(qū)別就像打電話和發(fā)短信。打電話要先接通確認(rèn)對方在聽發(fā)短信直接扔過去不管對方收沒收到。機(jī)器人通信絕大多數(shù)場景用TCP可靠不會丟數(shù)據(jù)順序也不會亂。在KAREL里機(jī)器人既可以做客戶端主動連接別人也可以做服務(wù)端等別人連進(jìn)來。這篇文章先講客戶端模式因?yàn)檫@是最常用的。服務(wù)端模式以后有機(jī)會再展開。2.2 五個核心Socket指令速查KAREL里Socket相關(guān)的指令不算多核心的就幾個。我先列個表后面寫代碼的時候會逐個用到。指令作用關(guān)鍵參數(shù)返回狀態(tài)SOCKET_CONNECT建立TCP連接服務(wù)名、通道號、服務(wù)端IP、端口status0表示成功SOCKET_SEND發(fā)送數(shù)據(jù)通道號、要發(fā)送的字符串status0表示成功SOCKET_RECV接收數(shù)據(jù)通道號、接收緩沖區(qū)status0表示成功SOCKET_CLOSE關(guān)閉連接通道號status0表示成功SOCKET_STATUS查詢連接狀態(tài)通道號status0表示連接正常關(guān)于SOCKET_CONNECT有一個參數(shù)容易讓人困惑就是它的第一個參數(shù)“服務(wù)程序名”。如果你學(xué)過FANUC的KAREL手冊會發(fā)現(xiàn)這個指令的完整簽名里有一個server program參數(shù)。在客戶端模式下這個參數(shù)通常可以填空字符串或者一個占位符因?yàn)樗辉谀承┫到y(tǒng)級通信場景下才有實(shí)際意義。不同控制器版本對它的處理略有差別個別老版本要求必須傳一個非空字符串你就傳一個不沖突的服務(wù)名占位即可?？傊阅憧刂乒窭锏腒AREL參考手冊為準(zhǔn)。通道號是KAREL里的核心概念類似于文件句柄。一個程序可以同時維護(hù)多個Socket連接只要通道號不重復(fù)。通道號范圍一般從1開始具體上限取決于控制器內(nèi)存和系統(tǒng)配置。狀態(tài)值status是一個整數(shù)返回0表示成功非0表示各種錯誤。但要注意不同控制器版本對負(fù)值錯誤碼的定義不完全相同。我遇到過的有-1表示網(wǎng)絡(luò)錯誤-2表示連接已關(guān)閉-3表示緩沖區(qū)溢出-4表示超時。這些數(shù)值不能死記到手第一件事就是查你對應(yīng)版本的KAREL手冊里的錯誤碼表。2.3 通道號、狀態(tài)值和字符串緩沖區(qū)寫KAREL Socket程序時最容易翻車的地方不在指令本身而在細(xì)節(jié)處理。字符串緩沖區(qū)長度要提前聲明。KAREL的字符串變量是固定長度聲明多少就是多少。比如recv_buf : STRING[128]最多能接收128個字符。如果對端發(fā)來的數(shù)據(jù)超過128字節(jié)程序會報錯或者截斷。在實(shí)際項(xiàng)目中建議把接收緩沖區(qū)聲明得比你預(yù)期報文長一點(diǎn)寧可浪費(fèi)一點(diǎn)內(nèi)存也不要讓它爆掉。但也要注意KAREL字符串最大長度有限制不是你想聲明多長就多長。超大報文建議拆包分多次接收或者改用文件方式緩沖。SOCKET_RECV是阻塞還是非阻塞這個問題很多人糾結(jié)。KAREL里的SOCKET_RECV在未收到數(shù)據(jù)時會發(fā)生等待直到收到數(shù)據(jù)、連接關(guān)閉或者超時。這意味著如果你的通信對象“不說話”你的KAREL程序可能會一直停在那里。所以在協(xié)議設(shè)計上一定要考慮超時保護(hù)。一種常見做法如果服務(wù)端可能長時間不回復(fù)程序側(cè)要有“等不到就撤”的邏輯。比如用SOCKET_STATUS輪詢連接狀態(tài)或者用定時循環(huán)判斷接收結(jié)果。當(dāng)然最根本的解決方案是在服務(wù)端設(shè)計好響應(yīng)機(jī)制任何請求都會在約定時間內(nèi)返回。設(shè)計通信協(xié)議時規(guī)定響應(yīng)時間這是雙方的事不是機(jī)器人單方面能解決的。發(fā)送數(shù)據(jù)時KAREL按字符串原樣發(fā)送ASCII字符。如果對端要求報文末尾帶結(jié)束符比如“\r\n”那你在KAREL里就不能直接寫這種轉(zhuǎn)義字符得通過別的方式拼進(jìn)去或者在協(xié)議里事先約定好固定長度讓對端按長度截取。這些都屬于通信協(xié)議設(shè)計的范疇建議在寫代碼之前就把協(xié)議明確下來。3. 完整.KL文件實(shí)現(xiàn)與逐段拆解3.1 程序功能設(shè)計和變量規(guī)劃這一節(jié)直接上代碼。我先描述一下這個程序要完成的功能方便你對照代碼理解。程序名為CONNECT_DEV扮演客戶端角色。啟動后連接指定IP和端口連接成功則循環(huán)執(zhí)行以下操作向服務(wù)端發(fā)送“POLL”字符串等待服務(wù)端回復(fù)。如果回復(fù)內(nèi)容是“OK”打印成功信息并繼續(xù)下一次循環(huán)如果回復(fù)是“NG”或者其他內(nèi)容打印狀態(tài)但連接不終止如果接收失敗或者發(fā)送失敗退出循環(huán)并關(guān)閉連接。這是一個最小可用的演示程序。實(shí)際項(xiàng)目里你會在“Server status OK”這個分支里放真正的業(yè)務(wù)邏輯比如去執(zhí)行運(yùn)動程序、更新寄存器、觸發(fā)IO等。但作為模板它的結(jié)構(gòu)足夠清晰了。變量規(guī)劃如下變量名類型用途io_chINTEGERSocket通道號stINTEGER指令執(zhí)行狀態(tài)值ip_addrSTRING[16]服務(wù)端IP地址字符串ip_portINTEGER服務(wù)端端口號send_bufSTRING[64]發(fā)送緩沖區(qū)recv_bufSTRING[128]接收緩沖區(qū)loop_runBOOLEAN循環(huán)運(yùn)行標(biāo)志位3.2 完整KAREL源文件.KL下面是完整的.KL文件內(nèi)容。我全部用英文注釋這是故意為之。FANUC控制器的KAREL編譯器對非ASCII字符支持并不穩(wěn)定中文字符可能導(dǎo)致編譯失敗。這個坑我踩過后面會專門說。PROGRAM CONNECT_DEV -- KAREL socket demo -- Purpose: connect external server, send POLL, wait reply -- Note: compile with KAREL option enabled VAR io_ch : INTEGER st : INTEGER ip_addr : STRING[16] ip_port : INTEGER send_buf : STRING[64] recv_buf : STRING[128] loop_run : BOOLEAN BEGIN -- initialize io_ch : 1 ip_addr : 192.168.0.10 ip_port : 5000 send_buf : POLL loop_run : TRUE -- establish TCP connection SOCKET_CONNECT(, io_ch, ip_addr, ip_port, st) IF st 0 THEN WRITE(Connect error st, st, CR) ELSE WRITE(Connect OK, CR) ENDIF -- main loop WHILE (loop_run TRUE) AND (st 0) DO -- send data SOCKET_SEND(io_ch, send_buf, st) IF st 0 THEN WRITE(Send error st, st, CR) ELSE WRITE(Send OK, CR) -- receive data SOCKET_RECV(io_ch, recv_buf, st) IF st 0 THEN WRITE(Recv:, recv_buf, CR) IF recv_buf OK THEN WRITE(Server status OK, CR) ELSE WRITE(Server status NG, CR) ENDIF ELSE WRITE(Recv error st, st, CR) loop_run : FALSE ENDIF ENDIF DELAY 500 ENDWHILE -- close socket SOCKET_CLOSE(io_ch, st) END CONNECT_DEV這份代碼邏輯并不復(fù)雜照著抄基本就能跑通。但有幾個細(xì)節(jié)值得展開講避免你復(fù)制后在現(xiàn)場蒙圈。3.3 逐段邏輯講解程序開頭是變量聲明區(qū)。KAREL程序的結(jié)構(gòu)和Pascal很像VAR區(qū)聲明所有局部變量。注意字符串變量后面的[16]、[64]、[128]這是固定長度字符串的聲明方式。賦值時如果字符串實(shí)際長度超過聲明長度會觸發(fā)運(yùn)行時錯誤。初始化部分給變量賦初值。IP地址和端口號在這個版本里是硬編碼的好處是代碼邏輯簡單壞處是每次換IP都要改代碼重新編譯。實(shí)際項(xiàng)目中我更推薦把這幾個值抽出來寫到TP程序的字符串寄存器里或者在程序啟動時從文件讀取。KAREL本身支持文件讀寫完全可以把通信參數(shù)放到一個配置文件里。SOCKET_CONNECT那一段是整個程序的地基。連接不成功后面全白搭。需要注意這里我把連接是否成功的判斷放到了IF里但沒有在失敗后立刻RETURN。為什么因?yàn)樵谀承﹫鼍跋鲁绦蛐枰卦囘B接而不是直接退出。我在演示代碼里選擇了直接往下走讓W(xué)HILE條件自己判斷。如果你想做重試在IF失敗分支里寫一個延時然后再次SOCKET_CONNECT即可。主循環(huán)是通信核心。每次循環(huán)先SOCKET_SEND發(fā)一個“POLL”再SOCKET_RECV等回復(fù)。值得注意的是我用了AND (st 0)作為循環(huán)條件的一部分。這保證了一旦之前出現(xiàn)錯誤程序不會繼續(xù)空轉(zhuǎn)而是跳過循環(huán)體直接執(zhí)行后續(xù)清理。你要注意發(fā)送和接收的節(jié)奏。DELAY 500表示每次循環(huán)間隔500毫秒這個值不是隨便寫的。如果循環(huán)過快會占滿控制器CPU時間影響機(jī)器人運(yùn)動程序的實(shí)時性。如果循環(huán)過慢對外響應(yīng)又不及時。具體多少合適要看你的業(yè)務(wù)場景。做機(jī)器人通信的永遠(yuǎn)要記住一個原則通信進(jìn)程不能影響運(yùn)動控制進(jìn)程。最后一個SOCKET_CLOSE是收尾操作。很多人會忽略關(guān)閉連接這一步程序跑完就完事。但在長任務(wù)循環(huán)中如果連接沒關(guān)閉就反復(fù)嘗試重連資源不會立即釋放嚴(yán)重時可能導(dǎo)致后續(xù)連接失敗。養(yǎng)成習(xí)慣每次通信結(jié)束后顯式關(guān)閉。3.4 和TP程序交換數(shù)據(jù)的方法KAREL程序不能獨(dú)立存在于FANUC的世界里它最終還是要和TP程序配合。最常見的模式是TP程序負(fù)責(zé)運(yùn)動軌跡和流程調(diào)度KAREL程序負(fù)責(zé)通信和協(xié)議處理兩者之間通過系統(tǒng)變量傳遞數(shù)據(jù)。具體怎么交換數(shù)據(jù)方法有很多我用得比較多的是寄存器。FANUC有通用寄存器R[]和位置寄存器PR[]在KAREL里可以直接讀寫。比如KAREL收到服務(wù)端的坐標(biāo)值后拆解字符串轉(zhuǎn)成浮點(diǎn)數(shù)寫入R[10]、R[11]、R[12]TP程序?qū)崟r讀取這幾位寄存器做點(diǎn)位偏移。字符串寄存器SR[]也可以作為交換通道。從KAREL往SR寫字符串TP里讀出來顯示或做其他判斷。反過來TP在示教器上讓操作員輸入一個IP地址存到SR[5]KAREL再把這個字符串讀出來作為連接目標(biāo)這樣就實(shí)現(xiàn)了運(yùn)行時靈活配置不用每次改代碼。KAREL讀寫寄存器的語法不復(fù)雜不同版本略有差異但整體思路一致。這也是為什么我建議把通信參數(shù)從代碼中抽出來的底層原因代碼邏輯不變只改寄存器里的值就能應(yīng)對不同的現(xiàn)場服務(wù)器。4. 編譯、加載和聯(lián)調(diào)完整流程4.1 把.KL編譯成控制器能運(yùn)行的程序.KL是KAREL源文件就像C語言的.c文件控制器不能直接運(yùn)行需要編譯成.pc文件。這個編譯動作可以在Roboguide里做也可以直接利用控制器上的KAREL編譯功能。Roboguide流程大致是這樣的打開對應(yīng)控制柜版本的工作單元菜單找到File→Import/Export→Import KAREL Source選擇你的.KL文件Roboguide會自動進(jìn)行編譯并生成.pc文件。編譯完成后在程序選擇界面能看到這個程序后面就能像TP程序一樣被調(diào)用。實(shí)機(jī)操作流程也類似。把.KL文件拷貝到CF卡或者U盤插到控制柜上在示教器的文件管理界面里找到它導(dǎo)入后控制系統(tǒng)會自動編譯。如果只是導(dǎo)入.pc文件就不需要再編譯了。注意這里有一個前提條件控制器必須開通KAREL功能選項(xiàng)。如果系統(tǒng)沒有這個選項(xiàng)導(dǎo)入時會直接報錯甚至文件管理界面都不認(rèn)識.KL文件。怎么判斷看系統(tǒng)信息里的選項(xiàng)列表或者在文件管理界面嘗試導(dǎo)入時報“非法指令”一類的錯誤。真要遇到?jīng)]開通的情況只能聯(lián)系FANUC購買并開通選項(xiàng)。4.2 從TP程序正式調(diào)用KAREL任務(wù)KAREL程序編譯好之后還不能直接在示教器上像TP程序那樣被選中運(yùn)行。它更像一個函數(shù)庫或者后臺工具需要從TP程序里通過CALL指令調(diào)用。在TP程序里寫一行CALL CONNECT_DEV ;這行代碼會讓控制器把控制權(quán)交給KAREL程序KAREL程序執(zhí)行完才會返回到TP的下一行。也就是說如果你的KAREL程序里有長循環(huán)TP會一直停在那里等它跑完。如果KAREL程序設(shè)計成無限循環(huán)那TP程序也會一直卡住。所以通常有兩種使用策略。一種是短任務(wù)模式KAREL程序只處理一次通信就結(jié)束TP每需要通信一次就CALL一次。另一種是長任務(wù)模式KAREL程序啟動后常駐內(nèi)存在后臺循環(huán)監(jiān)聽或者發(fā)送TP通過寄存器與之交換結(jié)果。長任務(wù)模式對程序結(jié)構(gòu)要求更高調(diào)試也更復(fù)雜建議新手先從短任務(wù)開始。調(diào)用KAREL程序時示教器上可以查看它的運(yùn)行狀態(tài)。如果程序里有WRITE輸出示教器會顯示對應(yīng)的信息。這在你調(diào)試時非常有用相當(dāng)于讓機(jī)器人把中間過程“講”給你聽。4.3 用PC端調(diào)試工具完成Socket聯(lián)調(diào)代碼寫完了編譯過了接下來要驗(yàn)證通信是否真的能通。這一步最好在PC上先模擬不要直接上真實(shí)設(shè)備原因很現(xiàn)實(shí)真實(shí)服務(wù)端設(shè)備不一定隨時可用而且出了問題不好定位。我習(xí)慣用Python寫一個極簡的TCP服務(wù)端模擬外部設(shè)備。下面這段代碼監(jiān)聽5000端口收到機(jī)器人的數(shù)據(jù)后打印出來然后回復(fù)“OK”。import socket s socket.socket(socket.AF_INET, socket.SOCK_STREAM) s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1) s.bind((0.0.0.0, 5000)) s.listen(1) print(listening on 5000...) while True: conn, addr s.accept() print(connected by, addr) data conn.recv(1024) print(recv:, data.decode()) conn.send(bOK) conn.close()這段代碼用到了一個關(guān)鍵選項(xiàng)SO_REUSEADDR。沒有這個選項(xiàng)時如果服務(wù)端程序崩潰后立刻重啟系統(tǒng)可能報“bind: only one usage of each socket address”的錯誤意思是端口還被上一個進(jìn)程占用著處于TIME_WAIT狀態(tài)。加了SO_REUSEADDR就能快速恢復(fù)服務(wù)端。這正是你在寫網(wǎng)絡(luò)通信軟件時一定會遇到的一個經(jīng)驗(yàn)點(diǎn)。聯(lián)調(diào)流程是這樣的PC先運(yùn)行Python服務(wù)端再在機(jī)器人側(cè)執(zhí)行KAREL程序。觀察示教器上應(yīng)該打印Connect OK、Send OK、Recv:OKPC端看到收到的POLL字符串。如果一切正常恭喜最小通信鏈路跑通了。4.4 實(shí)機(jī)聯(lián)調(diào)時的幾個檢查點(diǎn)到了真實(shí)設(shè)備上檢查重點(diǎn)要轉(zhuǎn)移。先檢查網(wǎng)絡(luò)連通性。在PC上持續(xù)Ping機(jī)器人IP或者從示教器端Ping PC。能Ping通說明底層的IP層通信沒問題可以聚焦到應(yīng)用層。Ping不通就先查網(wǎng)線、交換機(jī)、IP配置不要急著懷疑代碼。再檢查服務(wù)端是否真的在監(jiān)聽。很多時候機(jī)器人報連接失敗不是機(jī)器人的問題而是服務(wù)端沒起來。在PC上用netstat命令查看監(jiān)聽狀態(tài)或者在服務(wù)端打印一條日志確認(rèn)端口是開的。然后檢查報文交互。機(jī)器人發(fā)出去的數(shù)據(jù)服務(wù)端是否完整收到服務(wù)端回復(fù)的數(shù)據(jù)機(jī)器人是否完整解析這里最容易出現(xiàn)“半包”和“粘包”問題。TCP是流式協(xié)議它不保證你發(fā)一次對方就收一次發(fā)的時機(jī)、網(wǎng)絡(luò)緩沖都可能影響。在你的通信協(xié)議里定義清楚數(shù)據(jù)邊界比如固定長度或者結(jié)束符這是寫網(wǎng)絡(luò)應(yīng)用的基本功。最后檢查控制器的表現(xiàn)。長時間通信時觀察機(jī)器人運(yùn)動是否受影響示教器是否有報警控制器是否出現(xiàn)過熱。通信程序如果設(shè)計得不好比如在死循環(huán)里頻繁刷WRITE指令會拖累整個控制器。5. 常見問題與排查技巧實(shí)錄5.1 連接失敗先看狀態(tài)值再看網(wǎng)絡(luò)SOCKET_CONNECT返回非0這是最讓人頭疼的起步問題。我的排查順序是先看狀態(tài)值再看網(wǎng)絡(luò)最后查代碼。狀態(tài)值能給你一個大方向。查出錯誤碼后翻手冊對應(yīng)的含義。如果是網(wǎng)絡(luò)層錯誤大概率是IP寫錯、端口沒監(jiān)聽、網(wǎng)線不通。如果是連接被拒絕通常說明服務(wù)端端口沒開或者防火墻攔了。這時候去PC上啟動服務(wù)端用netstat驗(yàn)證監(jiān)聽狀態(tài)問題就能定位。還有一種隱蔽情況控制柜里配置了多個網(wǎng)絡(luò)接口機(jī)器人側(cè)用的物理網(wǎng)口和IP不在同一個網(wǎng)段。FANUC控制柜上有多個以太網(wǎng)口有些是內(nèi)部用的有些是外部通信的接錯口也會導(dǎo)致連接失敗。建議接線時在網(wǎng)口旁邊貼標(biāo)簽避免現(xiàn)場混亂。5.2 接收超時和亂碼多半是協(xié)議和緩沖區(qū)問題SOCKET_RECV超時優(yōu)先檢查服務(wù)端是否真的回復(fù)了。用Wireshark抓包最直觀能清楚看到TCP握手、數(shù)據(jù)發(fā)送、ACK響應(yīng)全過程。如果服務(wù)端明明發(fā)了數(shù)據(jù)機(jī)器人還是超時那就要查接收緩沖區(qū)大小是不是報文比緩沖區(qū)更長導(dǎo)致KAREL無法完整接收。亂碼問題通常是編碼不一致。機(jī)器人發(fā)送的是ASCII字符串服務(wù)端按GBK或者UTF-16解析自然亂碼。解決辦法是規(guī)范通信協(xié)議明確使用ASCII或UTF-8編碼字符串里不要夾雜不可見字符。還有一類問題很奇怪但確實(shí)存在服務(wù)端數(shù)據(jù)發(fā)得太快機(jī)器人還沒準(zhǔn)備好接收數(shù)據(jù)就丟了一部分。TCP本身有緩沖區(qū)小概率情況下會丟包或亂序。穩(wěn)妥的做法是在協(xié)議層做應(yīng)答機(jī)制每條報文都等對方確認(rèn)后再發(fā)下一條。這也是我演示代碼里用“POLL等OK”循環(huán)的意義所在。5.3 編譯和運(yùn)行時的KAREL坑KAREL編譯失敗最常見的原因是注釋和編碼問題。以前我寫過一次中文注釋結(jié)果Roboguide報錯找不到錯誤原因最后把中文刪掉就編譯通過了。從此我的.KL文件全部用英文注釋除非確認(rèn)當(dāng)前環(huán)境的編譯器支持中文。另外KAREL程序文件名和程序名必須一致。你寫的PROGRAM CONNECT_DEV對應(yīng)的文件也必須是CONNECT_DEV.KL大小寫在多數(shù)系統(tǒng)里可以忽略但建議全大寫統(tǒng)一少給自己找麻煩。變量聲明區(qū)的類型寫錯、字符串長度和實(shí)際賦值不匹配也會編譯失敗。比如聲明STRING[16]卻給它賦了一個20個字符的字符串運(yùn)行時會報警告甚至異常。如果你是從別的語言轉(zhuǎn)過來的務(wù)必記住KAREL字符串是定長的概念不是動態(tài)數(shù)組。運(yùn)行時還有一個經(jīng)典問題KAREL程序占用的內(nèi)存?？刂破鲀?nèi)存不是無限的KAREL程序如果寫得太大或者同時運(yùn)行太多KAREL任務(wù)會導(dǎo)致內(nèi)存不足報錯。處理辦法是清理不用的歷史程序或者把程序拆成多個小模塊按需調(diào)用。5.4 常見問題速查表整理了一份排查表覆蓋我遇到過的典型問題你可以直接照著檢查。現(xiàn)象可能原因處理辦法CONNECT返回非0IP/端口錯誤、服務(wù)端未監(jiān)聽、網(wǎng)線斷開先Ping再netstat確認(rèn)服務(wù)端在線連接成功但SEND失敗連接已被對方關(guān)閉檢查服務(wù)端是否還在運(yùn)行增加重連機(jī)制RECV超時服務(wù)端沒回復(fù)或回復(fù)太長抓包確認(rèn)加大緩沖區(qū)調(diào)整協(xié)議RECV亂碼編碼不一致統(tǒng)一ASCII避免不可見字符編譯報錯無明確信息中文注釋、編碼問題改英文注釋用純文本保存運(yùn)行時報內(nèi)存不足KAREL程序過大或任務(wù)過多清理程序拆功能模塊SOCKET_CLOSE后重連失敗TIME_WAIT狀態(tài)占用端口服務(wù)端開SO_REUSEADDR客戶端延時重連示教器無輸出WRITE被屏蔽或程序未運(yùn)行檢查程序調(diào)用方式確認(rèn)程序狀態(tài)這里面每一行都對應(yīng)著一次或多次現(xiàn)場踩坑。做通信類項(xiàng)目做好排查記錄比啥都強(qiáng)。5.5 斷線重連和心跳機(jī)制讓方案更接近生產(chǎn)演示程序很簡單但真正生產(chǎn)環(huán)境不會這么“傻白甜”。外部設(shè)備隨時可能重啟、斷網(wǎng)、出現(xiàn)異常你的KAREL程序必須有應(yīng)對能力。斷線重連是最基本的。設(shè)計思路是主循環(huán)里不斷查詢連接狀態(tài)如果發(fā)現(xiàn)連接斷開就嘗試重新SOCKET_CONNECT。重連的間隔不能太短否則會持續(xù)占用CPU推薦至少間隔1到2秒。重連超過N次后可以報警或者退出避免無限循環(huán)消耗資源。心跳機(jī)制也很有用。機(jī)器人和服務(wù)端約定一個特殊報文比如每5秒發(fā)一次“PING”服務(wù)端回復(fù)“PONG”。連續(xù)幾次沒收到PONG就認(rèn)為連接失效主動關(guān)閉并重連。這樣能及時感知網(wǎng)絡(luò)狀態(tài)而不是等到真正發(fā)業(yè)務(wù)數(shù)據(jù)時才發(fā)現(xiàn)斷線。這些邏輯寫起來不難但能顯著提升通信方案的穩(wěn)定性。如果你拿演示代碼直接上生產(chǎn)一旦外部設(shè)備出問題機(jī)器人可能就傻等在那里這就是事故了。我自己的體會是Socket通信這件事代碼本身只占三成工作量剩下七成全在協(xié)議設(shè)計和異常處理上。你花在思考“斷線了怎么辦”“粘包了怎么拆”“服務(wù)端不回復(fù)怎么辦”這些場景上的時間最后都會變成系統(tǒng)穩(wěn)定性的回報。希望這份.KL模板和思路能幫你在FANUC上少走幾步彎路。 FANUC機(jī)器人KAREL Socket通信實(shí)戰(zhàn)：從原理到代碼實(shí)現(xiàn)
搞工業(yè)機(jī)器人的朋友十有八九會碰到一個需求機(jī)器人得跟外部系統(tǒng)說上話。視覺系統(tǒng)要告訴它“工件找到了坐標(biāo)是多少”MES要下發(fā)當(dāng)前工單上位機(jī)要查機(jī)器人狀態(tài)。FANUC的TP示教器程序?qū)戇壿?、走點(diǎn)位很順手可一旦牽扯到字符串解析、自定義報文、斷線重連TP就明顯吃力了。這時候就得請出KARELFANUC控制器里真正能干“臟活累活”的高級語言而KAREL里最實(shí)用的網(wǎng)絡(luò)能力就是SOCKET指令。這篇文章把我實(shí)踐過的KAREL Socket通信套路完整整理了一遍包括一條能直接用的思路、一份完整的.KL源文件、從編譯到加載再到聯(lián)調(diào)的流程還有現(xiàn)場排查問題的經(jīng)驗(yàn)。做FANUC集成的電氣工程師、機(jī)器人應(yīng)用工程師或者正在研究機(jī)器人網(wǎng)絡(luò)通信的朋友這篇應(yīng)該能幫你少走不少彎路。1. 為什么KAREL成了Socket通信的最佳選擇1.1 場景需求機(jī)器人為什么要連外部設(shè)備工業(yè)現(xiàn)場不是一臺機(jī)器人單打獨(dú)斗設(shè)備之間總要交換信息。最常見的幾類場景我隨便舉幾個。視覺引導(dǎo)場景相機(jī)拍完照通過TCP把坐標(biāo)發(fā)給機(jī)器人。機(jī)器人收到坐標(biāo)后算偏移量再走修正點(diǎn)位。這個過程中報文的格式可能是一行字符串比如“X123.4,Y56.7,Z-10.2”也可能是一段JSON或者自定義結(jié)構(gòu)體。TP程序雖然能做簡單的IF判斷但你讓它去“拆字符串”“截字段”“轉(zhuǎn)浮點(diǎn)數(shù)”那是一場災(zāi)難。MES和上位機(jī)場景機(jī)器人完成任務(wù)后要上報結(jié)果或者接收下發(fā)的料號、任務(wù)號。這類通信往往要求一定的協(xié)議比如幀頭幀尾、校驗(yàn)位、超時重發(fā)。純TP實(shí)現(xiàn)會非常痛苦代碼寫出來長到你自己都不想維護(hù)。PLC網(wǎng)關(guān)和掃碼槍場景很多第三方設(shè)備支持TCP/IP通過Socket方式直接收發(fā)數(shù)據(jù)。雖然Profinet、EtherNet/IP這些總線協(xié)議在FANUC上也能用但配置起來要添加GSD文件、分配Device ID整體笨重。如果你只是傳幾十個字節(jié)的報文Socket直連是更輕巧的方案。這些場景的共同點(diǎn)是數(shù)據(jù)不是簡單的0/1信號而是有格式、有長度、有內(nèi)容的“報文”。KAREL天生就是干這個的。1.2 KAREL和TP程序的定位差異用一句話概括TP是給現(xiàn)場調(diào)試用的KAREL是給工程師寫邏輯用的。TP程序基于“指令點(diǎn)位”模型面向運(yùn)動控制和開關(guān)量邏輯簡單直觀但缺少復(fù)雜語言特性。你寫不出循環(huán)嵌套、動態(tài)數(shù)組、字符串函數(shù)也很難處理網(wǎng)絡(luò)通信中的異常分支。KAREL則是一門類Pascal的高級語言運(yùn)行在FANUC控制器內(nèi)部。它有完整的變量聲明、流程控制、子程序、數(shù)組、字符串處理還能調(diào)用系統(tǒng)級功能。很多TP實(shí)現(xiàn)不了的功能比如文件讀寫、Socket通信、復(fù)雜數(shù)學(xué)運(yùn)算都是KAREL的標(biāo)準(zhǔn)能力。打一個不恰當(dāng)?shù)N切的比方TP是空調(diào)遙控器按幾個鍵就能用KAREL是萬能遙控器能學(xué)習(xí)、能編程但需要你花時間研究說明書?，F(xiàn)場改點(diǎn)用TP系統(tǒng)級功能用KAREL這才是一個成熟工程師的工作方式。在FANUC生態(tài)里KAREL通常是一個獨(dú)立選件。控制器上有沒有開這個功能直接決定了你后面能不能編譯運(yùn)行。這一點(diǎn)我后面單獨(dú)說很多人剛開始搞就卡在這一步。1.3 開工前的環(huán)境準(zhǔn)備動手寫代碼之前先把環(huán)境捋清楚不然到后面會反復(fù)返工。軟件方面建議準(zhǔn)備Roboguide用于離線新建工作單元、導(dǎo)入KAREL源文件、做編譯驗(yàn)證。Roboguide版本盡量和現(xiàn)場控制器軟件版本對應(yīng)版本差太遠(yuǎn)容易出兼容問題。代碼編輯器推薦Notepad或者VS Code純文本保存避免Word這類工具插入奇怪格式。硬件方面一臺有網(wǎng)口的電腦一根網(wǎng)線最好再準(zhǔn)備一個工業(yè)交換機(jī)。調(diào)試初期機(jī)器人、電腦、服務(wù)端設(shè)備都在同一個局域網(wǎng)里簡單方便。網(wǎng)絡(luò)規(guī)劃是很多人忽視的點(diǎn)。機(jī)器人控制柜上一般有多個以太網(wǎng)口常用的一個用來連接外部網(wǎng)絡(luò)。IP地址要提前規(guī)劃比如機(jī)器人設(shè)192.168.0.10電腦設(shè)192.168.0.20服務(wù)端設(shè)192.168.0.30子網(wǎng)掩碼統(tǒng)一255.255.255.0。地址沖突、子網(wǎng)掩碼不一致是最常見的連接失敗原因。還有一個隱性問題很多控制器出廠時網(wǎng)絡(luò)參數(shù)是自動獲取DHCP狀態(tài)現(xiàn)場沒有DHCP服務(wù)器時會導(dǎo)致IP不對。所以在寫代碼之前建議先確認(rèn)機(jī)器人自身的網(wǎng)絡(luò)配置。FANUC一般在MENU→SETUP→HOST COMM→TCP/IP里改IP地址改完重啟網(wǎng)絡(luò)服務(wù)或控制柜。2. KAREL Socket指令細(xì)節(jié)先吃透再寫碼2.1 Socket基本原理用電話比喻講清楚做網(wǎng)絡(luò)通信軟件的人對Socket都不陌生但工業(yè)現(xiàn)場很多工程師是從PLC轉(zhuǎn)過來的對TCP/IP不太熟。我用電話比喻解釋一下。Socket通信就是兩臺設(shè)備之間建立一條“電話線路”。設(shè)備A通常是服務(wù)端先“接電話”也就是監(jiān)聽一個端口設(shè)備B客戶端主動“撥號”也就是連接服務(wù)端的IP和端口。線路建立后雙方你一句我一句地說話這就是發(fā)送和接收數(shù)據(jù)。說完了掛斷電話就是關(guān)閉連接。TCP和UDP的區(qū)別就像打電話和發(fā)短信。打電話要先接通確認(rèn)對方在聽發(fā)短信直接扔過去不管對方收沒收到。機(jī)器人通信絕大多數(shù)場景用TCP可靠不會丟數(shù)據(jù)順序也不會亂。在KAREL里機(jī)器人既可以做客戶端主動連接別人也可以做服務(wù)端等別人連進(jìn)來。這篇文章先講客戶端模式因?yàn)檫@是最常用的。服務(wù)端模式以后有機(jī)會再展開。2.2 五個核心Socket指令速查KAREL里Socket相關(guān)的指令不算多核心的就幾個。我先列個表后面寫代碼的時候會逐個用到。指令作用關(guān)鍵參數(shù)返回狀態(tài)SOCKET_CONNECT建立TCP連接服務(wù)名、通道號、服務(wù)端IP、端口status0表示成功SOCKET_SEND發(fā)送數(shù)據(jù)通道號、要發(fā)送的字符串status0表示成功SOCKET_RECV接收數(shù)據(jù)通道號、接收緩沖區(qū)status0表示成功SOCKET_CLOSE關(guān)閉連接通道號status0表示成功SOCKET_STATUS查詢連接狀態(tài)通道號status0表示連接正常關(guān)于SOCKET_CONNECT有一個參數(shù)容易讓人困惑就是它的第一個參數(shù)“服務(wù)程序名”。如果你學(xué)過FANUC的KAREL手冊會發(fā)現(xiàn)這個指令的完整簽名里有一個server program參數(shù)。在客戶端模式下這個參數(shù)通常可以填空字符串或者一個占位符因?yàn)樗辉谀承┫到y(tǒng)級通信場景下才有實(shí)際意義。不同控制器版本對它的處理略有差別個別老版本要求必須傳一個非空字符串你就傳一個不沖突的服務(wù)名占位即可?？傊阅憧刂乒窭锏腒AREL參考手冊為準(zhǔn)。通道號是KAREL里的核心概念類似于文件句柄。一個程序可以同時維護(hù)多個Socket連接只要通道號不重復(fù)。通道號范圍一般從1開始具體上限取決于控制器內(nèi)存和系統(tǒng)配置。狀態(tài)值status是一個整數(shù)返回0表示成功非0表示各種錯誤。但要注意不同控制器版本對負(fù)值錯誤碼的定義不完全相同。我遇到過的有-1表示網(wǎng)絡(luò)錯誤-2表示連接已關(guān)閉-3表示緩沖區(qū)溢出-4表示超時。這些數(shù)值不能死記到手第一件事就是查你對應(yīng)版本的KAREL手冊里的錯誤碼表。2.3 通道號、狀態(tài)值和字符串緩沖區(qū)寫KAREL Socket程序時最容易翻車的地方不在指令本身而在細(xì)節(jié)處理。字符串緩沖區(qū)長度要提前聲明。KAREL的字符串變量是固定長度聲明多少就是多少。比如recv_buf : STRING[128]最多能接收128個字符。如果對端發(fā)來的數(shù)據(jù)超過128字節(jié)程序會報錯或者截斷。在實(shí)際項(xiàng)目中建議把接收緩沖區(qū)聲明得比你預(yù)期報文長一點(diǎn)寧可浪費(fèi)一點(diǎn)內(nèi)存也不要讓它爆掉。但也要注意KAREL字符串最大長度有限制不是你想聲明多長就多長。超大報文建議拆包分多次接收或者改用文件方式緩沖。SOCKET_RECV是阻塞還是非阻塞這個問題很多人糾結(jié)。KAREL里的SOCKET_RECV在未收到數(shù)據(jù)時會發(fā)生等待直到收到數(shù)據(jù)、連接關(guān)閉或者超時。這意味著如果你的通信對象“不說話”你的KAREL程序可能會一直停在那里。所以在協(xié)議設(shè)計上一定要考慮超時保護(hù)。一種常見做法如果服務(wù)端可能長時間不回復(fù)程序側(cè)要有“等不到就撤”的邏輯。比如用SOCKET_STATUS輪詢連接狀態(tài)或者用定時循環(huán)判斷接收結(jié)果。當(dāng)然最根本的解決方案是在服務(wù)端設(shè)計好響應(yīng)機(jī)制任何請求都會在約定時間內(nèi)返回。設(shè)計通信協(xié)議時規(guī)定響應(yīng)時間這是雙方的事不是機(jī)器人單方面能解決的。發(fā)送數(shù)據(jù)時KAREL按字符串原樣發(fā)送ASCII字符。如果對端要求報文末尾帶結(jié)束符比如“\r\n”那你在KAREL里就不能直接寫這種轉(zhuǎn)義字符得通過別的方式拼進(jìn)去或者在協(xié)議里事先約定好固定長度讓對端按長度截取。這些都屬于通信協(xié)議設(shè)計的范疇建議在寫代碼之前就把協(xié)議明確下來。3. 完整.KL文件實(shí)現(xiàn)與逐段拆解3.1 程序功能設(shè)計和變量規(guī)劃這一節(jié)直接上代碼。我先描述一下這個程序要完成的功能方便你對照代碼理解。程序名為CONNECT_DEV扮演客戶端角色。啟動后連接指定IP和端口連接成功則循環(huán)執(zhí)行以下操作向服務(wù)端發(fā)送“POLL”字符串等待服務(wù)端回復(fù)。如果回復(fù)內(nèi)容是“OK”打印成功信息并繼續(xù)下一次循環(huán)如果回復(fù)是“NG”或者其他內(nèi)容打印狀態(tài)但連接不終止如果接收失敗或者發(fā)送失敗退出循環(huán)并關(guān)閉連接。這是一個最小可用的演示程序。實(shí)際項(xiàng)目里你會在“Server status OK”這個分支里放真正的業(yè)務(wù)邏輯比如去執(zhí)行運(yùn)動程序、更新寄存器、觸發(fā)IO等。但作為模板它的結(jié)構(gòu)足夠清晰了。變量規(guī)劃如下變量名類型用途io_chINTEGERSocket通道號stINTEGER指令執(zhí)行狀態(tài)值ip_addrSTRING[16]服務(wù)端IP地址字符串ip_portINTEGER服務(wù)端端口號send_bufSTRING[64]發(fā)送緩沖區(qū)recv_bufSTRING[128]接收緩沖區(qū)loop_runBOOLEAN循環(huán)運(yùn)行標(biāo)志位3.2 完整KAREL源文件.KL下面是完整的.KL文件內(nèi)容。我全部用英文注釋這是故意為之。FANUC控制器的KAREL編譯器對非ASCII字符支持并不穩(wěn)定中文字符可能導(dǎo)致編譯失敗。這個坑我踩過后面會專門說。PROGRAM CONNECT_DEV -- KAREL socket demo -- Purpose: connect external server, send POLL, wait reply -- Note: compile with KAREL option enabled VAR io_ch : INTEGER st : INTEGER ip_addr : STRING[16] ip_port : INTEGER send_buf : STRING[64] recv_buf : STRING[128] loop_run : BOOLEAN BEGIN -- initialize io_ch : 1 ip_addr : 192.168.0.10 ip_port : 5000 send_buf : POLL loop_run : TRUE -- establish TCP connection SOCKET_CONNECT(, io_ch, ip_addr, ip_port, st) IF st 0 THEN WRITE(Connect error st, st, CR) ELSE WRITE(Connect OK, CR) ENDIF -- main loop WHILE (loop_run TRUE) AND (st 0) DO -- send data SOCKET_SEND(io_ch, send_buf, st) IF st 0 THEN WRITE(Send error st, st, CR) ELSE WRITE(Send OK, CR) -- receive data SOCKET_RECV(io_ch, recv_buf, st) IF st 0 THEN WRITE(Recv:, recv_buf, CR) IF recv_buf OK THEN WRITE(Server status OK, CR) ELSE WRITE(Server status NG, CR) ENDIF ELSE WRITE(Recv error st, st, CR) loop_run : FALSE ENDIF ENDIF DELAY 500 ENDWHILE -- close socket SOCKET_CLOSE(io_ch, st) END CONNECT_DEV這份代碼邏輯并不復(fù)雜照著抄基本就能跑通。但有幾個細(xì)節(jié)值得展開講避免你復(fù)制后在現(xiàn)場蒙圈。3.3 逐段邏輯講解程序開頭是變量聲明區(qū)。KAREL程序的結(jié)構(gòu)和Pascal很像VAR區(qū)聲明所有局部變量。注意字符串變量后面的[16]、[64]、[128]這是固定長度字符串的聲明方式。賦值時如果字符串實(shí)際長度超過聲明長度會觸發(fā)運(yùn)行時錯誤。初始化部分給變量賦初值。IP地址和端口號在這個版本里是硬編碼的好處是代碼邏輯簡單壞處是每次換IP都要改代碼重新編譯。實(shí)際項(xiàng)目中我更推薦把這幾個值抽出來寫到TP程序的字符串寄存器里或者在程序啟動時從文件讀取。KAREL本身支持文件讀寫完全可以把通信參數(shù)放到一個配置文件里。SOCKET_CONNECT那一段是整個程序的地基。連接不成功后面全白搭。需要注意這里我把連接是否成功的判斷放到了IF里但沒有在失敗后立刻RETURN。為什么因?yàn)樵谀承﹫鼍跋鲁绦蛐枰卦囘B接而不是直接退出。我在演示代碼里選擇了直接往下走讓W(xué)HILE條件自己判斷。如果你想做重試在IF失敗分支里寫一個延時然后再次SOCKET_CONNECT即可。主循環(huán)是通信核心。每次循環(huán)先SOCKET_SEND發(fā)一個“POLL”再SOCKET_RECV等回復(fù)。值得注意的是我用了AND (st 0)作為循環(huán)條件的一部分。這保證了一旦之前出現(xiàn)錯誤程序不會繼續(xù)空轉(zhuǎn)而是跳過循環(huán)體直接執(zhí)行后續(xù)清理。你要注意發(fā)送和接收的節(jié)奏。DELAY 500表示每次循環(huán)間隔500毫秒這個值不是隨便寫的。如果循環(huán)過快會占滿控制器CPU時間影響機(jī)器人運(yùn)動程序的實(shí)時性。如果循環(huán)過慢對外響應(yīng)又不及時。具體多少合適要看你的業(yè)務(wù)場景。做機(jī)器人通信的永遠(yuǎn)要記住一個原則通信進(jìn)程不能影響運(yùn)動控制進(jìn)程。最后一個SOCKET_CLOSE是收尾操作。很多人會忽略關(guān)閉連接這一步程序跑完就完事。但在長任務(wù)循環(huán)中如果連接沒關(guān)閉就反復(fù)嘗試重連資源不會立即釋放嚴(yán)重時可能導(dǎo)致后續(xù)連接失敗。養(yǎng)成習(xí)慣每次通信結(jié)束后顯式關(guān)閉。3.4 和TP程序交換數(shù)據(jù)的方法KAREL程序不能獨(dú)立存在于FANUC的世界里它最終還是要和TP程序配合。最常見的模式是TP程序負(fù)責(zé)運(yùn)動軌跡和流程調(diào)度KAREL程序負(fù)責(zé)通信和協(xié)議處理兩者之間通過系統(tǒng)變量傳遞數(shù)據(jù)。具體怎么交換數(shù)據(jù)方法有很多我用得比較多的是寄存器。FANUC有通用寄存器R[]和位置寄存器PR[]在KAREL里可以直接讀寫。比如KAREL收到服務(wù)端的坐標(biāo)值后拆解字符串轉(zhuǎn)成浮點(diǎn)數(shù)寫入R[10]、R[11]、R[12]TP程序?qū)崟r讀取這幾位寄存器做點(diǎn)位偏移。字符串寄存器SR[]也可以作為交換通道。從KAREL往SR寫字符串TP里讀出來顯示或做其他判斷。反過來TP在示教器上讓操作員輸入一個IP地址存到SR[5]KAREL再把這個字符串讀出來作為連接目標(biāo)這樣就實(shí)現(xiàn)了運(yùn)行時靈活配置不用每次改代碼。KAREL讀寫寄存器的語法不復(fù)雜不同版本略有差異但整體思路一致。這也是為什么我建議把通信參數(shù)從代碼中抽出來的底層原因代碼邏輯不變只改寄存器里的值就能應(yīng)對不同的現(xiàn)場服務(wù)器。4. 編譯、加載和聯(lián)調(diào)完整流程4.1 把.KL編譯成控制器能運(yùn)行的程序.KL是KAREL源文件就像C語言的.c文件控制器不能直接運(yùn)行需要編譯成.pc文件。這個編譯動作可以在Roboguide里做也可以直接利用控制器上的KAREL編譯功能。Roboguide流程大致是這樣的打開對應(yīng)控制柜版本的工作單元菜單找到File→Import/Export→Import KAREL Source選擇你的.KL文件Roboguide會自動進(jìn)行編譯并生成.pc文件。編譯完成后在程序選擇界面能看到這個程序后面就能像TP程序一樣被調(diào)用。實(shí)機(jī)操作流程也類似。把.KL文件拷貝到CF卡或者U盤插到控制柜上在示教器的文件管理界面里找到它導(dǎo)入后控制系統(tǒng)會自動編譯。如果只是導(dǎo)入.pc文件就不需要再編譯了。注意這里有一個前提條件控制器必須開通KAREL功能選項(xiàng)。如果系統(tǒng)沒有這個選項(xiàng)導(dǎo)入時會直接報錯甚至文件管理界面都不認(rèn)識.KL文件。怎么判斷看系統(tǒng)信息里的選項(xiàng)列表或者在文件管理界面嘗試導(dǎo)入時報“非法指令”一類的錯誤。真要遇到?jīng)]開通的情況只能聯(lián)系FANUC購買并開通選項(xiàng)。4.2 從TP程序正式調(diào)用KAREL任務(wù)KAREL程序編譯好之后還不能直接在示教器上像TP程序那樣被選中運(yùn)行。它更像一個函數(shù)庫或者后臺工具需要從TP程序里通過CALL指令調(diào)用。在TP程序里寫一行CALL CONNECT_DEV ;這行代碼會讓控制器把控制權(quán)交給KAREL程序KAREL程序執(zhí)行完才會返回到TP的下一行。也就是說如果你的KAREL程序里有長循環(huán)TP會一直停在那里等它跑完。如果KAREL程序設(shè)計成無限循環(huán)那TP程序也會一直卡住。所以通常有兩種使用策略。一種是短任務(wù)模式KAREL程序只處理一次通信就結(jié)束TP每需要通信一次就CALL一次。另一種是長任務(wù)模式KAREL程序啟動后常駐內(nèi)存在后臺循環(huán)監(jiān)聽或者發(fā)送TP通過寄存器與之交換結(jié)果。長任務(wù)模式對程序結(jié)構(gòu)要求更高調(diào)試也更復(fù)雜建議新手先從短任務(wù)開始。調(diào)用KAREL程序時示教器上可以查看它的運(yùn)行狀態(tài)。如果程序里有WRITE輸出示教器會顯示對應(yīng)的信息。這在你調(diào)試時非常有用相當(dāng)于讓機(jī)器人把中間過程“講”給你聽。4.3 用PC端調(diào)試工具完成Socket聯(lián)調(diào)代碼寫完了編譯過了接下來要驗(yàn)證通信是否真的能通。這一步最好在PC上先模擬不要直接上真實(shí)設(shè)備原因很現(xiàn)實(shí)真實(shí)服務(wù)端設(shè)備不一定隨時可用而且出了問題不好定位。我習(xí)慣用Python寫一個極簡的TCP服務(wù)端模擬外部設(shè)備。下面這段代碼監(jiān)聽5000端口收到機(jī)器人的數(shù)據(jù)后打印出來然后回復(fù)“OK”。import socket s socket.socket(socket.AF_INET, socket.SOCK_STREAM) s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1) s.bind((0.0.0.0, 5000)) s.listen(1) print(listening on 5000...) while True: conn, addr s.accept() print(connected by, addr) data conn.recv(1024) print(recv:, data.decode()) conn.send(bOK) conn.close()這段代碼用到了一個關(guān)鍵選項(xiàng)SO_REUSEADDR。沒有這個選項(xiàng)時如果服務(wù)端程序崩潰后立刻重啟系統(tǒng)可能報“bind: only one usage of each socket address”的錯誤意思是端口還被上一個進(jìn)程占用著處于TIME_WAIT狀態(tài)。加了SO_REUSEADDR就能快速恢復(fù)服務(wù)端。這正是你在寫網(wǎng)絡(luò)通信軟件時一定會遇到的一個經(jīng)驗(yàn)點(diǎn)。聯(lián)調(diào)流程是這樣的PC先運(yùn)行Python服務(wù)端再在機(jī)器人側(cè)執(zhí)行KAREL程序。觀察示教器上應(yīng)該打印Connect OK、Send OK、Recv:OKPC端看到收到的POLL字符串。如果一切正常恭喜最小通信鏈路跑通了。4.4 實(shí)機(jī)聯(lián)調(diào)時的幾個檢查點(diǎn)到了真實(shí)設(shè)備上檢查重點(diǎn)要轉(zhuǎn)移。先檢查網(wǎng)絡(luò)連通性。在PC上持續(xù)Ping機(jī)器人IP或者從示教器端Ping PC。能Ping通說明底層的IP層通信沒問題可以聚焦到應(yīng)用層。Ping不通就先查網(wǎng)線、交換機(jī)、IP配置不要急著懷疑代碼。再檢查服務(wù)端是否真的在監(jiān)聽。很多時候機(jī)器人報連接失敗不是機(jī)器人的問題而是服務(wù)端沒起來。在PC上用netstat命令查看監(jiān)聽狀態(tài)或者在服務(wù)端打印一條日志確認(rèn)端口是開的。然后檢查報文交互。機(jī)器人發(fā)出去的數(shù)據(jù)服務(wù)端是否完整收到服務(wù)端回復(fù)的數(shù)據(jù)機(jī)器人是否完整解析這里最容易出現(xiàn)“半包”和“粘包”問題。TCP是流式協(xié)議它不保證你發(fā)一次對方就收一次發(fā)的時機(jī)、網(wǎng)絡(luò)緩沖都可能影響。在你的通信協(xié)議里定義清楚數(shù)據(jù)邊界比如固定長度或者結(jié)束符這是寫網(wǎng)絡(luò)應(yīng)用的基本功。最后檢查控制器的表現(xiàn)。長時間通信時觀察機(jī)器人運(yùn)動是否受影響示教器是否有報警控制器是否出現(xiàn)過熱。通信程序如果設(shè)計得不好比如在死循環(huán)里頻繁刷WRITE指令會拖累整個控制器。5. 常見問題與排查技巧實(shí)錄5.1 連接失敗先看狀態(tài)值再看網(wǎng)絡(luò)SOCKET_CONNECT返回非0這是最讓人頭疼的起步問題。我的排查順序是先看狀態(tài)值再看網(wǎng)絡(luò)最后查代碼。狀態(tài)值能給你一個大方向。查出錯誤碼后翻手冊對應(yīng)的含義。如果是網(wǎng)絡(luò)層錯誤大概率是IP寫錯、端口沒監(jiān)聽、網(wǎng)線不通。如果是連接被拒絕通常說明服務(wù)端端口沒開或者防火墻攔了。這時候去PC上啟動服務(wù)端用netstat驗(yàn)證監(jiān)聽狀態(tài)問題就能定位。還有一種隱蔽情況控制柜里配置了多個網(wǎng)絡(luò)接口機(jī)器人側(cè)用的物理網(wǎng)口和IP不在同一個網(wǎng)段。FANUC控制柜上有多個以太網(wǎng)口有些是內(nèi)部用的有些是外部通信的接錯口也會導(dǎo)致連接失敗。建議接線時在網(wǎng)口旁邊貼標(biāo)簽避免現(xiàn)場混亂。5.2 接收超時和亂碼多半是協(xié)議和緩沖區(qū)問題SOCKET_RECV超時優(yōu)先檢查服務(wù)端是否真的回復(fù)了。用Wireshark抓包最直觀能清楚看到TCP握手、數(shù)據(jù)發(fā)送、ACK響應(yīng)全過程。如果服務(wù)端明明發(fā)了數(shù)據(jù)機(jī)器人還是超時那就要查接收緩沖區(qū)大小是不是報文比緩沖區(qū)更長導(dǎo)致KAREL無法完整接收。亂碼問題通常是編碼不一致。機(jī)器人發(fā)送的是ASCII字符串服務(wù)端按GBK或者UTF-16解析自然亂碼。解決辦法是規(guī)范通信協(xié)議明確使用ASCII或UTF-8編碼字符串里不要夾雜不可見字符。還有一類問題很奇怪但確實(shí)存在服務(wù)端數(shù)據(jù)發(fā)得太快機(jī)器人還沒準(zhǔn)備好接收數(shù)據(jù)就丟了一部分。TCP本身有緩沖區(qū)小概率情況下會丟包或亂序。穩(wěn)妥的做法是在協(xié)議層做應(yīng)答機(jī)制每條報文都等對方確認(rèn)后再發(fā)下一條。這也是我演示代碼里用“POLL等OK”循環(huán)的意義所在。5.3 編譯和運(yùn)行時的KAREL坑KAREL編譯失敗最常見的原因是注釋和編碼問題。以前我寫過一次中文注釋結(jié)果Roboguide報錯找不到錯誤原因最后把中文刪掉就編譯通過了。從此我的.KL文件全部用英文注釋除非確認(rèn)當(dāng)前環(huán)境的編譯器支持中文。另外KAREL程序文件名和程序名必須一致。你寫的PROGRAM CONNECT_DEV對應(yīng)的文件也必須是CONNECT_DEV.KL大小寫在多數(shù)系統(tǒng)里可以忽略但建議全大寫統(tǒng)一少給自己找麻煩。變量聲明區(qū)的類型寫錯、字符串長度和實(shí)際賦值不匹配也會編譯失敗。比如聲明STRING[16]卻給它賦了一個20個字符的字符串運(yùn)行時會報警告甚至異常。如果你是從別的語言轉(zhuǎn)過來的務(wù)必記住KAREL字符串是定長的概念不是動態(tài)數(shù)組。運(yùn)行時還有一個經(jīng)典問題KAREL程序占用的內(nèi)存?？刂破鲀?nèi)存不是無限的KAREL程序如果寫得太大或者同時運(yùn)行太多KAREL任務(wù)會導(dǎo)致內(nèi)存不足報錯。處理辦法是清理不用的歷史程序或者把程序拆成多個小模塊按需調(diào)用。5.4 常見問題速查表整理了一份排查表覆蓋我遇到過的典型問題你可以直接照著檢查。現(xiàn)象可能原因處理辦法CONNECT返回非0IP/端口錯誤、服務(wù)端未監(jiān)聽、網(wǎng)線斷開先Ping再netstat確認(rèn)服務(wù)端在線連接成功但SEND失敗連接已被對方關(guān)閉檢查服務(wù)端是否還在運(yùn)行增加重連機(jī)制RECV超時服務(wù)端沒回復(fù)或回復(fù)太長抓包確認(rèn)加大緩沖區(qū)調(diào)整協(xié)議RECV亂碼編碼不一致統(tǒng)一ASCII避免不可見字符編譯報錯無明確信息中文注釋、編碼問題改英文注釋用純文本保存運(yùn)行時報內(nèi)存不足KAREL程序過大或任務(wù)過多清理程序拆功能模塊SOCKET_CLOSE后重連失敗TIME_WAIT狀態(tài)占用端口服務(wù)端開SO_REUSEADDR客戶端延時重連示教器無輸出WRITE被屏蔽或程序未運(yùn)行檢查程序調(diào)用方式確認(rèn)程序狀態(tài)這里面每一行都對應(yīng)著一次或多次現(xiàn)場踩坑。做通信類項(xiàng)目做好排查記錄比啥都強(qiáng)。5.5 斷線重連和心跳機(jī)制讓方案更接近生產(chǎn)演示程序很簡單但真正生產(chǎn)環(huán)境不會這么“傻白甜”。外部設(shè)備隨時可能重啟、斷網(wǎng)、出現(xiàn)異常你的KAREL程序必須有應(yīng)對能力。斷線重連是最基本的。設(shè)計思路是主循環(huán)里不斷查詢連接狀態(tài)如果發(fā)現(xiàn)連接斷開就嘗試重新SOCKET_CONNECT。重連的間隔不能太短否則會持續(xù)占用CPU推薦至少間隔1到2秒。重連超過N次后可以報警或者退出避免無限循環(huán)消耗資源。心跳機(jī)制也很有用。機(jī)器人和服務(wù)端約定一個特殊報文比如每5秒發(fā)一次“PING”服務(wù)端回復(fù)“PONG”。連續(xù)幾次沒收到PONG就認(rèn)為連接失效主動關(guān)閉并重連。這樣能及時感知網(wǎng)絡(luò)狀態(tài)而不是等到真正發(fā)業(yè)務(wù)數(shù)據(jù)時才發(fā)現(xiàn)斷線。這些邏輯寫起來不難但能顯著提升通信方案的穩(wěn)定性。如果你拿演示代碼直接上生產(chǎn)一旦外部設(shè)備出問題機(jī)器人可能就傻等在那里這就是事故了。我自己的體會是Socket通信這件事代碼本身只占三成工作量剩下七成全在協(xié)議設(shè)計和異常處理上。你花在思考“斷線了怎么辦”“粘包了怎么拆”“服務(wù)端不回復(fù)怎么辦”這些場景上的時間最后都會變成系統(tǒng)穩(wěn)定性的回報。希望這份.KL模板和思路能幫你在FANUC上少走幾步彎路。