假设车体足够小,不倒车就不会撞墙,至于算法,可以这么想,假设左转90度需要车体前进x,左移y,最简单的不撞墙
1、向前直行
2、当左侧距离小于y时停车
3、当前方距离小于x时左转90°
第2步可以扩展为右转90度
同样的右侧也是如此
再设置停车条件就可以了。
左右传感器检测侧边墙
1采集左右传感器距离,记录下来
2开一小段距离再次采样左右传感器距离,如果偏差在范围内就不需要校准方向,如果变化量比较大那么就校准方向,前侧传感器检测防止撞墙