本人毕业设计做了一个简单的机器人（说是机器人，其实就是个简单的电动爬楼梯轮椅）控制系统，用的AT89C52单片机，最后需要写一个程序，但是我C语言学的不好，不大会……大概的电路图和流程图都已经做好了，只需要写程序。需要实现的功能是用数码管显示超声波测距装置测出的距离，并使驾驶者通过按键来控制爬楼梯装置的前进后退、左转右转及爬楼梯等动作。（超声测距部分是一个模块，有相应的子程序）请擅长这部分的大神给予帮助，不胜感激……写好后若通过答辩，会另加80分。