久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2053|回復(fù): 0
收起左側(cè)

基于51單片機(jī)的藍(lán)牙避障小車代碼

[復(fù)制鏈接]
ID:888864 發(fā)表于 2021-12-16 00:01 | 顯示全部樓層 |閱讀模式
學(xué)習(xí)時(shí)候自己寫的，兩驅(qū)四驅(qū)皆可用

單片機(jī)源程序如下:
  1. /******************************************************************************
  2. 2021.9.27
  3. 單片機(jī)實(shí)踐二 孟瑞淞
  4. 超聲波舵機(jī)避障程序
  5. ******************************************************************************/
  6. #include <AT89x52.H>
  7. #include <intrins.h>
  8. #define led1 {P0_6=1,P0_6=0;}
  9. #define led2 {P0_7=0,P0_7=1;}
  10.        
  11. #define Right_moto_go     {P1_2=1,P1_3=0;}        //右邊電機(jī)向前走
  12. #define Right_moto_back   {P1_2=0,P1_3=1;}        //右邊電機(jī)向后走
  13. #define Right_moto_Stop   {P1_2=0,P1_3=0;}        //右邊電機(jī)停轉(zhuǎn)   

  15. #define Left_moto_go      {P1_6=1,P1_7=0;}  //左邊電機(jī)向前走
  16. #define Left_moto_back    {P1_6=1,P1_7=0;}         //左邊電機(jī)向后轉(zhuǎn)
  17. #define Left_moto_Stop    {P1_6=0,P1_7=0;}  //左邊電機(jī)停轉(zhuǎn)                     
  18.        
  19. #define Sevro_moto_pwm  P2_2      //接舵機(jī)信號端輸入PWM信號調(diào)節(jié)速度
  20. #define  ECHO  P2_0                                        //超聲波接口定義
  21. #define  TRIG  P2_1                                //超聲波接口定義
  22.        

  24. unsigned char const positon[3]={ 0xfe,0xfd,0xfb};
  25. unsigned char disbuff[4]={ 0,0,0,0,};
  26. unsigned char posit=0;

  28. unsigned char pwm_val_left  = 0;//變量定義
  29. unsigned char push_val_left =14;//舵機(jī)歸中，產(chǎn)生約，1.5MS 信號
  30. unsigned long S=0;
  31. unsigned long S1=0;
  32. unsigned long S2=0;
  33. unsigned long S3=0;
  34. unsigned long S4=0;
  35. unsigned int  time=0;                    //時(shí)間變量
  36. unsigned int  timer=0;                        //延時(shí)基準(zhǔn)變量
  37. unsigned char timer1=0;                        //掃描時(shí)間變量                                       
  38.    
  39. /************************************************************************/       
  40. //延時(shí)函數(shù)       
  41. void delay(unsigned int k)
  42. {                               
  43.                    unsigned int x,y;
  44.                    for(x=0;x<k;x++)
  45.                    for(y=0;y<2000;y++);
  46. }
  47. /************************************************************************/       
  48. //前速前進(jìn)
  49. void run(void)
  50. {
  51.    
  52.             Left_moto_go;    //左電機(jī)往前走
  53.             Right_moto_go ;  //右電機(jī)往前走
  54. }

  56. //前速后退
  57. void backrun(void)
  58. {
  59.    
  60.                  Left_moto_back ;   //左電機(jī)往前走
  61.                  Right_moto_back ;  //右電機(jī)往前走
  62. }

  64. //左轉(zhuǎn)
  65. void  leftrun(void)
  66. {
  67.    
  68.                   Right_moto_go ;  //右電機(jī)往前走 ;
  69.                   Left_moto_Stop ;   //左電機(jī)停止
  70. }

  72. //右轉(zhuǎn)
  73. void  rightrun(void)
  74. {
  75.    
  76.                    Left_moto_go ;   //左電機(jī)往前走
  77.                    Right_moto_Stop ;  //右電機(jī)停止
  78. }
  79. //停
  80. void  stoprun(void)
  81. {
  82.    
  83.                   Left_moto_Stop ;   //左電機(jī)往前走
  84.                   Right_moto_Stop ;  //右電機(jī)往前走
  85. }

  87. void  StartModule()                       //啟動測距信號
  88. {
  89.           TRIG=1;                                        
  90.           _nop_();
  91.           _nop_();
  92.           _nop_();
  93.           _nop_();
  94.           _nop_();
  95.           _nop_();
  96.           _nop_();
  97.           _nop_();
  98.           _nop_();
  99.           _nop_();
  100.           _nop_();
  101.           _nop_();
  102.           _nop_();
  103.           _nop_();
  104.           _nop_();
  105.           _nop_();
  106.           _nop_();
  107.           _nop_();
  108.           _nop_();
  109.           _nop_();
  110.           _nop_();
  111.           TRIG=0;
  112. }

  114. void Conut(void)                   //計(jì)算距離
  115. {
  116.           while(!ECHO);                       //當(dāng)RX為零時(shí)等待
  117.           TR0=1;                               //開啟計(jì)數(shù)
  118.           while(ECHO);                           //當(dāng)RX為1計(jì)數(shù)并等待
  119.           TR0=0;                                   //關(guān)閉計(jì)數(shù)
  120.           time=TH0*256+TL0;                   //讀取脈寬長度
  121.           TH0=0;
  122.           TL0=0;
  123.           S=(time*1.7)/100;        //算出來是CM
  124.           disbuff[0]=S%1000/100;   //更新顯示
  125.           disbuff[1]=S%1000%100/10;
  126.           disbuff[2]=S%1000%10 %10;
  127. }

  129. void  COMM( void )                      
  130. {
  131.                   push_val_left=5;          //舵機(jī)向左轉(zhuǎn)90度
  132.                   timer=0;
  133.                   while(timer<=4000); //延時(shí)400MS讓舵機(jī)轉(zhuǎn)到其位置
  134.                   StartModule();          //啟動超聲波測距
  135.           Conut();                           //計(jì)算距離
  136.                   S2=S;  
  137.   
  138.                   push_val_left=23;          //舵機(jī)向右轉(zhuǎn)90度
  139.                   timer=0;
  140.                   while(timer<=4000); //延時(shí)400MS讓舵機(jī)轉(zhuǎn)到其位置
  141.                   StartModule();          //啟動超聲波測距
  142.           Conut();                          //計(jì)算距離
  143.                   S4=S;        
  144.        
  145.                   push_val_left=14;          //舵機(jī)歸中
  146.                   timer=0;
  147.                   while(timer<=4000); //延時(shí)400MS讓舵機(jī)轉(zhuǎn)到其位置
  148.                   StartModule();          //啟動超聲波測距
  149.           Conut();                          //計(jì)算距離
  150.                   S1=S;        

  152.           if((S2<20)||(S4<20)) //只要左右各有距離小于，20CM小車后退
  153.                   {
  154.                   backrun();                   //后退
  155.                   timer=0;
  156.                   while(timer<=4000);
  157.                   }
  158.                   
  159.                   if(S2>S4)       
  160.                            
  161.                      {
  162.                                     rightrun();          //車的左邊比車的右邊距離小        右轉(zhuǎn)       
  163.                         timer=0;
  164.                         while(timer<=3500);//原4000
  165.                      }                                     
  166.                        else
  167.                      {
  168.                        leftrun();                //車的左邊比車的右邊距離大        左轉(zhuǎn)
  169.                        timer=0;
  170.                        while(timer<=3500);//原4000
  171.                      }
  172. }

  174. /*定時(shí)器產(chǎn)生100US定時(shí)信號*/
  175. void pwm_Servomoto(void)
  176. {  

  178.                    if(pwm_val_left<=push_val_left)
  179.                        Sevro_moto_pwm=1;
  180.                        else
  181.                        Sevro_moto_pwm=0;
  182.                        if(pwm_val_left>=200)
  183.                           pwm_val_left=0;
  184. }

  186. /*TIMER1中斷服務(wù)子函數(shù)產(chǎn)生PWM信號*/
  187. void time1()interrupt 3   using 2
  188. {       
  189.             TH1=(65536-100)/256;          //100US定時(shí)
  190.                 TL1=(65536-100)%256;
  191.                 timer++;                                  //定時(shí)器100US為準(zhǔn)。在這個(gè)基礎(chǔ)上延時(shí)
  192.                 pwm_val_left++;
  193.                 pwm_Servomoto();
  194. }

  196. void delay1()
  197. {
  198.                 unsigned char i,j,k;
  199.                 for(i=1;i>0;i--)
  200.                    for(j=100;j>0;j--)
  201.                 for(k=250;k>0;k--);
  202. }

  204. void shansuo()
  205. {
  206.                      led1;
  207.                      delay1();
  208.                      led2;
  209.                      delay1();                 
  210. }
  211.          
  212. /*--主函數(shù)--*/
  213. void main(void)
  214. {
  215.           stoprun();
  216.               TMOD=0X11;
  217.               TH1=(65536-100)/256;          //100US定時(shí)
  218.               TL1=(65536-100)%256;
  219.               TH0=0;
  220.                TL0=0;  
  221.               TR1= 1;
  222.               ET1= 1;
  223.               ET0= 1;
  224.               EA = 1;
  225.               delay(100);
  226.           push_val_left=14;          //舵機(jī)歸中
  227.               while(1)                     
  228.               {
  229.                    shansuo();        //閃爍燈函數(shù)
  230.                    if(timer>=200)          //100MS檢測啟動檢測一次 原來500
  231.                    {
  232.                       timer=0;
  233.                           StartModule(); //啟動檢測
  234.                   Conut();                  //計(jì)算距離
  235.                   if(S<35)                  //距離小于20CM
  236.                           {
  237.                              stoprun();          //小車停止
  238.                              COMM();                                  //方向函數(shù)
  239.                           }
  240.                           else
  241.                           if(S>40)                  //距離大于，35CM往前走
  242.                           run();
  243.                    }
  244.                }
  245. }
  246.        
復(fù)制代碼
屏幕截圖 2021-12-15 235951.png
Keil代碼下載:
單片機(jī)實(shí)踐二.rar (364.02 KB, 下載次數(shù): 17)

評分

參與人數(shù) 1黑幣 +30 收起 理由
admin + 30 共享資料的黑幣獎勵！

查看全部評分

回復(fù)

使用道具 舉報(bào)

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 国产欧美综合在线 | 欧美精品一区二区三区蜜臀 | 日韩精品福利 | 高清久久 | 一区二区三区成人 | 久久九精品| 国产精品成av人在线视午夜片 | 日韩成人精品 | 亚洲精品成人av久久 | 欧洲一级视频 | 五十女人一级毛片 | 草久久久 | 国产欧美日韩一区二区三区 | 国产999在线观看 | 天堂一区二区三区四区 | av片免费| 国产免费播放视频 | 欧美精品一区二区在线观看 | 91文字幕巨乱亚洲香蕉 | 天天躁天天操 | 91成人小视频| 久久国产精品一区二区三区 | 黄色网毛片 | 激情91 | 一级大片 | 操久久 | 久久这里只有精品首页 | 亚洲男人天堂av | 国产精品一区二区在线 | 无码国模国产在线观看 | 免费观看毛片 | 久久久久资源 | 欧美亚洲国产日韩 | 久久综合av | 日本精品久久久久 | 97伦理电影网 | 国产精品色 | 成人在线视频一区二区三区 | 波多野吉衣在线播放 | 999观看免费高清www | 欧美日韩三区 |