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

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

QQ登錄

只需一步，快速開始

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

基于K60單片機(jī)控制的智能循跡避障小車程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:994606 發(fā)表于 2021-12-31 12:00 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
這是上個(gè)月做的基于K60控制的智能循跡避障小車通過五路紅外傳感器使小車沿著黑線循跡
通過HC-SR04來(lái)進(jìn)行避障
  1. #include "common.h"
  2. #include "include.h"

  4. int date=2;
  5. int i=3;
  6. int distance=399;   //測(cè)量距離
  7. int Time = 100000;
  8. uint32 timevar;

  10. //直行
  11. void straight()
  12. {
  13.     gpio_set(PTE8, 1);//右
  14.     gpio_set(PTE9, 0); //右
  15.     gpio_set(PTE10,0);//左
  16.     gpio_set(PTE11,1); //左
  17.     ftm_pwm_duty(FTM0, FTM_CH0,25);
  18.     ftm_pwm_duty(FTM0, FTM_CH2,25);
  19. }

  21. //慢直行
  22. void slow()
  23. {
  24.     gpio_set(PTE8, 1);//右
  25.     gpio_set(PTE9, 0); //右
  26.     gpio_set(PTE10,0);//左
  27.     gpio_set(PTE11,1); //左
  28.     ftm_pwm_duty(FTM0, FTM_CH0,10);
  29.     ftm_pwm_duty(FTM0, FTM_CH2,10);
  30. }

  32. //左轉(zhuǎn)彎
  33. void left()
  34. {
  35.     gpio_set(PTE8, 1);//右
  36.     gpio_set(PTE9, 0); //右
  37.     gpio_set(PTE10,1);//左
  38.     gpio_set(PTE11,0); //左
  39.     ftm_pwm_duty(FTM0, FTM_CH0,23);
  40.     ftm_pwm_duty(FTM0, FTM_CH2,7);
  41. }

  43. //左轉(zhuǎn)大彎
  44. void bigleft()
  45. {
  46.     gpio_set(PTE8,1);
  47.     gpio_set(PTE9,0);
  48.     gpio_set(PTE10,1);
  49.     gpio_set(PTE11,0);  
  50.     ftm_pwm_duty(FTM0, FTM_CH0,30);
  51.     ftm_pwm_duty(FTM0, FTM_CH2,12);
  52. }

  54. //右轉(zhuǎn)彎
  55. void right()
  56. {
  57.     gpio_set(PTE8,0);
  58.     gpio_set(PTE9,1);
  59.     gpio_set(PTE10,0);
  60.     gpio_set(PTE11,1);
  61.     ftm_pwm_duty(FTM0, FTM_CH0,7);
  62.     ftm_pwm_duty(FTM0, FTM_CH2,23);
  63. }

  65. //右轉(zhuǎn)大彎
  66. void bigright()
  67. {
  68.     gpio_set(PTE8,0);
  69.     gpio_set(PTE9,1);
  70.     gpio_set(PTE10,0);
  71.     gpio_set(PTE11,1);
  72.     ftm_pwm_duty(FTM0, FTM_CH0,12);
  73.     ftm_pwm_duty(FTM0, FTM_CH2,30);
  74. }

  76. //停
  77. void stop()
  78. {
  79.     gpio_set(PTE8,0);  
  80.     gpio_set(PTE9,0);  
  81.     gpio_set(PTE10,0);  
  82.     gpio_set(PTE11,0);
  83.     ftm_pwm_duty(FTM0, FTM_CH0,0);
  84.     ftm_pwm_duty(FTM0, FTM_CH2,0);
  85. }

  87. //后退
  88. void back()
  89. {
  90.     gpio_set(PTE8,0);  
  91.     gpio_set(PTE9,1);  
  92.     gpio_set(PTE10,1);  
  93.     gpio_set(PTE11,0);
  94.     ftm_pwm_duty(FTM0, FTM_CH0,17);
  95.     ftm_pwm_duty(FTM0, FTM_CH2,17);
  96. }
  97. //TRIG發(fā)射脈沖
  98. void trigpulse()
  99. {
  100.     gpio_set(PTA25,1);               //產(chǎn)生觸發(fā)脈沖
  101.     systick_delay_us(15);      
  102.     gpio_set(PTA25,0);           //產(chǎn)生一個(gè)20us的高電平脈沖
  103. }

  105. //超聲波測(cè)距
  106. void chaoshengbo()
  107. {   
  108.    
  109.     gpio_set(PTA25,1);               //產(chǎn)生觸發(fā)脈沖
  110.     systick_delay_us(15);      
  111.     gpio_set(PTA25,0);           //產(chǎn)生一個(gè)20us的高電平脈沖
  112.     while(gpio_get(PTA27)==0);             //等待電平變高，低電平一直等待
  113.     pit_time_start(PIT0); //開始計(jì)時(shí)
  114.     while(gpio_get(PTA27)==1);      //等待電平變低，高電平一直等待   
  115.     Time=pit_time_get_us(PIT0);    //停止計(jì)時(shí)，獲取計(jì)時(shí)時(shí)間
  116. //    timevar=Time*1000/bus_clk_khz;
  117. //    distance = timevar*(331.4+0.607*20)/20000;
  118.     distance = (int)(Time*1.7)/100;
  119.     systick_delay_ms(60);
  120. }


  123. //超聲波左轉(zhuǎn)
  124. void HCleft()
  125. {   
  126.     gpio_set(PTE8,1);
  127.     gpio_set(PTE9,0);
  128.     gpio_set(PTE10,0);
  129.     gpio_set(PTE11,1);
  130.     ftm_pwm_duty(FTM0, FTM_CH0,45);//右
  131.     ftm_pwm_duty(FTM0, FTM_CH2,15);//左
  132. }

  134. //超聲波右轉(zhuǎn)
  135. void HCright()
  136. {
  137.     gpio_set(PTE8,1);
  138.     gpio_set(PTE9,0);
  139.     gpio_set(PTE10,0);//左
  140.     gpio_set(PTE11,1); //左
  141.     ftm_pwm_duty(FTM0, FTM_CH0,15);
  142.     ftm_pwm_duty(FTM0, FTM_CH2,50);
  143. }

  145. void xunji()
  146. {
  147.            //循跡 PTB4-右輪
  148.         if((gpio_get(PTB4)==1)&&(gpio_get(PTB5)==1)&&(gpio_get(PTB6)==1)&(gpio_get(PTB7)==1)&&(gpio_get(PTC0)==1))
  149.         {   
  150. //            gpio_set(PTE8, 1);//右
  151. //            gpio_set(PTE9, 0); //右
  152. //            gpio_set(PTE10,0);//左
  153. //            gpio_set(PTE11,1); //左
  154. //            ftm_pwm_duty(FTM0, FTM_CH0,15);
  155. //            ftm_pwm_duty(FTM0, FTM_CH2,15);
  156.            slow();
  157.             systick_delay_ms(10);
  158.         }   
  159.         if((gpio_get(PTB4)==1)&&(gpio_get(PTB5)==1)&&(gpio_get(PTB6)==0)&(gpio_get(PTB7)==1)&&(gpio_get(PTC0)==1))
  160.         {   
  161.             straight();
  162.             systick_delay_ms(10);
  163.         }
  164.         //右轉(zhuǎn)小彎
  165.         if((gpio_get(PTB4)==1)&&(gpio_get(PTB5)==1)&&(gpio_get(PTB6)==1)&(gpio_get(PTB7)==0)&&(gpio_get(PTC0)==1))
  166.         {   
  167.             right();
  168.             systick_delay_ms(10);
  169.         }
  170.         //左轉(zhuǎn)小彎
  171.         if((gpio_get(PTB4)==1)&&(gpio_get(PTB5)==0)&&(gpio_get(PTB6)==1)&(gpio_get(PTB7)==1)&&(gpio_get(PTC0)==1))
  172.         {   
  173.             left();
  174.             systick_delay_ms(10);
  175.         }            
  176.         //右轉(zhuǎn)大彎
  177.         if((gpio_get(PTB4)==1)&&(gpio_get(PTB5)==1)&&(gpio_get(PTB6)==1)&(gpio_get(PTB7)==1)&&(gpio_get(PTC0)==0))
  178.         {            
  179.             bigright();
  180.             systick_delay_ms(10);
  181.         }
  182.         //左轉(zhuǎn)大彎
  183.         if((gpio_get(PTB4)==0)&&(gpio_get(PTB5)==1)&&(gpio_get(PTB6)==1)&(gpio_get(PTB7)==1)&&(gpio_get(PTC0)==1))
  184.         {
  185.             bigleft();
  186.             systick_delay_ms(10);
  187.         }
  188. }
  189. void pit2_hander()
  190. {
  191.     led (LED0,LED_ON);
  192.     led (LED1,LED_ON);
  193.     led (LED2,LED_ON);
  194.     date--;     
  195.     PIT_Flag_Clear(PIT2);
  196. }

  198. void main()
  199. {     
  200.     led_init(LED0);
  201.     led_init(LED1);
  202.     led_init(LED2);
  203.     gpio_init(PTE8, GPO, 1);
  204.     gpio_init(PTE9, GPO, 0);
  205.     gpio_init(PTE10, GPO,0);
  206.     gpio_init(PTE11, GPO,1);
  207.     gpio_init(PTB4, GPI, 0);
  208.     gpio_init(PTB5, GPI, 0);
  209.     gpio_init(PTB6, GPI, 0);
  210.     gpio_init(PTB7, GPI, 0);
  211.     gpio_init(PTC0, GPI, 0);
  212.     gpio_init(PTA25, GPO, 0); //TRIG
  213.     gpio_init  (PTA27, GPI, 0); //ECHO
  214.     ftm_pwm_init(FTM0, FTM_CH0,200,18);
  215.     ftm_pwm_init(FTM0, FTM_CH2,200,18);
  216.          
  217.     pit_init_ms(PIT2, 14000); //初始化 PIT2，定時(shí)時(shí)間為：14s
  218.     set_vector_handler(PIT2_VECTORn,pit2_hander);
  219.     enable_irq(PIT2_IRQn);
  220.    
  221. //    disable_irq(PIT2_IRQn);
  222.     while(i>2)//i>2   
  223.     {   
  224.         xunji();
  225.         while(date<2)
  226.         {
  227.             trigpulse();
  228.             chaoshengbo();
  229.             if(distance<70)
  230.             {     
  231.                 i=2;
  232.                 HCleft();  
  233.                 systick_delay_ms(1000);                    
  234.                 HCright();     
  235.                 systick_delay_ms(600);                  
  236.             }  
  237.         }   
  238.     }
  239.    while(i==2)
  240.    {     
  241.        xunji();
  242.     }
  243. }
復(fù)制代碼





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

使用道具 舉報(bào)

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 国产电影一区二区 | 狠狠干天天干 | 人人看人人干 | 亚洲精品久久久久久国产精华液 | 亚洲成人免费观看 | 国产精品永久免费 | 91中文在线观看 | 欧美黄视频 | 日韩另类视频 | 色99视频 | 一道本一区二区 | 亚洲精品久久久一区二区三区 | 色婷婷激情综合 | 国产做a爱免费视频 | 成人久久18免费网站麻豆 | 久久精品国产一区二区三区不卡 | 久久成人精品 | 欧美天堂| 国产女人与拘做视频免费 | 国产精品欧美一区二区 | 羞羞视频在线观看 | 欧美mv日韩mv国产网站91进入 | 青青草av | 亚洲另类视频 | 国产精品视频999 | 红色av社区 | av国产精品毛片一区二区小说 | 神马久久av | 国产无套一区二区三区久久 | 最新黄色毛片 | 国产在线精品一区二区三区 | 综合久久综合久久 | 国产日产精品一区二区三区四区 | 成人日韩av | av在线播放网址 | 久久九九色 | 亚洲一区二区av | 国产精品久久久久久吹潮 | 免费观看一级特黄欧美大片 | 九九热免费视频在线观看 | 免费国产黄网站在线观看视频 |