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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

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

基于stm32的小車差速轉彎源程序

[復制鏈接]
跳轉到指定樓層
樓主
ID:383648 發表于 2018-8-19 06:54 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
這個是我最近在做的一個比賽里用到的程序,分享給大家。
這個同樣也是需要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)



評分

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

查看全部評分

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

使用道具 舉報

沙發
ID:520034 發表于 2019-4-23 22:24 | 只看該作者
謝謝分享
回復

使用道具 舉報

板凳
ID:716037 發表于 2020-3-27 17:28 | 只看該作者
謝謝樓主!請問有電路原理圖嗎?
回復

使用道具 舉報

地板
ID:653456 發表于 2020-10-11 12:39 | 只看該作者
感謝分享,電賽正在使用。
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 国产精品久久久久久婷婷天堂 | 国产一区二区三区免费视频 | 亚洲免费在线视频 | 国产一区亚洲 | 午夜精品一区二区三区在线视频 | 欧美午夜视频 | 成人小视频在线 | 日日夜夜免费精品视频 | 中文字幕一区二区三区四区 | 亚洲成av人片在线观看 | 麻豆精品国产91久久久久久 | 亚洲一区国产精品 | 91久久网站 | 欧美午夜影院 | 国产精品久久久久久福利一牛影视 | 国产欧美在线观看 | 在线成人免费视频 | 亚洲aⅴ一区二区 | 免费天天干 | 一级毛片免费完整视频 | 国产精品成人在线 | 97伦理 | 国产黑丝在线 | 天天操夜夜看 | 免费成人av网站 | 日韩在线视频免费观看 | 日韩美女爱爱 | 日韩av在线一区二区 | 亚洲国产一区在线 | 免费视频一区 | 精久久久| 国产精品1区2区3区 国产在线观看一区 | 三级视频久久 | 欧美精品乱码久久久久久按摩 | 亚洲精品免费视频 | 日韩成人在线免费视频 | 国产中文一区二区三区 | 日韩精品一区二区三区 | 亚洲欧美在线视频 | 少妇av片 | 国产一级片免费看 |