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

標題: 基于stm32的小車差速轉彎源程序 [打印本頁]

作者: jeffrey.....    時間: 2018-8-19 06:54
標題: 基于stm32的小車差速轉彎源程序
這個是我最近在做的一個比賽里用到的程序,分享給大家。
這個同樣也是需要ADC算法的,主函數如下:
  1. int main(void)
  2. {         
  3.                         int adcx1,adcx2,cha;
  4.                         int m,last_m;
  5.                         delay_init();                     //延時函數初始化
  6.                         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//設置中斷優先級為2
  7.                         uart_init(115200);                 /串口初始化為115200                     
  8.                         Adc1_Init();                                  //ADC初始化
  9.                         Adc2_Init();        
  10.                         TIM2_PWM_Init(999,200);         /不分頻,PWM頻率=72000000/900=80Khz
  11.                         TIM3_PWM_Init(999,200);         
  12.                         TIM4_PWM_Init(999,200);
  13.                         TIM_SetCompare1(TIM4,0);        
  14.                         TIM_SetCompare2(TIM4,0);
  15.                         TIM_SetCompare3(TIM4,0);
  16.                         TIM_SetCompare4(TIM4,0);
  17.          
  18.                         TIM_SetCompare1(TIM3,0);        
  19.                         TIM_SetCompare2(TIM3,0);        
  20.                         TIM_SetCompare3(TIM2,0);
  21.                         TIM_SetCompare4(TIM2,0);        
  22.          
  23.          
  24. //                 adcx1=Get_Adc1_Average(ADC_Channel_0,20);
  25. //    adcx2=Get_Adc2_Average(ADC_Channel_1,20);
  26. //                           
  27. //                        m=adcx1-adcx2;

  28. //                cha=(float)m*2.0;
  29. //                SPEED(600-cha,600+cha);
  30. //                SPEED(300,300);
  31.          
  32.          
  33.         while(1)
  34.         {
  35.                
  36.                 adcx1=Get_Adc1_Average(ADC_Channel_0,20);
  37.     adcx2=Get_Adc2_Average(ADC_Channel_1,20);
  38.                 if(adcx1<300||adcx2<(-300))
  39.                 {
  40.                         if(last_m>0)
  41.                                 m=+1000;
  42.                         else
  43.                                 m=-1000;
  44.                 }
  45.                 else
  46.                 {
  47.                         m=adcx1-adcx2;
  48.                 }
  49.                
  50.                 if(m>1000)
  51.                         m=1000;
  52.                 if(m<-1000)
  53.                         m=-1000;
  54.                
  55.                
  56.                 cha=(float)m*3.7;
  57.                 if(abs(m)<30)
  58.                 {
  59.                         SPEED(950-cha,950+cha);
  60.                 }
  61.                 else
  62.                 {
  63.                                         SPEED(900-cha,900+cha);

  64.                 }
  65.                
  66.                
  67.                                         printf("%d\n",m);
  68. //                delay_ms(10);
  69.                 last_m=m;
  70.                 }
  71.         
  72. }


  73.              void SPEED(int L,int R)
  74.                                         {

  75.                                                 if(L>999)
  76.                                                 {
  77.                                                         
  78.                                                     L=999;
  79.                                                         
  80.                                                 }        
  81.                                                         if(L<-999)
  82.                                                 {
  83.                                                         
  84.                                                     L=-999;
  85.                                                         
  86.                                                 }        
  87.                                                         if(R>999)
  88.                                                 {
  89.                                                    R=999;
  90.                                                 }        
  91.                                                         if(R<-999)
  92.                                                 {
  93.                                                 R=-999;
  94.                                                 }        
  95.                                         if(L>0)
  96.                                         {
  97.                                         TIM_SetCompare2(TIM3,0);        
  98.                                         TIM_SetCompare4(TIM2,0);        

  99.                                         TIM_SetCompare1(TIM3,L);        
  100.                                         TIM_SetCompare3(TIM2,L);
  101.                                         }
  102.                                         else
  103.                                         {
  104.                                                                         TIM_SetCompare1(TIM3,0);        
  105.                                         TIM_SetCompare2(TIM3,-L);        
  106.                                         TIM_SetCompare3(TIM2,0);
  107.                                         TIM_SetCompare4(TIM2,-L);        
  108.                                        
  109.                                         }
  110.                                        
  111.                                        
  112.                                         if(R>0)
  113.                                         {
  114.                                         TIM_SetCompare1(TIM4,R);        
  115.                                         TIM_SetCompare2(TIM4,0);
  116.                                         TIM_SetCompare3(TIM4,R);
  117.                                         TIM_SetCompare4(TIM4,0);
  118.                                         }
  119.                                         else
  120.                                         {
  121.                                                                 TIM_SetCompare1(TIM4,0);        
  122.                                         TIM_SetCompare2(TIM4,-R);
  123.                                         TIM_SetCompare3(TIM4,0);
  124.                                         TIM_SetCompare4(TIM4,-R);
  125.                                        
  126.                                         }
  127. }

復制代碼

全部資料51hei下載地址:
differ-speed.rar (338.19 KB, 下載次數: 82)




作者: jiabo    時間: 2019-4-23 22:24
謝謝分享
作者: DukeKyrie    時間: 2020-3-27 17:28
謝謝樓主!請問有電路原理圖嗎?
作者: pmp    時間: 2020-10-11 12:39
感謝分享,電賽正在使用。




歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板: 一本色道精品久久一区二区三区 | 日本成人在线免费视频 | 欧美精品一区二区在线观看 | 婷婷激情综合 | 亚洲精品乱 | 美女中文字幕视频 | 一区二区三区久久久 | 四虎影院免费在线 | 人人射人人草 | 91免费观看在线 | 综合久| 风间由美一区二区三区在线观看 | 人人玩人人干 | 福利片在线观看 | 欧美日韩国产精品一区二区 | 在线观看中文字幕视频 | 日韩一区在线观看视频 | 久久只有精品 | 一级欧美一级日韩片 | 国产69精品久久久久777 | 巨大荫蒂视频欧美另类大 | 99色综合 | 国产一级特黄真人毛片 | 欧美精品网站 | 韩日视频在线观看 | 我要看一级片 | 成人一区二区三区 | av国产精品毛片一区二区小说 | xxxxxx国产| 国产精品一区二区三区在线 | 成人国产精品入口免费视频 | 色秀网站 | 水蜜桃久久夜色精品一区 | 日韩欧美视频免费在线观看 | 国产欧美日韩综合精品一区二区 | 福利视频一区二区 | 中文字幕亚洲欧美日韩在线不卡 | 国产乱码精品1区2区3区 | 国产精品久久在线 | 国产精品久久一区 | 中文字幕一区二区三区四区五区 |