找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 6118|回复: 5
收起左侧

51单片机超声波测距控制步进电机转速实验程序

  [复制链接]
ID:467782 发表于 2019-1-14 11:55 | 显示全部楼层 |阅读模式
这个起初是学校的单片机实验课的简单题目,就是这几天的课程,但是我发现网上找不到直接的程序,就自力更生用我很有限的单片机知识和C语言基础写了这个程序。里面测距和步进电机驱动都是现成的,不过我稍微改动了一点点,可以显示学号,设置两个阈值控制三段转速,我试了试,在这个学校很常见的开发板上很好用。程序很简单很简陋,但确实给我带来了一些新的知识,也希望能给有需要的朋友一点点帮助。
这里是显示固定数字,程序里各个部分我都放了注释,本来是为了让老师多给点分写的,不过好像大家也能看得更清楚。
image3.png
这里是显示实时测距。
image4.png
这里是两段阈值的加减设置,用来隔开三段速度控制
image5.png

单片机源程序如下:
  1. /*********************************************************************
  2. * 实 验 名:超声波测距控制步进电机实验
  3. *********************************************************************/
  4. #include "reg52.h"
  5. #include <intrins.h>

  6. sbit RX=P2^1;
  7. sbit TX=P2^0;          //t,e定义超声波管教
  8. unsignedint  time=0;
  9. unsignedint  timer=0;
  10. unsigned long S=0;
  11. bit      flag =0; //测量标志
  12. bit                srFlag                = 1;
  13. unsignedint a=100;
  14. unsignedint b=600;
  15. unsignedinta_o=100;
  16. unsignedintb_o=600;
  17. unsignedint mid;
  18. unsigned char        iSW        = 0;
  19. unsigned char uMode                                = 1;

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

  38. unsigned char code FFW[8]={0xf1,0xf3,0xf2,0xf6,0xf4,0xfc,0xf8,0xf9}; //反转顺序
  39. unsigned char code FFZ[8]={0xf9,0xf8,0xfc,0xf4,0xf6,0xf2,0xf3,0xf1}; //正转顺序

  40. unsigned char Direction,Speed;
  41. void Delay(unsigned int t);
  42. void  Motor();
  43. voidDigDisplay();

  44. void Delay1ms()   //?? 0us
  45. {
  46. unsigned char a,b,c;
  47. for(c=2;c>0;c--)
  48. for(b=38;b>0;b--)
  49. for(a=13;a>0;a--);       
  50.                        
  51. }

  52. voidDigDisplay()
  53. {
  54.         unsigned char i;
  55.         unsignedint j;
  56.         for(i=0;i<8;i++)
  57.         {
  58.                 switch(i)         //位选,选择点亮的数码管,
  59.                 {
  60.                         case(0):
  61.                                 LSA=0;LSB=0;LSC=0; break;//显示第0位
  62.                         case(1):
  63.                                 LSA=1;LSB=0;LSC=0; break;//显示第1位
  64.                         case(2):
  65.                                 LSA=0;LSB=1;LSC=0; break;//显示第2位
  66.                         case(3):
  67.                                 LSA=1;LSB=1;LSC=0; break;//显示第3位
  68.                         case(4):
  69.                                 LSA=0;LSB=0;LSC=1; break;//显示第4位
  70.                         case(5):
  71.                                 LSA=1;LSB=0;LSC=1; break;//显示第5位
  72.                         case(6):
  73.                                 LSA=0;LSB=1;LSC=1; break;//显示第6位
  74.                         case(7):
  75.                                 LSA=1;LSB=1;LSC=1; break;//显示第7位  //势能端       
  76.                 }
  77.                  GPIO_DIG=disbuff[i];//发送段码
  78.                        
  79.                 j=10;                                                 //扫描间隔时间设定       
  80.                 while(j--);                                            //延时
  81.                 GPIO_DIG=0x00;//消隐
  82.         }
  83. }

  84. unsigned char scanKey(void)
  85. {
  86. // 如果此前没有按键
  87.         if(keyEx == 0 )
  88.         {
  89.                 if( K1 == 0 )
  90.                 {
  91.                         keyEx        = 1;        // 有键按下
  92.                         return 1;                // 键值1表示阈值ab切换
  93.                 }
  94.                 if( K2 == 0 )
  95.                 {
  96.                         keyEx        = 1;        // 有键按下
  97.                         return 2;                // 键值2表示'+'
  98.                 }
  99.                 if( K3 == 0 )
  100.                 {
  101.                         keyEx        = 1;        // 有键按下
  102.                         return 3;                // 键值3表示'-'
  103.                 }
  104.                 if( K4 == 0 )
  105.                 {
  106.                         keyEx        = 1;        // 有键按下
  107.                         return 4;                // 键值4表示数位切换
  108.                 }               
  109.                 return 0;
  110.         }
  111.         else
  112.         {
  113.                 if( K1 == 1 && K2 == 1 && K3 == 1 && K4 == 1 )
  114.                 {
  115.                         keyEx        = 0;        // 等待没有按键后,按键保护值清0
  116.                 }
  117.         }
  118.         return 0;
  119. }
  120. /*********************************************************************
  121. * 函 数 名:Motor
  122. * 函数功能:电机旋转函数
  123. *********************************************************************/
  124. void  Motor()
  125. {
  126.         unsigned char i;
  127.         for(i=0;i<8;i++)
  128.         {
  129.                 if(Direction==1)
  130.                         GPIO_MOTOR = FFW[i]&0x1f;  //???
  131.                 if(Direction==2)
  132.                         GPIO_MOTOR = FFZ[i]&0x1f;
  133.                 Delay(Speed);        //????       
  134.         }       
  135. }

  136. void  zd3()  interrupt 3                  //T1中断用来扫描数码管和计800MS启动模块
  137. {
  138.         TH1=0xf8;
  139.         TL1=0x30;
  140.         DigDisplay();
  141.         timer++;
  142.         if(srFlag||timer>=100)
  143. //200ms 中断一次
  144.         {
  145.                 srFlag = 0;
  146.                 timer=0;
  147.                 TX=1;        //至高点平                                //800MS  启动一次模块
  148.                 _nop_();
  149.                 _nop_();
  150.                 _nop_();
  151.                 _nop_();
  152.                 _nop_();       
  153.                 _nop_();
  154.                 _nop_();
  155.                 _nop_();
  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.                 //20us高电平               
  169.                 TX=0;
  170.         }
  171. }

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

  319. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
c源文件.rar (2.33 KB, 下载次数: 88)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励!

查看全部评分

回复

使用道具 举报

ID:546439 发表于 2019-6-26 19:44 | 显示全部楼层
为什么我这里报错第九行
回复

使用道具 举报

ID:421308 发表于 2019-7-13 16:56 | 显示全部楼层
正需要,学习下
回复

使用道具 举报

ID:583390 发表于 2019-7-13 17:24 | 显示全部楼层
用不了,什么情况
回复

使用道具 举报

ID:421308 发表于 2019-7-13 17:26 | 显示全部楼层
用不了,这个
回复

使用道具 举报

ID:471817 发表于 2019-7-13 23:16 | 显示全部楼层
感谢楼主,可以正常使用
大家看下代码有些没有空格的改下就行,
比如第九行的unsignedint  time=0;
改成unsigned int  time=0;
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表