机器人避障路径问题 数学建模