标题: 智能小车三路小车测速代码 [打印本页]

---

作者: tripper    时间: 2019-11-25 00:25
标题: 智能小车三路小车测速代码
自己做的小车用于调试3路寻迹测试程序，小伙伴调试小车时可用

1. #include<reg52.h>
   
2. #define uint unsigned int
   
3. #define uchar unsigned char
   
4. sbit P10=P1^0; //  控制左电机前进
   
5. sbit P11=P1^1;//控制左电机后退
   
6. sbit P12=P1^2;//控制右电机
   
7. sbit P13=P1^3;//控制右电机
   
8. sbit P14=P1^4;//寻迹左
   
9. sbit P15=P1^5;//寻迹中
   
10. sbit P16=P1^6;//寻迹右
    
11. fun1()
    
12. { P10=0;P11=1;P12=0;P13=1;}
    
13. //fun2()
    
14. //{ P10=1;P11=0;P12=1;P13=0;}
    
15. fun3()
    
16. { P10=0;P11=1;P12=1;P13=1;}
    
17. fun4()
    
18. { P10=1;P11=1;P12=1;P13=0;}
    
19. fun5()
    
20. { P10=1;P11=1;P12=1;P13=1;}
    
21. void main()
    
22. { while(1)
    
23.   { if((P14==0&&P15==1&&P16==0)||
    
24. 
    
25. (P14==0&&P15==0&&P16==0))
    
26.           fun1();
    
27.     if(P14==1&&P15==0&&P16==0)
    
28.           fun4();
    
29.          if(P14==0&&P15==0&&P16==1)
    
30.          fun3();
    
31.         if(P10==4&&P15==1&&P16==1)
    
32.          fun5();
    
33.   }
    
34. }
    

复制代码

---

欢迎光临 (http://www.51hei.com/bbs/)

Powered by Discuz! X3.1