找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 1162|回复: 0
打印 上一主题 下一主题
收起左侧

超声波测试代码

[复制链接]
跳转到指定楼层
楼主
ID:373843 发表于 2018-7-18 09:49 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
超声波测试代码
  1. #include <reg52.h>
  2. #include <intrins.h>

  3. #define IN P1

  4. sbit PWM0A = P3^2;
  5. sbit PWM0B = P3^3;
  6. sbit PWM1A = P3^4;
  7. sbit PWM1B = P3^5;

  8. sbit RX = P0^2;
  9. sbit TX = P0^3;

  10. sbit out1 = P2^2;
  11. sbit out2 = P2^3;

  12. sbit pwm_dj = P3^6;

  13. bit flag = 0;

  14. unsigned int  time=0;
  15. unsigned int  timer=0;
  16. unsigned int  timers=0;
  17. unsigned long S=0;
  18. unsigned long max1 = 0;
  19. unsigned long max2 = 0;
  20. unsigned int dj;

  21. void Conut();
  22. void end();

  23. void Conut()
  24. {
  25.         while(!RX);
  26.         TR0=1;
  27.         while(RX);
  28.         TR0=0;
  29.        
  30.         time=TH0*256+TL0;
  31.         TH0=0;
  32.         TL0=0;
  33.        
  34.         S=(time*1.7)/100;
  35. }

  36. void zd0() interrupt 1
  37. {
  38.         flag=1;
  39. }

  40. void  zd3()  interrupt 3
  41. {
  42.         TH1=0xFF;
  43.         TL1=0xEC;
  44.         timer++;
  45.         timers++;
  46.         if(timers >= 500)
  47.                 timers = 0;
  48.         if(timers <= dj) pwm_dj = 1;
  49.         else pwm_dj = 0;
  50. }

  51. void end()
  52. {
  53.         PWM0A = 0;
  54.         PWM0B = 0;
  55.         PWM1A = 0;
  56.         PWM1B = 0;
  57.        
  58.         IN = 0x00;
  59. }

  60. void front()
  61. {
  62.         PWM0A = 1;
  63.         PWM0B = 1;
  64.         PWM1A = 1;
  65.         PWM1B = 1;
  66.        
  67.         IN = 0x55;
  68. }

  69. void right()
  70. {
  71.         PWM0A = 1;
  72.         PWM0B = 1;
  73.         PWM1A = 1;
  74.         PWM1B = 1;
  75.        
  76.         IN = 0x56;
  77. }

  78. void left()
  79. {
  80.         PWM0A = 1;
  81.         PWM0B = 1;
  82.         PWM1A = 1;
  83.         PWM1B = 1;
  84.        
  85.         IN = 0x95;
  86. }

  87. void qd()
  88. {
  89.         TX = 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.         TX = 0;
  112. }

  113. void  main()
  114. {
  115.         int i;
  116.   TMOD |= 0x11;
  117.         TH0=0;
  118.         TL0=0;
  119.         TH1=0xFF;                   //0.02MS定时
  120.         TL1=0xEC;
  121.         ET0=1;         //允许T0中断
  122.         ET1=1;                          //允许T1中断
  123.         TR1=1;
  124.         EA=1;                             //开启总中断
  125.        
  126.         end();
  127.         while(1)
  128.         {
  129.                 while(1)
  130.                 {
  131.                         dj = 30;
  132.                         if(timer >= 800)
  133.                         {
  134.                                 timer = 0;
  135.                                 qd();
  136.                                 Conut();
  137.                                 if(S >= 700 || flag == 1){        flag = 0; front();}
  138.                                 else if(S >= 18) front();
  139.                                 else { end(); break;}
  140.                         }
  141.                 }
  142.                 dj = 13;
  143.                 for(i = 0; i < 5000; i++);
  144.                
  145.                 qd();
  146.                 Conut();
  147.                 if(S >= 700 || flag == 1){        flag = 0; max1 = 700;}
  148.                 else max1 = S;
  149.                
  150.                 dj = 50;
  151.                 for(i = 0; i < 5000; i++);
  152.                
  153.                 qd();
  154.                 Conut();
  155.                 if(S >= 700 || flag == 1){        flag = 0; max2 = 700;}
  156.                 else max2 = S;
  157.        
  158.                 dj = 30;
  159.                 for(i = 0; i < 5000; i++);
  160.                
  161.                 if(max1 > max2) right();
  162.                 else left();
  163.                 for(i = 0; i < 5000; i++);
  164.         }
  165. }
复制代码


超声波.7z

21.6 KB, 下载次数: 3, 下载积分: 黑币 -5

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶 踩
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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