这是我在机械创新中项目中写的部分源码,逻辑简单,主要是硬件和接线方面有些困难,毕竟机械创新中主要是以机械为主,控制部分只是辅助!