用c++实现机器人自主躲避障碍以及路径规划