机器人运动轨迹中躲开障碍物的规划程序,可在matlab中实现