以下文章來源于不知名網友i,作者不知名網友i
軟件支持
庫卡軟件包支持:
需要KUKA.Ethernet KRL,具體小版本根據系統而定。
測試環境:
虛擬機:VM17Pro
示教器:Officelite v8.6.7
電腦:w11 python(測試) socketTool(測試)
配置方法
庫卡 socket 一切關于 socket 配置的操作,都基于一個或多個 xml 文件。
軟件安裝后自帶的一些 demo 和文檔,本文不過多概述。
關于 xml 文件的參數解析:
基于VST_Ethernet_KRL_31_zh,文中未提及的皆為可選參數,具體請參閱手冊
連接
Server 192.1.10.20 54600 TCP
接收數據
發送數據
實戰起!
我的 xml 文件,作用:接收位置數據并只回復狀態。
192.168.0.1 59152
關于EKI的一些函數
程序說明:
1、接收上位機發送的 xyz 位置變量,歐拉角使用當前自身位置,得到后賦值到位置變量數組。DECL FRAME POS_DATA[1000]位置變量聲明于 config 中。
SRC
DAT
&ACCESS RVP DEF RECE_MAIN ( ) ;FOLD INI;%{PE} ;FOLD BASISTECH INI GLOBAL INTERRUPT DECL 3 WHEN $STOPMESS==TRUE DO IR_STOPM ( ) INTERRUPT ON 3 BAS (#INITMOV,0 ) ;ENDFOLD (BASISTECH INI) ;FOLD USER INI ;Make your modifications here ;ENDFOLD (USER INI) ;ENDFOLD (INI) ;FOLD SPTP HOME Vel=100 % DEFAULT ;%{PE} ;FOLD Parameters ;%{h} ;Params IlfProvider=kukaroboter.basistech.inlineforms.movement.spline; Kuka.IsGlobalPoint=False; Kuka.PointName=HOME; Kuka.BlendingEnabled=False; Kuka.MoveDataPtpName=DEFAULT; Kuka.VelocityPtp=100; Kuka.VelocityFieldEnabled=True; Kuka.CurrentCDSetIndex=0; Kuka.MovementParameterFieldEnabled=True; IlfCommand=SPTP ;ENDFOLD SPTP XHOME WITH $VEL_AXIS[1] = SVEL_JOINT(100.0), $TOOL = STOOL2(FHOME), $BASE = SBASE(FHOME.BASE_NO), $IPO_MODE = SIPO_MODE(FHOME.IPO_FRAME), $LOAD = SLOAD(FHOME.TOOL_NO), $ACC_AXIS[1] = SACC_JOINT(PDEFAULT), $APO = SAPO_PTP(PDEFAULT), $GEAR_JERK[1] = SGEAR_JERK(PDEFAULT), $COLLMON_TOL_PRO[1] = USE_CM_PRO_VALUES(0) ;ENDFOLD ACT_POS = $POS_ACT INIT_DATA() GET_DATA() ;wait until data read RET=EKI_Close("XmlCallBack") RET=EKI_Clear("XmlCallBack") RUN_ROBOT() END DEF INIT_DATA() RET=EKI_Init("XmlCallBack") RET=EKI_Open("XmlCallBack") RET = EKI_SEND("XmlCallBack", "Status 200") ; INIT save_index = 1 FOR i=1 TO (1000) POS_DATA[i]={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C 0.0} ENDFOR valueFrame={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C 0.0} END DEF GET_DATA() LOOP Wait for $Flag[1] ;SET_VALUE RET=EKI_GetFrame("XmlCallBack","Sensor/Read/xyzabc",valueFrame) IF (valueFrame.X <> 666.666) and (valueFrame.Y <> 666.666) THEN POS_DATA[save_index] = valueFrame POS_DATA[save_index].A = ACT_POS.A POS_DATA[save_index].B = ACT_POS.B POS_DATA[save_index].C = ACT_POS.C save_index = save_index + 1 $Flag[1]=False ELSE EXIT ENDIF RET = EKI_SEND("XmlCallBack", "Status 200") ENDLOOP END DEF RUN_ROBOT() DECL FRAME XMOVE_POS LOOP FOR i=1 TO (1000) XMOVE_POS = POS_DATA[i] ;FOLD SLIN MOVE_POS Vel=2 m/s CPDAT1 Tool[1] Base[0] ;%{PE} ;FOLD Parameters ;%{h} ;Params IlfProvider=kukaroboter.basistech.inlineforms.movement.spline; Kuka.IsGlobalPoint=False; Kuka.PointName=MOVE_POS; Kuka.BlendingEnabled=False; Kuka.MoveDataName=CPDAT1; Kuka.VelocityPath=2; Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.CurrentCDSetIndex=0; Kuka.MovementParameterFieldEnabled=True; IlfCommand=SLIN ;ENDFOLD SLIN XMOVE_POS WITH $VEL = SVEL_CP(2.0, , LCPDAT1), $TOOL = STOOL2(FMOVE_POS), $BASE = SBASE(FMOVE_POS.BASE_NO), $IPO_MODE = SIPO_MODE(FMOVE_POS.IPO_FRAME), $LOAD = SLOAD(FMOVE_POS.TOOL_NO), $ACC = SACC_CP(LCPDAT1), $ORI_TYPE = SORI_TYP(LCPDAT1), $APO = SAPO(LCPDAT1), $JERK = SJERK(LCPDAT1), $COLLMON_TOL_PRO[1] = USE_CM_PRO_VALUES(0) ;ENDFOLD IF (POS_DATA[i + 1].X == 0) AND (POS_DATA[i + 1].Y == 0) THEN EXIT ENDIF ENDFOR ENDLOOP END
&ACCESS RVP DEFDAT rece_main ;FOLD EXTERNAL DECLARATIONS;%{PE}%MKUKATPBASIS,%CEXT,%VCOMMON,%P ;FOLD BASISTECH EXT;%{PE}%MKUKATPBASIS,%CEXT,%VEXT,%P EXT BAS (BAS_COMMAND :IN,REAL :IN ) DECL INT SUCCESS ;ENDFOLD (BASISTECH EXT) ;FOLD USER EXT;%{E}%MKUKATPUSER,%CEXT,%VEXT,%P ;Make your modifications here ;ENDFOLD (USER EXT) ;ENDFOLD (EXTERNAL DECLARATIONS) INT i, save_index DECL EKI_STATUS RET FRAME ValueFrame DECL E6POS ACT_POS DECL MODULEPARAM_T LAST_TP_PARAMS = {PARAMS[] "Kuka.VelocityFieldEnabled=False; Kuka.ColDetectFieldEnabled=False; Kuka.MovementParameterFieldEnabled=False; Kuka.IsAngleEnabled=False; Kuka.PointName=MOVE_POS; Kuka.FrameData.base_no=0; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataName=CPDAT1; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.MovementData.vel=2; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPath=2; Kuka.BlendingEnabled=False; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0"} DECL LDAT LCPDAT1 = {CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}},APO_FAC 50.0,APO_DIST 500,AXIS_ACC 100.0,AXIS_VEL 100.0,CIRC_TYP #BASE,JERK_FAC 50.0,ORI_TYP #VAR,VEL 2,ACC 100,GEAR_JERK 100.0,EXAX_IGN 0} DECL FDAT FMOVE_POS = {BASE_NO 0,TOOL_NO 1,IPO_FRAME #BASE,POINT2[] " "} ENDDAT
程序關鍵點說明
1、xml 文件編輯完成后必須放置在C:KRCROBOTERConfigUserCommonEthernetKRL中
并且程序中EKI函數傳參時傳入的為 xml 文件名。
2、必須聲明EKI函數 DECL EKI_STATUS RET
在正確的位置使用相關函數,初始化、連接、發送等
3、使用正確的 GETSET 函數
例如我是需要獲取位置變量,那么我直接是使用了GetFrame函數,如果是字符串則是GETSTRING,整數、實數、布爾等同理。
4、如果你是接收或發送的字符串,注意庫卡中并沒有 String 類型變量,需要使用的字符數組char[],并且字符數組下標從 1 開始。
DECLCHARTEST_STR[20]聲明了長度為20的字符數組 DECLCHARTEST_STR1[1] TEST_STR="ABC" TEST_STR1[1]=TEST_STR[2] 這樣賦值到,TEST_STR1[1]值為B
5、合理使用 flag 標志,像我的代碼中我只使用了接收到信息的標志,這是不對的,現在代碼在創建連接后會直接發送信息,但是可能會出現上位機并未運行等情況,所以需要正確的使用標志位
192.168.0.1 59152
6、更多信息請參閱文檔。
python 發送 xml 完成通訊
importsocket importtime #創建Socket服務器 defstart_server(): #創建一個IPv4(AF_INET)和TCP(SOCK_STREAM)的socket對象 server_socket=socket.socket(socket.AF_INET,socket.SOCK_STREAM) #綁定服務器地址和端口 server_address=('0.0.0.0',59152) print(f"啟動服務器,監聽地址:{server_address[0]}:{server_address[1]}") server_socket.bind(server_address) #監聽客戶端連接,最大連接數為1 server_socket.listen(1) print("等待客戶端連接...") #接受客戶端連接 client_socket,client_address=server_socket.accept() try: print(f"客戶端連接成功:{client_address}") foriinrange(1000): send_data(client_socket,i+1,i-1) print(client_socket.recv(1024),i) #time.sleep(3) send_data(client_socket,666.666,666.666) finally: #關閉客戶端連接 client_socket.close() print(f"已斷開客戶端:{client_address}") defsend_data(socket_client,x,y): #定義XML數據 xml_data=f'''''' #發送XML數據到客戶端 socket_client.sendall(xml_data.encode('utf-8')) print(f"已發送數據: {xml_data}") #啟動服務器 if__name__=="__main__": start_time=time.time() start_server() end_time=time.time() print(f'耗時:{end_time-start_time}')
發送 xml 格式,注意格式,否則無法解析。
測試
這種寫法肯定不是最優解,但是在 50 秒內解析并保存完成了 1000 組位置數據,歡迎大佬們有更好的方案一起討論,不喜勿噴。
-
機器人
+關注
關注
210文章
28191瀏覽量
206505 -
電腦
+關注
關注
15文章
1680瀏覽量
68678 -
虛擬機
+關注
關注
1文章
908瀏覽量
28086 -
KUKA
+關注
關注
3文章
217瀏覽量
16488
原文標題:KUKA機器人socket通訊配置方法
文章出處:【微信號:指南車機器人科技,微信公眾號:指南車機器人科技】歡迎添加關注!文章轉載請注明出處。
發布評論請先 登錄
相關推薦
評論