该程序时自己写的，为了准备飞思卡尔电磁组的比赛，可是该程序也有部分的问题，例如，车还是不能直立，需要再调。