亚洲春色中文字幕久久久-三上亚,91精品国产亚一区二区三区,久久久九色综合亚洲成色777,涩涩视频下载,国产午夜亚洲精品午夜鲁丝片,国产精品A一区二区三区腾讯导航,影音先锋色情AV在线看片,蜜臀国产在线视频,极品少妇高潮啪啪无码吴梦梦 ,精品人妻无码一区二区三区手机版

標(biāo)題: STM32F103系列PID尋線小車源程序 [打印本頁]
作者: GUYRVBNN    時(shí)間: 2018-10-22 19:43
標(biāo)題: STM32F103系列PID尋線小車源程序
    使用STM32F1系列芯片，尋仙模塊采用光電對(duì)管，使用PID算法調(diào)節(jié)占空比，輸出不同的PWM波，差速尋線

單片機(jī)源程序如下:
  1. # include "stm32f10x.h"
  2. # include "public.h"

  4. volatile uint32_t time = 0; // ms 計(jì)時(shí)變量
  5. int Shut = 3 ; //停車判斷
  6. int k = 30000 ;
  7. int Ultrasonic_Sing = 1 ;
  8. int main(void)
  9.    {
  10.          Period = 1600 ; //給定占空比，調(diào)節(jié)初始速度
  11.    trackingCarInitialization() ; //初始化函數(shù)
  12.          PID_Set(&PID_Tracking_The_Car,45,280,10);//PID參數(shù)設(shè)置
  13.          Ultrasonic_Star() ; //超聲波啟動(dòng)
  14.          while(k--)
  15.          {
  16.                         Motor_PID_Control() ;
  17.          }
  18.          k = 30000 ;
  19.           while(1)
  20.          {   
  21.                   if(time>=300)     /*********超聲波定時(shí)測(cè)距  300*(1ms)=0.3s  ***********/
  22.                   {
  23.                           Ultrasonic_Length=Hcsr04GetLength();
  24.                           time = 0 ;
  25.                   }
  26.                    Motor_PID_Control() ;  // PID調(diào)節(jié)控制小車轉(zhuǎn)速
  27.                          if(ShutDown<2)
  28.                          {
  29.                                  Shut-- ;
  30.                                  if(Shut==0)
  31.                                  {
  32.                                           goto ShutDown_The_Car ;
  33.                                  }
  34.                                  while(k--)
  35.                                  {
  36.                                           Motor_PID_Control() ;
  37.                                  }
  38.                          }
  39.                          k=30000;
  40.                          
  41.                          Trans_Isand_Runing() ;//環(huán)島
  42.                          gotoAquare_Bent() ; //過直角彎道
  43.           }
  44.          ShutDown_The_Car:               
  45.                           TIM_SetCompare2(TIMx,0);//左側(cè)控制
  46.                           TIM_SetCompare1(TIMx,0);//右側(cè)控制               
  47.                     return 0;
  48. }

  50.                        
復(fù)制代碼

所有資料51hei提供下載:
Tracking The Car.rar (286.56 KB, 下載次數(shù): 129)


作者: 八月醉    時(shí)間: 2019-3-22 20:24
十分有幫助，最近正在做尋跡車，感謝分享！
作者: qcwy16    時(shí)間: 2019-6-5 13:51
學(xué)習(xí)一下，挺好的，感謝分享



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