標(biāo)題: 51單片機(jī)超聲波測距控制步進(jìn)電機(jī)轉(zhuǎn)速實驗程序 [打印本頁]
作者: TTNNAASS    時間: 2019-1-14 11:55
標(biāo)題: 51單片機(jī)超聲波測距控制步進(jìn)電機(jī)轉(zhuǎn)速實驗程序
這個起初是學(xué)校的單片機(jī)實驗課的簡單題目，就是這幾天的課程，但是我發(fā)現(xiàn)網(wǎng)上找不到直接的程序，就自力更生用我很有限的單片機(jī)知識和C語言基礎(chǔ)寫了這個程序。里面測距和步進(jìn)電機(jī)驅(qū)動都是現(xiàn)成的，不過我稍微改動了一點點，可以顯示學(xué)號，設(shè)置兩個閾值控制三段轉(zhuǎn)速，我試了試，在這個學(xué)校很常見的開發(fā)板上很好用。程序很簡單很簡陋，但確實給我?guī)砹艘恍┬碌闹R，也希望能給有需要的朋友一點點幫助。
這里是顯示固定數(shù)字，程序里各個部分我都放了注釋，本來是為了讓老師多給點分寫的，不過好像大家也能看得更清楚。

這里是顯示實時測距。

這里是兩段閾值的加減設(shè)置，用來隔開三段速度控制


單片機(jī)源程序如下:
  1. /*********************************************************************
  2. * 實 驗 名:超聲波測距控制步進(jìn)電機(jī)實驗
  3. *********************************************************************/
  4. #include "reg52.h"
  5. #include <intrins.h>

  7. sbit RX=P2^1;
  8. sbit TX=P2^0;          //t，e定義超聲波管教
  9. unsignedint  time=0;
  10. unsignedint  timer=0;
  11. unsigned long S=0;
  12. bit      flag =0; //測量標(biāo)志
  13. bit                srFlag                = 1;
  14. unsignedint a=100;
  15. unsignedint b=600;
  16. unsignedinta_o=100;
  17. unsignedintb_o=600;
  18. unsignedint mid;
  19. unsigned char        iSW        = 0;
  20. unsigned char uMode                                = 1;

  22. #define GPIO_DIG P0
  23. sbit LSA=P2^2;
  24. sbit LSB=P2^3;
  25. sbit LSC=P2^4;
  26. unsigned char code DIG_CODE[17]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x77,0x7c,0x39,0x5e,0x79,0x71};
  27. unsigned char disbuff[8] ={0,0,0,0,0,0,0,0};
  28. //電機(jī)IO
  29. #define GPIO_MOTOR P1
  30. sbit F1 = P1^0;
  31. sbit F2 = P1^1;
  32. sbit F3 = P1^2;
  33. sbit F4 = P1^3;
  34. //按鍵IO
  35. sbit K1=P3^1;
  36. sbit K2=P3^0;
  37. sbit K3=P3^2;
  38. sbit K4=P3^3;
  39. unsigned char        keyEx        = 0;

  41. unsigned char code FFW[8]={0xf1,0xf3,0xf2,0xf6,0xf4,0xfc,0xf8,0xf9}; //反轉(zhuǎn)順序
  42. unsigned char code FFZ[8]={0xf9,0xf8,0xfc,0xf4,0xf6,0xf2,0xf3,0xf1}; //正轉(zhuǎn)順序

  44. unsigned char Direction,Speed;
  45. void Delay(unsigned int t);
  46. void  Motor();
  47. voidDigDisplay();

  49. void Delay1ms()   //?? 0us
  50. {
  51. unsigned char a,b,c;
  52. for(c=2;c>0;c--)
  53. for(b=38;b>0;b--)
  54. for(a=13;a>0;a--);       
  55.                        
  56. }

  58. voidDigDisplay()
  59. {
  60.         unsigned char i;
  61.         unsignedint j;
  62.         for(i=0;i<8;i++)
  63.         {
  64.                 switch(i)         //位選，選擇點亮的數(shù)碼管，
  65.                 {
  66.                         case(0):
  67.                                 LSA=0;LSB=0;LSC=0; break;//顯示第0位
  68.                         case(1):
  69.                                 LSA=1;LSB=0;LSC=0; break;//顯示第1位
  70.                         case(2):
  71.                                 LSA=0;LSB=1;LSC=0; break;//顯示第2位
  72.                         case(3):
  73.                                 LSA=1;LSB=1;LSC=0; break;//顯示第3位
  74.                         case(4):
  75.                                 LSA=0;LSB=0;LSC=1; break;//顯示第4位
  76.                         case(5):
  77.                                 LSA=1;LSB=0;LSC=1; break;//顯示第5位
  78.                         case(6):
  79.                                 LSA=0;LSB=1;LSC=1; break;//顯示第6位
  80.                         case(7):
  81.                                 LSA=1;LSB=1;LSC=1; break;//顯示第7位  //勢能端       
  82.                 }
  83.                  GPIO_DIG=disbuff[i];//發(fā)送段碼
  84.                        
  85.                 j=10;                                                 //掃描間隔時間設(shè)定       
  86.                 while(j--);                                            //延時
  87.                 GPIO_DIG=0x00;//消隱
  88.         }
  89. }

  91. unsigned char scanKey(void)
  92. {
  93. // 如果此前沒有按鍵
  94.         if(keyEx == 0 )
  95.         {
  96.                 if( K1 == 0 )
  97.                 {
  98.                         keyEx        = 1;        // 有鍵按下
  99.                         return 1;                // 鍵值1表示閾值ab切換
  100.                 }
  101.                 if( K2 == 0 )
  102.                 {
  103.                         keyEx        = 1;        // 有鍵按下
  104.                         return 2;                // 鍵值2表示'+'
  105.                 }
  106.                 if( K3 == 0 )
  107.                 {
  108.                         keyEx        = 1;        // 有鍵按下
  109.                         return 3;                // 鍵值3表示'-'
  110.                 }
  111.                 if( K4 == 0 )
  112.                 {
  113.                         keyEx        = 1;        // 有鍵按下
  114.                         return 4;                // 鍵值4表示數(shù)位切換
  115.                 }               
  116.                 return 0;
  117.         }
  118.         else
  119.         {
  120.                 if( K1 == 1 && K2 == 1 && K3 == 1 && K4 == 1 )
  121.                 {
  122.                         keyEx        = 0;        // 等待沒有按鍵后，按鍵保護(hù)值清0
  123.                 }
  124.         }
  125.         return 0;
  126. }
  127. /*********************************************************************
  128. * 函 數(shù) 名:Motor
  129. * 函數(shù)功能:電機(jī)旋轉(zhuǎn)函數(shù)
  130. *********************************************************************/
  131. void  Motor()
  132. {
  133.         unsigned char i;
  134.         for(i=0;i<8;i++)
  135.         {
  136.                 if(Direction==1)
  137.                         GPIO_MOTOR = FFW[i]&0x1f;  //???
  138.                 if(Direction==2)
  139.                         GPIO_MOTOR = FFZ[i]&0x1f;
  140.                 Delay(Speed);        //????       
  141.         }       
  142. }

  144. void  zd3()  interrupt 3                  //T1中斷用來掃描數(shù)碼管和計800MS啟動模塊
  145. {
  146.         TH1=0xf8;
  147.         TL1=0x30;
  148.         DigDisplay();
  149.         timer++;
  150.         if(srFlag||timer>=100)
  151. //200ms 中斷一次
  152.         {
  153.                 srFlag = 0;
  154.                 timer=0;
  155.                 TX=1;        //至高點平                                //800MS  啟動一次模塊
  156.                 _nop_();
  157.                 _nop_();
  158.                 _nop_();
  159.                 _nop_();
  160.                 _nop_();       
  161.                 _nop_();
  162.                 _nop_();
  163.                 _nop_();
  164.                 _nop_();
  165.                 _nop_();        
  166.                 _nop_();
  167.                 _nop_();
  168.                 _nop_();
  169.                 _nop_();
  170.                 _nop_();       
  171.                 _nop_();
  172.                 _nop_();
  173.                 _nop_();
  174.                 _nop_();
  175.                 _nop_();
  176.                 //20us高電平               
  177.                 TX=0;
  178.         }
  179. }

  181. /*********************************************************************
  182. * 函 數(shù) 名:main
  183. * 函數(shù)功能:主函數(shù)
  184. *********************************************************************/
  185. void main(void)
  186. {
  187.         unsigned char i;
  188.         Speed=15;
  189.         TMOD=0x11;                   //設(shè)T0為方式1，GATE=1；
  190.         TH0=0;
  191.         TL0=0;         
  192.         //清0
  193.        
  194.         TH1=0xf8;                   //2MS定時
  195.         TL1=0x30;
  196.         ET0=1;             //允許T0中斷
  197.         ET1=1;                           //允許T1中斷
  198.         TR1                = 0;
  199.         EA                = 0;
  200.         while(scanKey() == 0 )
  201.         {
  202.                 disbuff[0]        = DIG_CODE[4];
  203.                 disbuff[1]        = DIG_CODE[5];
  204.                 disbuff[2]        = DIG_CODE[0];
  205.                 disbuff[3]        = DIG_CODE[1];
  206.                 disbuff[4]        = DIG_CODE[0];
  207.                 disbuff[5]        = DIG_CODE[3];
  208.                 disbuff[6]        = DIG_CODE[1];
  209.                 disbuff[7]        = DIG_CODE[1];
  210.                 DigDisplay();
  211.         }
  212.         for(i=0;i<100;i++)
  213.         {
  214.                 Delay1ms();       
  215.         }
  216.         if(uMode == 1 )
  217.         {
  218.                 TR1                = 1;
  219.                 EA                = 1;
  220.         }
  221.         while(1)
  222.         {
  223.                 if(uMode == 0 )
  224.                 {
  225.                         disbuff[0]        = DIG_CODE[a% 10];
  226.                         disbuff[1]        = DIG_CODE[(a / 10) % 10];
  227.                         disbuff[2]        = DIG_CODE[(a / 100) % 10];
  228.                         disbuff[3]        = DIG_CODE[(a / 1000) % 10];
  229.                         disbuff[4]        = DIG_CODE[b% 10];
  230.                         disbuff[5]        = DIG_CODE[(b / 10) % 10];
  231.                         disbuff[6]        = DIG_CODE[(b / 100) % 10];
  232.                         disbuff[7]        = DIG_CODE[(b / 1000) % 10];
  233.                         DigDisplay();
  234.                         switch(scanKey() )
  235.                         {
  236.                         // 如果按下了模式切換鍵
  237.                                 case 1:
  238.                                         uMode        = 1;
  239.                                         TR1                = 1;
  240.                                         EA                = 1;
  241.                                         break;                               
  242.                                 // 如果按下了'+'鍵
  243.                                 case 2:
  244.                                         switch(iSW )
  245.                                         {
  246.                                                 case 0:
  247.                                                 mid = a;
  248.                                                 if( mid        + 100 <= 3000 )
  249.                                                 mid        += 100;
  250.                                                 a = mid;
  251.                                                 break;                                                       
  252.                                                 case 1:
  253.                                                 mid = b;
  254.                                                 if( mid        + 100 <= 3000 )
  255.                                                 mid        += 100;
  256.                                                 b = mid;
  257.                                                 break;                                                                                               
  258.                                                 default:
  259.                                                 break;
  260.                                         }
  261.                                         break;                               
  262.                                 // 如果按下了'-'鍵
  263.                                 case 3:
  264.                                         switch(iSW )
  265.                                         {
  266.                                                 case 0:
  267.                                                 mid = a;
  268.                                                 if( mid        - 100 > 0 )
  269.                                                 mid        -= 100;
  270.                                                 a = mid;
  271.                                                 break;                                                       
  272.                                                 case 1:
  273.                                                 mid = b;
  274.                                                 if( mid        - 100 > 0 )
  275.                                                 mid        -= 100;
  276.                                                 b = mid;                                               
  277.                                                 default:
  278.                                                 break;
  279.                                         }
  280.                                         break;                               
  281.                                 // 如果按下了換位鍵
  282.                                 case 4:
  283.                                         iSW++;
  284.                                         if(iSW>= 2 )
  285.                                                 iSW        = 0;
  286.                                         break;                                       
  287.                                         default:
  288.                                         break;       
  289.                         }
  290.                         if (a>=b)
  291.                         {
  292.                                 a = a_o;
  293.                                 b + b_o;
  294.                         }
  295.                 }
  296.                         else
  297.                 {
  298.                         TH0                 = 0;                // 計數(shù)清0，等待測距計數(shù)
  299.                         TL0                 = 0;                       
  300.                         // 我們假定工作模式=1代表超聲波測距
  301.                         while( !RX &&scanKey() != 1 );                       
  302.                         // 如果有echo信號或者有SET按鍵
  303.                         TR0        = 1;                       
  304.                         if( !RX &&keyEx )                // 如果是有按鍵而沒有echo，則返回參數(shù)設(shè)置
  305.                         {
  306.                                 // 如果有SET按鍵
  307.                                 uMode        = 0;
  308.                                 TR0                = 0;
  309.                                 TR1                = 0;
  310.                                 EA                = 0;
  311.                                 continue;
  312.                         }                       
  313.                         // 如果有echo信號，則一直等待echo信號結(jié)束
  314.                         while(RX );
  315.                         // echo信號結(jié)束，停止計數(shù)
  316.                         TR0                        = 0;
  317.                         time        = TH0 * 256 + TL0;
  318.                         S= (long)(time*0.17);
  319.                         disbuff[3]=DIG_CODE[S%10000/1000];
  320.                         disbuff[2]=DIG_CODE[S%1000/100];
  321.                         disbuff[1]=DIG_CODE[S%100/10];
  322.                         disbuff[0]=DIG_CODE[S%10/1];
  323.                         disbuff[4]        = 0;
  324.                         disbuff[5]        = 0;
  325.                         disbuff[6]        = 0;
  326.                         disbuff[7]        = 0;
  327. ……………………

  329. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
c源文件.rar (2.33 KB, 下載次數(shù): 89)

作者: 空1234    時間: 2019-6-26 19:44
為什么我這里報錯第九行
作者: xiaozhong1314    時間: 2019-7-13 16:56
正需要，學(xué)習(xí)下
作者: admin520    時間: 2019-7-13 17:24
用不了，什么情況
作者: xiaozhong1314    時間: 2019-7-13 17:26
用不了，這個
作者: 261779498    時間: 2019-7-13 23:16
感謝樓主，可以正常使用
大家看下代碼有些沒有空格的改下就行，
比如第九行的unsignedint  time=0;
改成unsigned int  time=0;



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1