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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3029|回復: 1
打印 上一主題 下一主題
收起左側

52單片機的避障小車代碼

[復制鏈接]
跳轉到指定樓層
樓主
ID:958624 發表于 2021-8-3 15:44 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
利用52單片機做的一個避障小車，還有一些地方不足，供參考
  1. #include<reg52.h>
  2. #include<intrins.h>

  4. #define uchar unsigned char
  5. #define obstructionDis 20   //到障礙物距離

  7. sbit LED = P0^0;            //距離小于20就亮
  8. sbit Trig = P1^1;                //TRIG用來發送方波
  9. sbit Echo = P1^2;                //ECHO用來接收方波
  10. sbit Motor_1 = P2^1;                   //控制第一個電機正反轉
  11. sbit Motor_2 = P2^2;                  
  12. sbit Motor_3 = P2^3;                   //控制第二個電機正反轉
  13. sbit Motor_4 = P2^4;                  
  14. sbit servoMotors = P1^0;    //PWM控制舵機引腳

  16. float L = 0;
  17. uchar sum;
  18. uchar Motor_pwm = 0;
  19. uchar Servor = 5;           //設置舵機占空比
  20. uchar servorTime = 0;
  21. uchar ifLeft = 0;           //左方向是否有障礙物
  22. uchar ifRight = 0;          //右方向是否有障礙物

  24. void delay(uchar time)      //延時函數
  25. {         
  26.         uchar i;
  27.         for(;time > 0;time--){
  28.                 for(i = 0;i < 255;i++);
  29.         }
  30. }

  32. void turnLeft()                        //左
  33. {
  34.         Motor_1 = 1;
  35.         Motor_2 = 0;
  36.         Motor_3 = 0;
  37.         Motor_4 = 0;
  38. }

  40. void turnRight()            //右
  41. {
  42.         Motor_1 = 0;
  43.         Motor_2 = 0;
  44.         Motor_3 = 1;
  45.         Motor_4 = 0;
  46. }

  48. void turnUp()                            //前
  49. {
  50.         Motor_1 = 1;
  51.         Motor_2 = 0;
  52.         Motor_3 = 1;
  53.         Motor_4 = 0;
  54. }

  56. void turnDown()                                  //后
  57. {
  58.         Motor_1 = 0;
  59.         Motor_2 = 1;
  60.         Motor_3 = 0;
  61.         Motor_4 = 1;
  62. }
  63. //發射超聲波測距波形
  64. void openHc()
  65. {
  66.     Trig = 1;
  67.     _nop_();                                  //1us,一共20us
  68.     _nop_();_nop_();_nop_();
  69.     _nop_();_nop_();_nop_();
  70.     _nop_();_nop_();_nop_();
  71.     _nop_();_nop_();_nop_();
  72.     _nop_();_nop_();_nop_();
  73.     _nop_();_nop_();_nop_();
  74.     _nop_();
  75.         Trig = 0;
  76. }
  77. //超聲波
  78. uchar getDistance()                  
  79. {
  80.         TH0 = 0;
  81.         TL0 = 0;
  82.         openHc();                        //發送一個方波信號，
  83.         while(!Echo);                    //等于0一直循環，直到Echo為高電平，信號反彈回來
  84.         TR0 = 1;                         //開啟定時器
  85.         while(Echo);     
  86.         TR0 = 0;
  87.         sum = TH0*256 + TL0;    //高八位加低八位組成16位
  88.         L = (sum*1.78)/100;     //L為距離
  89.         if(L < obstructionDis){  //如果距離小于20
  90.                 LED = 1;
  91.                 return 0;
  92.         }else{
  93.                 LED = 0;
  94.                 return 1;
  95.         }
  96. }
  97. //控制舵機方向
  98. void control()
  99. {
  100.                 Servor = 21;                          //舵機向左擺動
  101.                 servorTime = 0;                   //從0開始計數
  102.                 TR1 = 1;                          //開啟T1，舵機開始工作
  103.                 delay(200);                        //等待
  104.                 TR1 = 0;
  105.                 delay(3000);
  106.                 if(getDistance() == 0){
  107.                         turnLeft();
  108.                         delay(200);        
  109.                         delay(200);
  110.                 }
  111.                 Servor = 13;                //超聲波正對前方
  112.                 servorTime = 0;
  113.                 TR1 = 1;                  //定時器T1開始工(T1用來控制舵機)
  114.                 delay(200);         //等待中斷
  115.                 TR1 = 0;            //關閉定時器
  116.                 delay(3000);
  117.                 if(getDistance() == 0){
  118.                         turnDown();
  119.                         delay(200);
  120.                         delay(200);
  121.                         delay(100);
  122.                         turnRight();
  123.                         delay(200);
  124.                         delay(200);
  125.                 }               
  126.                 Servor = 5;                         //舵機向右
  127.                 servorTime = 0;      
  128.                 TR1 = 1;            
  129.                 delay(200);
  130.                 TR1 = 0;
  131.                 delay(3000);
  132.                 if(getDistance() == 0){
  133.                         turnRight();
  134.                         delay(200);
  135.                         delay(200);
  136.                 }        
  137.                 Servor = 13;                //超聲波正對前方
  138.                 servorTime = 0;
  139.                 TR1 = 1;                  //定時器T1開始工(T1用來控制舵機)
  140.                 delay(200);         //等待中斷
  141.                 TR1 = 0;            //關閉定時器
  142.                 delay(3000);
  143.                 if(getDistance() == 0){
  144.                         turnDown();
  145.                         delay(200);
  146.                         delay(200);
  147.                         delay(100);
  148.                         turnRight();
  149.                         delay(200);
  150.                         delay(200);
  151.                 }
  152. }
  153. //初始化
  154. void Init()
  155. {
  156.         LED = 1;                              //LED先亮
  157.         EA = 1;
  158.         ET1 = 1;
  159.         TMOD |= 0x10;                    //00000001，方式1
  160.         TH1 = (65536 - 100)/256;                     //65436,100us
  161.         TL1 = (65536 - 100)%256;
  162. }
  163. //主程序
  164. void main()
  165. {
  166.         Init();
  167.         servorTime = 0;
  168.         while(1){                        //如果返回的是1，則說明沒有障礙物所以一直向前        
  169.                 turnUp();
  170.                 if(getDistance() == 1){
  171.                         control();
  172.                 }else{
  173.                         turnDown();
  174.                         delay(200);
  175.                         delay(200);
  176.                         delay(100);
  177.                         control();
  178.                         break;
  179.                 }
  180.         }
  181. }
  182. //T1中斷
  183. void T1_int() interrupt 3          //產生舵機所用脈常(輸出PWM信號)
  184. {        
  185.         TH1 = 0xff;                //重新賦值
  186.         TL1 = 0x9c;
  187.         servorTime++;              //用來計數中斷次數,加一次就代表100us
  188.         if(servorTime <= Servor){   
  189.                 servoMotors = 1;       //舵機旋轉
  190.         }else{
  191.                 servoMotors = 0;       //舵機停止
  192.         }
  193.         if(servorTime >= 100){             //加到100舵機就停止
  194.                 servorTime = 0;          //舵機停
  195.         }
  196. }

復制代碼

評分

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

查看全部評分

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

使用道具 舉報

沙發
ID:869305 發表于 2021-9-4 17:29 | 只看該作者
博主，程序能運行嗎？我看起來有點懵
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 国产精品2 | 伊人久久一区二区 | 日日夜夜免费精品视频 | 狠狠热视频 | 免费一区二区 | 欧美精品一区二区三区四区五区 | 欧洲毛片 | 免费精品 | 中文亚洲视频 | 久久不卡 | 国产激情视频网站 | 人人人人干 | 久久91精品国产一区二区三区 | 欧美日韩精品影院 | 久久午夜精品福利一区二区 | 色噜噜狠狠色综合中国 | 日韩欧美在 | 亚洲福利在线观看 | 国产九一精品 | 毛片免费看的 | 精品毛片视频 | 亚洲三级视频 | 999国产精品视频免费 | 在线播放国产一区二区三区 | 午夜精品福利视频 | 国产91丝袜在线播放 | 欧美在线观看网站 | 亚洲欧美在线视频 | 日韩久久精品 | 四虎永久免费影院 | 欧美中国少妇xxx性高请视频 | 亚洲欧美自拍偷拍视频 | 国产人成精品一区二区三 | 99久久婷婷国产综合精品首页 | 欧美国产视频 | 男人的天堂视频网站 | 天堂在线www | av在线一区二区三区 | 中文字幕亚洲一区二区va在线 | 91亚洲国产成人久久精品网站 | caoporn视频 |