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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

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

基于stm32的小車差速轉(zhuǎn)彎源程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:383648 發(fā)表于 2018-8-19 06:54 | 只看該作者 回帖獎勵(lì) |倒序?yàn)g覽 |閱讀模式
這個(gè)是我最近在做的一個(gè)比賽里用到的程序,分享給大家。
這個(gè)同樣也是需要ADC算法的,主函數(shù)如下:
  1. int main(void)
  2. {         
  3.                         int adcx1,adcx2,cha;
  4.                         int m,last_m;
  5.                         delay_init();                     //延時(shí)函數(shù)初始化
  6.                         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//設(shè)置中斷優(yōu)先級為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. }

復(fù)制代碼

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



評分

參與人數(shù) 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵(lì)!

查看全部評分

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

使用道具 舉報(bào)

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

使用道具 舉報(bào)

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

使用道具 舉報(bào)

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

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板: 日韩在线国产 | 人人爽日日躁夜夜躁尤物 | 久久综合爱 | 91精品国产一区二区三区动漫 | 一区中文字幕 | 欧美在线视频网 | 久久爆操 | 一区二区三区国产 | 精品日韩欧美一区二区 | 日韩免费 | 好婷婷网 | 亚洲一区二区三 | 黄色一级大片在线免费看产 | 国产精品无 | 亚洲精品日韩在线观看 | 欧美精品久久 | 在线观看免费av网 | 精品国产伦一区二区三区观看体验 | 亚洲在线一区 | 日韩中文字幕在线观看视频 | 国产视频久 | 亚洲精品久久久久久久久久久久久 | 男女视频在线观看 | 成人一区二区三区 | 欧美精品区 | 中文字幕在线一区二区三区 | 青青久在线视频 | 欧美国产日韩在线观看 | 欧美视频在线播放 | 亚洲国产aⅴ成人精品无吗 国产精品永久在线观看 | 日韩欧美网 | 精品久久久久久久久久久久久久久久久 | 欧美日韩国产在线 | 国产一区二区在线视频 | 91中文在线观看 | 精品毛片视频 | 欧美精品1区2区 | 午夜午夜精品一区二区三区文 | 毛片毛片毛片毛片 | 在线观看av网站 | 狠狠干av |