机器人运动规划和3D视觉