I got the robot moving from one position to another, in a straight’ish line, as good as a bunch of movej’s can do, and I have now moved onto trying to figure out how to calculate radiuses between the moves.
There are some functions to return the distance between two poses, but to get it to do as I wanted, I am moving the joints to degree positions, which are in a list. Are there a way to convert the list back into a pose, and calculate the distance with that?