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