可达工作空间可视化

懒人必备：使用 MoveIt! 运动规划遍历可达工作空间，并通过 Matplotlib 可视化。运行程序前，请启动你的机械臂的 MoveIt! 节点，然后运行 main.py 即可。运行结果点集保存在 points.txt ，运行 visualize.py 来可视化它。