此程序是用6050陀螺仪和mega16单片机做成,已调试通过,小车可直立行走