Week 6 避障流程

1. 读取前方距离
2. 判断是否小于安全距离
3. 如果前方安全，继续前进
4. 如果检测到障碍物，开始后退
5. 后退后进行左转
6. 重复三次后退和左转
7. 避障动作完成