標題: 基于stm32f103c8t6藍牙遙控小車可測距避障程序 [打印本頁]
作者: 2549367083    時間: 2021-7-28 13:35
標題: 基于stm32f103c8t6藍牙遙控小車可測距避障程序
STM32單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "key.h"
  4. #include "sys.h"
  5. #include "usart.h"
  6. #include "timer.h"
  7. #include "motor.h"
  8. #include "sg90.h"
  9. #include "HCSR.h"
  10. #include "oled.h"       
  11. #include "beep.h"
  12. #include "motorpwm.h"
  13. #include "TCRT.h"
  14. #define motor1_PWM     TIM1->CCR1               

  16. #define motor3_PWM     TIM1->CCR3               
  17.         #define motor2_PWM     TIM1->CCR2               
  18.        
  19. #define motor4_PWM     TIM1->CCR4       
  20. // motor11=1; PA7
  21. //                motor12=0; PA6
  22. //               
  23. //                motor21=1; PB7
  24. //                motor21=0; PB6


  27. extern u8 res;       
  28.        
  29. int main(void)
  30. {                                
  31.          int len;
  32.                  
  33.         delay_init();                     //延時函數(shù)初始化          
  34.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);          //設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應(yīng)優(yōu)先級
  35.         uart_init(9600);         //串口初始化為9600
  36.         My_USART2_Init();  
  37.           OLED_Init();
  38.          OLED_Clear();
  39.          motor_pwm_init();
  40.          Motor_Init();
  41.         TIM3_PWM_Init(199,7199);         //不分頻。T為20ms，這樣的配置就是為了讓輸出的PWM信號達到舵機要求的20ms周期。
  42.         SG90_pwm_init();
  43.           TCRT_config(); //循跡模塊初始化
  44.          CH_SR04_Init();
  45.          motor1_PWM=0;motor3_PWM =0;motor21=0; motor22=0;
  46. //         motor1_PWM=10;motor2_PWM=10;motor3_PWM =10;motor4_PWM =10;
  47.          beep_Init();
  48.            while(1)
  49.         {
  50.                  len =Senor_Using();
  51. //     printf("距離為:%dcm\n",length);   
  52.                  OLED_ShowCHinese(0,0,0);//前
  53.                 OLED_ShowCHinese(18,0,1);//方
  54.                 OLED_ShowCHinese(36,0,2);//距
  55.                 OLED_ShowCHinese(54,0,3);//離
  56.                 OLED_ShowCHinese(72,0,4);//為
  57.                  OLED_Float(3,3,len,1);   
  58.      delay_ms(20);                   
  59. //                  if(res=='1'){motor11=1; motor12=0;motor21=1; motor22=0;TIM_SetCompare2(TIM3,175);}//前進右轉(zhuǎn)90
  60. if(res=='1')//避障
  61. {
  62.        
  63. float  length_res[5];  //用來存放測距結(jié)果
  64.                  len =Senor_Using();
  65. //     printf("距離為:%dcm\n",length);   
  66.                  OLED_ShowCHinese(0,0,0);//前
  67.                 OLED_ShowCHinese(18,0,1);//方
  68.                 OLED_ShowCHinese(36,0,2);//距
  69.                 OLED_ShowCHinese(54,0,3);//離
  70.                 OLED_ShowCHinese(72,0,4);//為
  71.                  OLED_Float(3,3,len,1);   
  72.      delay_ms(20);  

  74.                 SG90_Front;    //舵機擺正
  75.                 delay_ms(100);
  76.     length_res[0] =Senor_Using();  //測前方距離放在數(shù)組里
  77.                 delay_ms(100);
  78.                        
  79.                
  80.                 if(length_res[0]>40.00)       //如果前方距離大于30cm  前進
  81.                         {
  82.                                 motor1_PWM=70;motor3_PWM =70;        motor21=0; motor22=0;  
  83.                           SG90_Front;               
  84. TIM_SetCompare2(TIM3,185);                                //方向回中  

  86.                                
  87.                                 }
  88.                                
  89.                 if(length_res[0]<40.00)     //如果前方距離小于30厘米  停車測左右距離
  90.                         {
  91.                         beep=1;
  92.                        
  93.                                  motor1_PWM=0;motor3_PWM =0;motor21=0; motor22=0;  
  94.                                
  95.                           SG90_Left_45;   //舵機左轉(zhuǎn)45度測距
  96.                           delay_ms(700);beep=0;               
  97.                           length_res[1] =Senor_Using();    //把測量結(jié)果放進數(shù)組
  98.         SG90_Right_45;     //舵機右轉(zhuǎn)45度測距
  99.                           delay_ms(700);       
  100.         length_res[4] =Senor_Using();     //把測量結(jié)果放進數(shù)組                               
  101.                                
  102.                           SG90_Front;          //舵機擺正
  103.                           delay_ms(100);
  104.                 if(length_res[1]>length_res[4])    //如果左邊的距離大于右邊的距離
  105.                                 {
  106.                                         do                        //舵機擺正
  107.                                         {
  108.                                         SG90_Front;
  109.                                         delay_ms(10);
  110.                                         length_res[0] =Senor_Using();        //重復(fù)測前方的距離同時左轉(zhuǎn)
  111.                                         delay_ms(10);                                               
  112.                                         TIM_SetCompare2(TIM3,195);
  113.                                         motor1_PWM=75;motor3_PWM =75;          motor21=0; motor22=0;                                                 
  114.                                         }
  115.                                         while(length_res[0]<40.00);                //一直轉(zhuǎn)到前方距離大于30cm               
  116.                                 }
  117.                    if(length_res[1]<length_res[4])    //如果右邊的距離大于左邊的距離
  118.                                 {
  119.                                         do
  120.                                         {
  121.                                         SG90_Front;
  122.                                         delay_ms(10);
  123.                                         length_res[0] =Senor_Using();  
  124.                                         delay_ms(10);                                               
  125.                                         TIM_SetCompare2(TIM3,175);
  126.                                         motor1_PWM=75;motor3_PWM =75;         motor21=0; motor22=0;                                                  
  127.                                         }
  128.                                         while(length_res[0]<40.00);                //一直轉(zhuǎn)到前方距離大于30cm
  129.                                 }
  130.                                
  131.                         }               
  132.        
  133.        

  135. }
  136.                         if(res=='2')
  137.         {
  138.                                 if(Senor_Using()<30)
  139.                                 {        beep=1;
  140.         delay_ms(500);
  141.         beep=0;motor1_PWM=0;motor3_PWM =0;motor21=0; motor22=0;delay_ms(300);}motor1_PWM=75;motor3_PWM =65;motor21=0; motor22=0;  TIM_SetCompare2(TIM3,180);}//前進右轉(zhuǎn)45
  142.                         if(res=='3')
  143. {
  144.         if(Senor_Using()<30)
  145.         {beep=1;
  146.         delay_ms(500);
  147.         beep=0;motor1_PWM=0;motor3_PWM =0;motor21=0; motor22=0;delay_ms(600);
  148.         }
  149. motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;  TIM_SetCompare2(TIM3,185);}//直行
  150.                         if(res=='4')
  151. {
  152.         if(Senor_Using()<30)
  153.                 {beep=1;
  154.         delay_ms(500);
  155.         beep=0;motor1_PWM=0;motor3_PWM =0;motor21=0; motor22=0;delay_ms(300);}motor1_PWM=65;motor3_PWM =75;motor21=0; motor22=0;  TIM_SetCompare2(TIM3,190);}//前進左轉(zhuǎn)45
  156. //                        if(res=='5'){motor11=1; motor12=0;motor21=1; motor22=0;TIM_SetCompare2(TIM3,195);}//前進左轉(zhuǎn)90
  157.                         if(res=='0'){TIM_SetCompare2(TIM3,185);motor1_PWM=0;motor3_PWM =0;;motor21=0; motor22=0;}
  158.                         if(res=='6'){motor1_PWM=30;motor3_PWM =30;motor21=1; motor22=1;TIM_SetCompare2(TIM3,185);}//后退
  159.                         if(res=='7'){motor1_PWM=30;motor3_PWM =30;motor21=1; motor22=1;TIM_SetCompare2(TIM3,180);}//后退右轉(zhuǎn)45
  160.                         if(res=='8'){motor1_PWM=30;motor3_PWM =30;motor21=1; motor22=1;TIM_SetCompare2(TIM3,190);}//后退左轉(zhuǎn)45

  162.                         if(res=='5')
  163.         {  
  164.        
  165.                                  Read_TCRT_Date(); //讀循跡線值
  166.                 TIM_SetCompare2(TIM3,185);                        //回中
  167.    
  168.          if(L==1&&M==1&&R==1)//11
  169.           {
  170.              motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;          //如果都沒有讀取到黑線，直走
  171.                 TIM_SetCompare2(TIM3,0);
  172.             delay_ms(10);
  173.           }
  174.          if(L==1&&M==0&&R==1)//101
  175.           {
  176.           motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;       //如果中間一個讀取到黑線，直走
  177.                   TIM_SetCompare2(TIM3,185);                //回中
  178.             delay_ms(10);
  179.           }          
  180.          if(L==1&&M==1&&R==0)//110
  181.           {
  182.                         motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;        //直走
  183.         TIM_SetCompare2(TIM3,179); //如果右邊讀取到黑線，右轉(zhuǎn)
  184.             delay_ms(10);
  185.           }

  187.           if(L==0&&M==1&&R==1)//011
  188.           {
  189.                         motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;        //直走
  190.                  TIM_SetCompare2(TIM3,191); //如果左邊讀取到黑線，左轉(zhuǎn)
  191.              delay_ms(10);
  192.           }
  193.                 if(L==0&&M==0&&R==0)//000
  194.           {
  195.             motor1_PWM=75;motor3_PWM =75;motor21=0; motor22=0;
  196.                          TIM_SetCompare2(TIM3,185);
  197.                        
  198.                 }               
  199.         }
  200.         }
  201.                                        
  202.                                                
  203.                 //在周期20ms的PWM信號中，不同的脈寬對應(yīng)舵機不同的轉(zhuǎn)動角度，在0.5ms-2.5ms間有效                                                                                  
  204.                 //        TIM_SetCompare2(TIM4,175);//總共計數(shù)200，前面設(shè)置的模式是計數(shù)在比較值之后才是高電平
  205.                 //也就是高電平的時間是[(200-175)/200]*20ms=2.5ms,即轉(zhuǎn)過360度，180度舵機依次類推                               
  206.         }         
復(fù)制代碼

所有程序51hei附件下載:
stm32利用藍牙控制舵機1.3.7z (215.34 KB, 下載次數(shù): 31)





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