C语言51单片机等高表建立，冲刺问题

51单片机小车，如何用队列建立好一个等高表，并且完成冲刺功能