Closed yijiangh closed 6 years ago
Maybe not needed. Just backcount from the last joint pose, do FK to obtain the EEF pose, compute the distance between the pose to process start pose and we end the backcounting with the first joint pose that leads to a distance bigger than user-defined tolerance
.
Checking our method in grasshopper file might be helpful for this. @lock794779857
Closing this issue to focus discussion in #69 .
collision objects might need a half-edge data structure similar to
wire_frame
in framefab. This enables collecting all connected edges to a node.