一个机器人避障算法代码,主要通过声纳判断障碍物进行避障,有点类似BUG算法