Hi,
du kannst einzelne Positionen direkt aufrufen und mit diesen weiterrechnen. Ich nutze deine angegebene Position p als Beispiel:
p[0.65397,0.01392,0.1745,2.319,-2.108,0.003]
bedeutet im Endeffekt nichts anderes als:
p[ X = 0.65397, Y = 0.01392, Z = 0.1745, RX = 2.319, RY = -2.108, RZ = 0.003]
oder
p[0, 1, 2, 3, 4, 5]
Du kannst nun mit folgender Funktion eine einzelne Position (wir werden Z nehmen) aufrufen und zum berechnen verwenden, dafür sollten wir die Pose an sich aber in einer Variable speichern:
Testposition = p[0.65397,0.01392,0.1745,2.319,-2.108,0.003]
Testposition[2] = 0.500
Hiermit überschreiben wir den Wert an Position [2] der Variable Testposition, was dem Z-Wert entspricht (X = 0, Y = 1, Z = 2, RX = 3, ..), was in folgendem Ergebnis resultiert:
Testposition = p[0.65397,0.01392,0.500,2.319,-2.108,0.003]
Somit kannst du für dein Beispiel folgendes Nutzen:
Testposition = p[0.65397,0.01392,0.1745,2.319,-2.108,0.003]
Var_X = Testposition[0]
Var_Y = Testposition[1]
Var_Z = Testposition[2]
Var_RX = Testposition[3]
Var_RY = Testposition[4]
Var_RZ = Testposition[5]
Hiermit schreiben wir den Wert der Variable/Pose "Testposition" an der Stelle [n] auf die entsprechende Variable.
Ergebnis:
Var_X = 0.65397
Var_Y = 0.01392
Var_Z = 0.1745
Var_RX = 2.319
Var_RY = -2.108
Var_RZ = 0.003