判定机械手与箱的干涉

自动计算机械手动作路径，算出手臂、手部、抓持的工件与外围设备不发生碰撞的抓取姿势等。