回避障碍物

掌握机械手各轴的状态，为机械手算出合理的动作路径。即使动作路径中有异常点，也能够安全通过。