我的小车由单片机最小系统模块、电机驱动模块、超声波测距模块1602显示模块和双减速电机加外向轮小车底盘构成,四节1.5伏南孚电池供电,可以考虑步进电机控制超声波模块,要求实现自动避障,显示提示有障碍物,求哪位大能帮我写个C程序,我实在是不知道怎么写了,我只能实现最基本的避障功能,求帮帮忙啊,谢谢啦!