Pose distance

Parameters

p_from: tool pose (pose)

p_to: tool pose (pose)

Return Value

distance

Example command: pose_dist(p[.2,.5,.1,1.57,0,3.14], p[.2,.5,.6,0,1.57,3.14])

• Example Parameters:
  • p_from = p[.2,.5,.1,1.57,0,3.14] -> The first point
  • p_to = p[.2,.5,.6,0,1.57,3.14] -> The second point
    • Returns distance between two poses including rotation