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

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

QQ登錄

只需一步,快速開始

搜索
查看: 7021|回復(fù): 3
收起左側(cè)

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

[復(fù)制鏈接]
ID:383648 發(fā)表于 2018-8-19 06:54 | 顯示全部樓層 |閱讀模式
這個(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)先級(jí)為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)



評(píng)分

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

查看全部評(píng)分

回復(fù)

使用道具 舉報(bào)

ID:520034 發(fā)表于 2019-4-23 22:24 | 顯示全部樓層
謝謝分享
回復(fù)

使用道具 舉報(bào)

ID:716037 發(fā)表于 2020-3-27 17:28 | 顯示全部樓層
謝謝樓主!請(qǐng)問有電路原理圖嗎?
回復(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ù) 返回頂部 返回列表
主站蜘蛛池模板: 超碰97免费观看 | 一级特黄在线 | 欧美精品二区 | 九九热在线免费观看 | 精品伊人久久 | 青久草视频 | 亚洲欧美日韩精品久久亚洲区 | 亚洲 欧美 日韩在线 | 国产精品18毛片一区二区 | 视频一区二区在线观看 | www久久av| 一级电影免费看 | 亚洲国产成人在线观看 | av中文字幕在线播放 | 欧美黄色网 | aaa大片免费观看 | 久久久久久久久淑女av国产精品 | 精品久久久久久久久久久久久久久久久 | 99久久免费精品国产免费高清 | 精品欧美一区免费观看α√ | 日本精品一区二区三区在线观看视频 | 日本网站免费在线观看 | 国产精品久久九九 | 日产精品久久久一区二区福利 | 久久亚洲一区 | 日本网站免费观看 | 综合自拍 | 91精品久久久久久久久99蜜臂 | 亚洲一区二区三区四区五区午夜 | 一级在线免费观看 | 99精品在线免费观看 | 国产91 在线播放 | 亚洲精品欧美 | 久久青视频 | 亚洲精品一区二区三区蜜桃久 | 国产欧美性成人精品午夜 | 请别相信他免费喜剧电影在线观看 | 日日操夜夜干 | 国产精品九九九 | 欧美精品中文字幕久久二区 | 在线观看第一区 |