找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開始

搜索
查看: 2915|回復(fù): 0
打印 上一主題 下一主題
收起左側(cè)

剛剛學(xué)了一個(gè)月51單片機(jī)，做了個(gè)超聲波小車(舵機(jī)控制)還望各位指點(diǎn)

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
另含舵機(jī)測(cè)試程序，l298n驅(qū)動(dòng)電機(jī)程序
程序?qū)懙貌皇呛芎�，還希望各位高手多多指點(diǎn)


實(shí)在是沒弄懂該怎么發(fā)程序。。。只好截圖了。。。

單片機(jī)源程序如下:
  1. #include<reg52.h>
  2. #include<intrins.h>

  4. sbit duojip=P1^2;                  //舵機(jī)輸出接口

  6. sbit trig=P1^0;                          //觸發(fā)腳
  7. sbit echo=P1^1;                          //接受腳

  9. unsigned int dis;         //測(cè)算出的距離
  10. unsigned char duojiCNT;
  11. unsigned char duojiJD;

  13. void open();           //打開超聲波函數(shù)
  14. void jisuan();         //計(jì)算距離函數(shù)

  16. void main()
  17. {
  18.    unsigned int a = 20000;
  19.    TMOD=0X11;                                               
  20.    TR0=1;                          //打開定時(shí)器0，1，打開中斷，并定時(shí)0.5ms
  21.    EA=1;
  22.    ET0=1;
  23.    TH0=0XFE;
  24.    TL0=0X33;
  25.    while(1)
  26.    {  
  27.      if(dis<=8)
  28.         {
  29.       duojiJD=1;
  30.           duojiCNT=0;
  31.           for(a=20000;a>0;a--);
  32.           for(a=20000;a>0;a--);
  33.           open();
  34.           jisuan();
  35.                                                        //{如果距離大于8，前進(jìn)，并每隔一個(gè)for循環(huán)開啟一次超聲波,                                                                                                                                                                                                 
  36.                                                                //如果距離小于8，舵機(jī)轉(zhuǎn)到0度//{如果0度處距離大于8，舵機(jī)歸中，并前進(jìn)                        {距離小于8，舵機(jī)歸中，后退       
  37.                   if(dis>=8)                                                                                        //{如果0度處距離小于8，舵機(jī)轉(zhuǎn)到180度，開啟超聲波{距離大于8，歸中
  38.                   {
  39.                    duojiJD=3;      //舵機(jī)歸中
  40.                    duojiCNT=0;
  41.                    for(a=20000;a>0;a--);
  42.                    for(a=20000;a>0;a--);
  43.                    }
  44.                    else
  45.                    {
  46.                    duojiJD=5;      //舵機(jī)轉(zhuǎn)到180度
  47.                    duojiCNT=0;
  48.                    for(a=20000;a>0;a--);         
  49.                    for(a=20000;a>0;a--);
  50.                    for(a=20000;a>0;a--);
  51.                    open();
  52.                    jisuan();
  53.                       if(dis>=8)
  54.                           {
  55.                            duojiJD=3;
  56.                        duojiCNT=0;
  57.                            }
  58.                            else
  59.                            {
  60.                            duojiJD=5;
  61.                            duojiCNT=0;
  62.                            for(a=20000;a>0;a--);
  63.                        for(a=20000;a>0;a--);
  64.                        for(a=20000;a>0;a--);
  65.                            }
  66.                    }
  67.                 }
  68.         else
  69.         {
  70.          duojiJD=3;
  71.          duojiCNT=0;
  72.          open();
  73.          jisuan();
  74.          for(a=20000;a>0;a--);
  75.          }
  76.    }
  77. }

  79. void open()
  80. {
  81.   trig=1;
  82.   _nop_();
  83.   _nop_();
  84.   _nop_();
  85.   _nop_();
  86.   _nop_();
  87.   _nop_();
  88.   _nop_();
  89.   _nop_();
  90.   _nop_();
  91.   _nop_();
  92.   _nop_();
  93.   _nop_();
  94.   trig=0;
  95. }

  97. void jisuan()
  98. {
  99.    unsigned int t;
  100.    TH1=0;
  101.    TL1=0;
  102.    while(!echo);
  103.    TR1=1;
  104.    while(echo);
  105.    TR1=0;
  106.    t=TL1+TH1*255;
  107.    dis=(t*1.7)/100;
  108. }

  110. void timer() interrupt 1
  111. {
  112.    TH0=0XFE;
  113.    TL0=0X33;
  114.    if(duojiCNT<duojiJD)
  115.    {
  116.      duojip=1;
  117.          }
  118.         else
  119.         {
  120.          duojip=0;
  121.          }
  122.    duojiCNT++;
  123.    duojiCNT=duojiCNT%40;                        //每20ms duojiCNT歸零
  124. }  
復(fù)制代碼

所有資料51hei提供下載:
舵機(jī)測(cè)試，電機(jī)測(cè)試，超聲波小車程序.rar (85.41 KB, 下載次數(shù): 49)


評(píng)分

參與人數(shù) 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎(jiǎng)勵(lì)！

查看全部評(píng)分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏1 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表