8. Roboter-Statusabfrage
8.1. Aktuelle Gelenkposition (Winkel) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Gelenkposition (Winkel) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.2. Aktuelle Gelenkposition (Bogenmaß) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Gelenkposition (Bogenmaß) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.3. Gelenk-Rückmeldegeschwindigkeit (deg/s) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Gelenk-Rückmeldegeschwindigkeit (deg/s) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.4. Gelenk-Rückmeldebeschleunigung (deg/s²) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Gelenk-Rückmeldebeschleunigung (deg/s²) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.5. TCP-Befehlsresultierende Geschwindigkeit abrufen
Prototyp |
|
|---|---|
Beschreibung |
TCP-Befehlsresultierende Geschwindigkeit abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.6. TCP-Rückmelderesultierende Geschwindigkeit abrufen
Prototyp |
|
|---|---|
Beschreibung |
TCP-Rückmelderesultierende Geschwindigkeit abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.7. TCP-Befehlsgeschwindigkeit (Komponenten) abrufen
Prototyp |
|
|---|---|
Beschreibung |
TCP-Befehlsgeschwindigkeit (Komponenten) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.8. TCP-Rückmeldegeschwindigkeit (Komponenten) abrufen
Prototyp |
|
|---|---|
Beschreibung |
TCP-Rückmeldegeschwindigkeit (Komponenten) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.9. Aktuelle Werkzeugpose (TCP) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Werkzeugpose (TCP) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.10. Nummer des aktuellen Werkzeugkoordinatensystems abrufen
Prototyp |
|
|---|---|
Beschreibung |
Nummer des aktuellen Werkzeugkoordinatensystems abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.11. Nummer des aktuellen Werkstückkoordinatensystems abrufen
Prototyp |
|
|---|---|
Beschreibung |
Nummer des aktuellen Werkstückkoordinatensystems abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.12. Aktuelle Pose des Endflansches abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Pose des Endflansches abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.13. Aktuelle Gelenkmomente abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Gelenkmomente abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
|
Rückgabewert |
|
8.14. Systemzeit abrufen
Prototyp |
|
|---|---|
Beschreibung |
Systemzeit abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.15. Abfragen, ob die Roboterbewegung abgeschlossen ist
Prototyp |
|
|---|---|
Beschreibung |
Abfragen, ob die Roboterbewegung abgeschlossen ist |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.16. Länge der Roboter-Bewegungsbefehlswarteschlange abrufen
Prototyp |
|
|---|---|
Beschreibung |
Länge der Roboter-Bewegungsbefehlswarteschlange abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.17. Roboter-Not-Halt-Status abrufen
Prototyp |
|
|---|---|
Beschreibung |
Roboter-Not-Halt-Status abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.18. Kommunikationsstatus zwischen SDK und Roboter abrufen
Prototyp |
|
|---|---|
Beschreibung |
Kommunikationsstatus zwischen SDK und Roboter abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.19. Sicherheitsstopp-Signal abrufen
Prototyp |
|
|---|---|
Beschreibung |
Sicherheitsstopp-Signal abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.20. Aktuelle Temperatur der Gelenkantriebe (°C) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelle Temperatur der Gelenkantriebe (°C) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.21. Aktuelles Drehmoment der Gelenkantriebe (Nm) abrufen
Prototyp |
|
|---|---|
Beschreibung |
Aktuelles Drehmoment der Gelenkantriebe (Nm) abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.22. Roboter-Echtzeitstatus abrufen
Prototyp |
|
|---|---|
Beschreibung |
Roboter-Echtzeitstatus abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.23. Codebeispiel für Roboter-Statusabfrage
1from fairino import Robot
2import time
3# Verbindung zur Robotersteuerung herstellen, bei Erfolg wird ein Roboterobjekt zurückgegeben
4robot = Robot.RPC('192.168.58.2')
5error, [yangle, zangle] = robot.GetRobotInstallAngle()
6print(f"yangle: {yangle}, zangle: {zangle}")
7error, j_deg = robot.GetActualJointPosDegree(0)
8print(f"joint pos deg: {j_deg[0]}, {j_deg[1]}, {j_deg[2]}, {j_deg[3]}, {j_deg[4]}, {j_deg[5]}")
9error, jointSpeed = robot.GetActualJointSpeedsDegree(0)
10print(f"joint speeds deg: {jointSpeed[0]}, {jointSpeed[1]}, {jointSpeed[2]}, {jointSpeed[3]}, {jointSpeed[4]}, {jointSpeed[5]}")
11error, jointAcc = robot.GetActualJointAccDegree(0)
12print(f"joint acc deg: {jointAcc[0]}, {jointAcc[1]}, {jointAcc[2]}, {jointAcc[3]}, {jointAcc[4]}, {jointAcc[5]}")
13error, [tcp_speed, ori_speed] = robot.GetTargetTCPCompositeSpeed(0)
14print(f"GetTargetTCPCompositeSpeed tcp {tcp_speed}; ori {ori_speed}")
15error, [tcp_speed, ori_speed] = robot.GetActualTCPCompositeSpeed(0)
16print(f"GetActualTCPCompositeSpeed tcp {tcp_speed}; ori {ori_speed}")
17error, targetSpeed = robot.GetTargetTCPSpeed(0)
18print(f"GetTargetTCPSpeed {targetSpeed[0]}, {targetSpeed[1]}, {targetSpeed[2]}, {targetSpeed[3]}, {targetSpeed[4]}, {targetSpeed[5]}")
19error, actualSpeed = robot.GetActualTCPSpeed(0)
20print(f"GetActualTCPSpeed {actualSpeed[0]}, {actualSpeed[1]}, {actualSpeed[2]}, {actualSpeed[3]}, {actualSpeed[4]}, {actualSpeed[5]}")
21error, tcp = robot.GetActualTCPPose(0)
22print(f"tcp pose: {tcp[0]}, {tcp[1]}, {tcp[2]}, {tcp[3]}, {tcp[4]}, {tcp[5]}")
23error, flange = robot.GetActualToolFlangePose(0)
24print(f"flange pose: {flange[0]}, {flange[1]}, {flange[2]}, {flange[3]}, {flange[4]}, {flange[5]}")
25error, id = robot.GetActualTCPNum(0)
26print(f"tcp num: {id}")
27error, id = robot.GetActualWObjNum(0)
28print(f"wobj num: {id}")
29error, jtorque = robot.GetJointTorques(0)
30print(f"torques: {jtorque[0]}, {jtorque[1]}, {jtorque[2]}, {jtorque[3]}, {jtorque[4]}, {jtorque[5]}")
31error, t_ms = robot.GetSystemClock()
32print(f"system clock: {t_ms}")
33error, config = robot.GetRobotCurJointsConfig()
34print(f"joint config: {config}")
35error, motionDone = robot.GetRobotMotionDone()
36print(f"GetRobotMotionDone: {motionDone}")
37error, len = robot.GetMotionQueueLength()
38print(f"GetMotionQueueLength: {len}")
39error, emergState = robot.GetRobotEmergencyStopState()
40print(f"GetRobotEmergencyStopState: {emergState}")
41error, comstate = robot.GetSDKComState()
42print(f"GetSDKComState: {comstate}")
43error, [si0_state, si1_state] = robot.GetSafetyStopState()
44print(f"GetSafetyStopState: {si0_state} {si1_state}")
45error, temp = robot.GetJointDriverTemperature()
46print(f"Temperature: {temp[0]}, {temp[1]}, {temp[2]}, {temp[3]}, {temp[4]}, {temp[5]}")
47error, torque = robot.GetJointDriverTorque()
48print(f"torque: {torque[0]}, {torque[1]}, {torque[2]}, {torque[3]}, {torque[4]}, {torque[5]}")
49error, pkg = robot.GetRobotRealTimeState()
50robot.CloseRPC()
8.24. Inverse Kinematik berechnen
Prototyp |
|
|---|---|
Beschreibung |
Inverse Kinematik: Berechnet Gelenkpositionen aus einer kartesischen Pose |
Erforderliche Parameter |
|
Standardparameter |
|
Rückgabewert |
|
8.25. Inverse Kinematik mit Referenzposition berechnen
Prototyp |
|
|---|---|
Beschreibung |
Inverse Kinematik unter Verwendung einer Referenz-Gelenkposition |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.26. Inverse Kinematik im kartesischen Raum inklusive Erweiterungsachsenposition
Prototyp |
|
|---|---|
Beschreibung |
Inverse Kinematik im kartesischen Raum inklusive Erweiterungsachsenposition |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.27. Codebeispiel für inverse Kinematik mit Erweiterungsachse
1from fairino import Robot
2import time
3robot = Robot.RPC('192.168.58.2')
4desc = [99.957, -0.002, 29.994, -176.569, -6.757, -167.462]
5exaxis = [100.0, 0.0, 0.0, 0.0]
6jointPos = [0.0] * 6
7offsetPos = [0.0] * 6
8rtn,pkg = robot.GetRobotRealTimeState()
9toolnum = pkg.tool
10workPcsNum = pkg.user
11rtn, jointPos = robot.GetInverseKinExaxis(0, desc, exaxis, toolnum, workPcsNum)
12print(f"GetInverseKinExaxis joint is {jointPos[0]},{jointPos[1]},{jointPos[2]},{jointPos[3]},{jointPos[4]},{jointPos[5]}")
13robot.ExtAxisMove(exaxis, 100, -1)
14robot.MoveJ(joint_pos=jointPos, desc_pos=desc, tool=toolnum, user=workPcsNum, vel=100.0, acc=100.0, ovl=100.0, exaxis_pos=exaxis, blendT=-1, offset_flag=0, offset_pos=offsetPos)
15robot.CloseRPC()
16return 0
8.28. Prüfen, ob die inverse Kinematik eine Lösung hat
Prototyp |
|
|---|---|
Beschreibung |
Prüfen, ob die inverse Kinematik für eine gegebene Pose eine Lösung hat |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.29. Vorwärtskinematik berechnen
Prototyp |
|
|---|---|
Beschreibung |
Vorwärtskinematik: Berechnet Werkzeugpose aus Gelenkpositionen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.30. Codebeispiel für Vorwärts- und inverse Kinematik
1from fairino import Robot
2# Verbindung zur Robotersteuerung herstellen, bei Erfolg wird ein Roboterobjekt zurückgegeben
3robot = Robot.RPC('192.168.58.2')
4j1 = [-11.904, -99.669, 117.473, -108.616, -91.726, 74.256]
5desc_pos1 = [-419.524, -13.000, 351.569, -178.118, 0.314, 3.833]
6error, inverseRtn = robot.GetInverseKin(0, desc_pos=desc_pos1, config=-1)
7print(f"dcs1 GetInverseKin rtn is {inverseRtn[0]}, {inverseRtn[1]}, {inverseRtn[2]}, "
8 f"{inverseRtn[3]}, {inverseRtn[4]}, {inverseRtn[5]}")
9error, inverseRtn = robot.GetInverseKinRef(0, desc_pos=desc_pos1, joint_pos_ref=j1)
10print(f"dcs1 GetInverseKinRef rtn is {inverseRtn[0]}, {inverseRtn[1]}, {inverseRtn[2]}, "
11 f"{inverseRtn[3]}, {inverseRtn[4]}, {inverseRtn[5]}")
12error, hasResult = robot.GetInverseKinHasSolution(0, desc_pos=desc_pos1, joint_pos_ref=j1)
13print(f"dcs1 GetInverseKinRef result {hasResult}")
14error, forwordResult = robot.GetForwardKin(j1)
15print(f"jpos1 forwordResult rtn is {forwordResult[0]}, {forwordResult[1]}, {forwordResult[2]}, "
16 f"{forwordResult[3]}, {forwordResult[4]}, {forwordResult[5]}")
17robot.CloseRPC()
8.31. Daten eines Roboter-Teachingpunkts abfragen
Prototyp |
|
|---|---|
Beschreibung |
Daten eines Roboter-Teachingpunkts abfragen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.32. DH-Parameter-Kompensationswerte abrufen
Neu in Version Python: SDK-v2.0.1
Prototyp |
|
|---|---|
Beschreibung |
DH-Parameter-Kompensationswerte abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.33. SN-Code des Steuerkastens abrufen
Neu in Version Python: SDK-v2.1.1
Prototyp |
|
|---|---|
Beschreibung |
SN-Code des Steuerkastens abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.34. Codebeispiel für Teachingpunkt-Abfrage
1from fairino import Robot
2# Verbindung zur Robotersteuerung herstellen, bei Erfolg wird ein Roboterobjekt zurückgegeben
3robot = Robot.RPC('192.168.58.2')
4name = "P1"
5rtn, data = robot.GetRobotTeachingPoint(name)
6print(f"{rtn} name is: {name}")
7for i in range(20):
8 print(f"data is: {data[i]}")
9rtn,que_len = robot.GetMotionQueueLength()
10print(f"GetMotionQueueLength rtn is: {rtn}, queue length is: {que_len}")
11retval,dh = robot.GetDHCompensation()
12print(f"retval is: {retval}")
13print(f"dh is: {dh[0]} {dh[1]} {dh[2]} {dh[3]} {dh[4]} {dh[5]}")
14error,sn = robot.GetRobotSN()
15print(f"robot SN is {sn[0]}")
16robot.CloseRPC()
8.35. Werkzeugkoordinatensystem nach ID abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Werkzeugkoordinatensystem nach ID abrufen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.36. Werkstückkoordinatensystem nach ID abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Werkstückkoordinatensystem nach ID abrufen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.37. Externes Werkzeugkoordinatensystem nach ID abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Externes Werkzeugkoordinatensystem nach ID abrufen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.38. Erweiterungsachsen-Koordinatensystem nach ID abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Erweiterungsachsen-Koordinatensystem nach ID abrufen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.39. Lastmasse und -schwerpunkt nach ID abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Lastmasse und -schwerpunkt nach ID abrufen |
Erforderliche Parameter |
|
Standardparameter |
Keine |
Rückgabewert |
|
8.40. Aktuelles Werkzeugkoordinatensystem abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Aktuelles Werkzeugkoordinatensystem abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.41. Aktuelles Werkstückkoordinatensystem abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Aktuelles Werkstückkoordinatensystem abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.42. Aktuelles externes Werkzeugkoordinatensystem abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Aktuelles externes Werkzeugkoordinatensystem abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.43. Aktuelles Erweiterungsachsen-Koordinatensystem abrufen
Neu in Version Python: SDK-v2.1.6
Prototyp |
|
|---|---|
Beschreibung |
Aktuelles Erweiterungsachsen-Koordinatensystem abrufen |
Erforderliche Parameter |
Keine |
Standardparameter |
Keine |
Rückgabewert |
|
8.44. Codebeispiel zum Abrufen von Roboter-Koordinatensystemen und Lastdaten
1from fairino import Robot
2# Verbindung zur Robotersteuerung herstellen, bei Erfolg wird ein Roboterobjekt zurückgegeben
3robot = Robot.RPC('192.168.58.2')
4id = 1
5toolCoord = [0.0] * 6
6extoolCoord = [0.0] * 6
7wobjCoord = [0.0] * 6
8exAxisCoord = [0.0] * 6
9for i in range(100):
10 print(f"ID:{id}")
11 coordSet0 = [0.0] * 6
12 coordSet = [1.0, 2.0, 3.0, 4.0, 5.0, 6.0]
13 etcp = [10.0, 20.0, 30.0, 40.0, 50.0, 60.0]
14 etool = [0.1, 0.2, 0.3, 0.4, 0.5, 0.6]
15 cog = [1.0, 2.0, 3.0]
16 if i % 2 == 0:
17 robot.SetToolCoord(id, coordSet, 0, 0, 1, 0)
18 time.sleep(0.1)
19 robot.SetWObjCoord(id, coordSet, 0)
20 time.sleep(0.1)
21 robot.ExtAxisActiveECoordSys(id, 1, coordSet, 1)
22 time.sleep(0.1)
23 rtn = robot.SetExToolCoord(id, etcp, etool)
24 time.sleep(0.1)
25 rtn = robot.SetLoadWeight(id, 1.5)
26 time.sleep(0.1)
27 rtn = robot.SetLoadCoord(cog[0],cog[1],cog[2],id)
28 time.sleep(0.1)
29 else:
30 robot.SetToolCoord(id, coordSet0, 0, 0, 1, 0)
31 time.sleep(0.1)
32 robot.SetWObjCoord(id, coordSet0, 0)
33 time.sleep(0.1)
34 robot.ExtAxisActiveECoordSys(id, 1, coordSet0, 1)
35 time.sleep(0.1)
36 rtn = robot.SetExToolCoord(id, coordSet0, coordSet0)
37 time.sleep(0.1)
38 rtn = robot.SetLoadWeight(id, 0)
39 time.sleep(0.1)
40 rtn = robot.SetLoadCoord(coordSet0[0],coordSet0[1],coordSet0[2] , id)
41 time.sleep(0.1)
42 rtn, toolCoord = robot.GetCurToolCoord()
43 print(f"GetToolCoord {toolCoord[0]},{toolCoord[1]},{toolCoord[2]},{toolCoord[3]},{toolCoord[4]},{toolCoord[5]}")
44 rtn, wobjCoord = robot.GetCurWObjCoord()
45 print(f"GetWObjCoord {wobjCoord[0]},{wobjCoord[1]},{wobjCoord[2]},{wobjCoord[3]},{wobjCoord[4]},{wobjCoord[5]}")
46 rtn, extoolCoord = robot.GetCurExToolCoord()
47 print(f"GetExToolCoord {extoolCoord[0]},{extoolCoord[1]},{extoolCoord[2]},{extoolCoord[3]},{extoolCoord[4]},{extoolCoord[5]}")
48 rtn, exAxisCoord = robot.GetCurExAxisCoord()
49 print(f"GetExAxisCoord {exAxisCoord[0]},{exAxisCoord[1]},{exAxisCoord[2]},{exAxisCoord[3]},{exAxisCoord[4]},{exAxisCoord[5]}")
50 weight = 0.0
51 getCog = [0.0] * 3
52 rtn, weight = robot.GetTargetPayload(0)
53 rtn, getCog = robot.GetTargetPayloadCog(0)
54 print(f"GetTargetPayload {weight},{getCog[0]},{getCog[1]},{getCog[2]}")
55
56 rtn, toolCoord = robot.GetToolCoordWithID(id)
57 print(f"GetToolCoordWithID {id},{toolCoord[0]},{toolCoord[1]},{toolCoord[2]},{toolCoord[3]},{toolCoord[4]},{toolCoord[5]}")
58 rtn, wobjCoord = robot.GetWObjCoordWithID(id)
59 print(f"GetWObjCoordWithID {id},{wobjCoord[0]},{wobjCoord[1]},{wobjCoord[2]},{wobjCoord[3]},{wobjCoord[4]},{wobjCoord[5]}")
60 rtn, extoolCoord = robot.GetExToolCoordWithID(id)
61 print(f"GetExToolCoordWithID {id},{extoolCoord[0]},{extoolCoord[1]},{extoolCoord[2]},{extoolCoord[3]},{extoolCoord[4]},{extoolCoord[5]}")
62 rtn, exAxisCoord = robot.GetExAxisCoordWithID(id)
63 print(f"GetExAxisCoordWithID {id},{exAxisCoord[0]},{exAxisCoord[1]},{exAxisCoord[2]},{exAxisCoord[3]},{exAxisCoord[4]},{exAxisCoord[5]}")
64 weight = 0.0
65 getCog = [0.0] * 3
66 rtn, weight, getCog = robot.GetTargetPayloadWithID(id)
67 print(f"GetTargetPayloadWithID {id},{weight},{getCog[0]},{getCog[1]},{getCog[2]}")
68 time.sleep(0.5)
69 print(f"times {i}")