標(biāo)題: 用STM32mini版做的避障小車源程序 [打印本頁]
作者: jetty-9    時(shí)間: 2018-11-19 15:47
標(biāo)題: 用STM32mini版做的避障小車源程序
用stm32mini版做的避障小車，這是根據(jù)原子哥的歷程改的，狀態(tài)機(jī)部分只需要稍微修改一下即可使用。PA0接Echo，PA1接tring。論壇新手請(qǐng)多多指教。

單片機(jī)源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "timer.h"
  5. #include "usart.h"
  6. #include "ceju.h"
  7. #include "pwm.h"

  9. //接線說明echo-PA0；trig-PA1；vcc接5v
  10. //TM3使超聲波每隔一秒發(fā)送，TM2輸入捕獲。

  12. float Distance;
  13. extern u8  TIM2CH1_CAPTURE_STA;                //輸入捕獲狀態(tài)                                                   
  14. extern u16        TIM2CH1_CAPTURE_VAL;        //輸入捕獲值
  15. int main(void)
  16. {       
  17.          
  18.         u32 temp=0;
  19.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);// 設(shè)置中斷優(yōu)先級(jí)分組2
  20.         TIM3_PWM_Init(799,0);
  21.         delay_init();                     //延時(shí)函數(shù)初始化       
  22.         uart_init(9600);                                 //9600         
  23.         LED_Init();                          //初始化與LED連接的硬件接口
  24.         TIM3_Int_Init(4999*2,7199);                //一秒發(fā)送一次。       
  25.         TIM2_Cap_Init(0XFFFF,7199);                //以10khz的頻率計(jì)數(shù)
  26.          ceju_Init();
  27.            while(1)
  28.         {         
  29.                
  30.                 if(TIM2CH1_CAPTURE_STA&0X80)//成功捕獲到了一次高電平
  31.                 {
  32.                         temp=TIM2CH1_CAPTURE_STA&0X3F;
  33.                         temp*=65536;                                        //溢出時(shí)間總和
  34.                         temp+=TIM2CH1_CAPTURE_VAL;                //得到總的高電平時(shí)間
  35.                         Distance=temp*5*34*2/200.0;
  36.                         printf("distance:%f cm\r\n",Distance);
  37.                         if(Distance<10)
  38.                         {
  39.                                 LED0=!LED0;
  40.                                 TIM_SetCompare1(TIM3,0);
  41.                     TIM_SetCompare2(TIM3,0);
  42.                     TIM_SetCompare3(TIM3,799);
  43.                     TIM_SetCompare4(TIM3,0);
  44.                         }
  45.                                
  46.                         TIM2CH1_CAPTURE_STA=0;                        //開啟下一次捕獲
  47.                 }
  48.         }
  49. }
復(fù)制代碼
  1. #include "pwm.h"
  2. #include "sys.h"

  4. void TIM3_PWM_Init(u16 arr,u16 psc)
  5. {
  6.         GPIO_InitTypeDef GPIO_InitStruct;//GPIOC初始化結(jié)構(gòu)體
  7.         TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStruct;//定時(shí)器3初始化結(jié)構(gòu)體
  8.         TIM_OCInitTypeDef TIM_OCInitStruct;
  9.        
  10.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE);//使能定時(shí)器3時(shí)鐘
  11.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);//使能GPIOC時(shí)鐘
  12.        
  13.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);//使能重映射AFIO時(shí)鐘
  14.        
  15.         GPIO_PinRemapConfig(GPIO_FullRemap_TIM3,ENABLE);//開啟重映射
  16.        
  17.         GPIO_InitStruct.GPIO_Mode=GPIO_Mode_AF_PP;
  18.         GPIO_InitStruct.GPIO_Pin=GPIO_Pin_6;
  19.         GPIO_InitStruct.GPIO_Speed=GPIO_Speed_50MHz;
  20.         GPIO_Init(GPIOC,&GPIO_InitStruct);//GPIOC6初始化，設(shè)置為復(fù)用功能輸出
  21.        
  22.         GPIO_InitStruct.GPIO_Mode=GPIO_Mode_AF_PP;
  23.         GPIO_InitStruct.GPIO_Pin=GPIO_Pin_7;
  24.         GPIO_InitStruct.GPIO_Speed=GPIO_Speed_50MHz;
  25.         GPIO_Init(GPIOC,&GPIO_InitStruct);//GPIOC7初始化，設(shè)置為復(fù)用功能輸出
  26.        
  27.         GPIO_InitStruct.GPIO_Mode=GPIO_Mode_AF_PP;
  28.         GPIO_InitStruct.GPIO_Pin=GPIO_Pin_8;
  29.         GPIO_InitStruct.GPIO_Speed=GPIO_Speed_50MHz;
  30.         GPIO_Init(GPIOC,&GPIO_InitStruct);//GPIOC8初始化，設(shè)置為復(fù)用功能輸出
  31.         GPIO_InitStruct.GPIO_Mode=GPIO_Mode_AF_PP;
  32.         GPIO_InitStruct.GPIO_Pin=GPIO_Pin_9;
  33.         GPIO_InitStruct.GPIO_Speed=GPIO_Speed_50MHz;
  34.         GPIO_Init(GPIOC,&GPIO_InitStruct);//GPIOC9初始化，設(shè)置為復(fù)用功能輸出
  35.        
  36.         TIM_TimeBaseInitStruct.TIM_ClockDivision=TIM_CKD_DIV1;
  37.         TIM_TimeBaseInitStruct.TIM_CounterMode=TIM_CounterMode_Up;
  38.         TIM_TimeBaseInitStruct.TIM_Period=arr;//自動(dòng)重裝載值
  39.         TIM_TimeBaseInitStruct.TIM_Prescaler=psc;//預(yù)分頻系數(shù)
  40.         //TIM_TimeBaseInitStruct.TIM_RepetitionCounter=
  41.         TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStruct);//定時(shí)器初始化函數(shù)
  42.        
  43.         //TIM_OCInitStruct.TIM_OCIdleState
  44.         TIM_OCInitStruct.TIM_OCMode=TIM_OCMode_PWM2;//PWM設(shè)為模式2，比較值比arr大的時(shí)候是有效電平，即下面設(shè)置的高電平
  45.         //TIM_OCInitStruct.TIM_OCNIdleState
  46.         //TIM_OCInitStruct.TIM_OCNPolarity
  47.         TIM_OCInitStruct.TIM_OCPolarity=TIM_OCPolarity_High;//有效極性輸出為高
  48.         //TIM_OCInitStruct.TIM_OutputNState
  49.         TIM_OCInitStruct.TIM_OutputState=TIM_OutputState_Enable;//enable
  50.         //TIM_OCInitStruct.TIM_Pulse
  51.         TIM_OC3Init(TIM3,&TIM_OCInitStruct);//
  52.        
  53.         //TIM_OCInitStruct.TIM_OCIdleState
  54.         TIM_OCInitStruct.TIM_OCMode=TIM_OCMode_PWM2;//PWM設(shè)為模式2，比較值比arr大的時(shí)候是有效電平，即下面設(shè)置的高電平
  55.         //TIM_OCInitStruct.TIM_OCNIdleState
  56.         //TIM_OCInitStruct.TIM_OCNPolarity
  57.         TIM_OCInitStruct.TIM_OCPolarity=TIM_OCPolarity_High;//有效極性輸出為高
  58.         //TIM_OCInitStruct.TIM_OutputNState
  59.         TIM_OCInitStruct.TIM_OutputState=TIM_OutputState_Enable;//enable
  60.         //TIM_OCInitStruct.TIM_Pulse
  61.         TIM_OC1Init(TIM3,&TIM_OCInitStruct);//
  62.        
  63.         //TIM_OCInitStruct.TIM_OCIdleState
  64.         TIM_OCInitStruct.TIM_OCMode=TIM_OCMode_PWM2;//PWM設(shè)為模式2，比較值比arr大的時(shí)候是有效電平，即下面設(shè)置的高電平
  65.         //TIM_OCInitStruct.TIM_OCNIdleState
  66.         //TIM_OCInitStruct.TIM_OCNPolarity
  67.         TIM_OCInitStruct.TIM_OCPolarity=TIM_OCPolarity_High;//有效極性輸出為高
  68.         //TIM_OCInitStruct.TIM_OutputNState
  69.         TIM_OCInitStruct.TIM_OutputState=TIM_OutputState_Enable;//enable
  70.         //TIM_OCInitStruct.TIM_Pulse
  71.         TIM_OC2Init(TIM3,&TIM_OCInitStruct);//
  72.        
  73.         //TIM_OCInitStruct.TIM_OCIdleState
  74.         TIM_OCInitStruct.TIM_OCMode=TIM_OCMode_PWM2;//PWM設(shè)為模式2，比較值比arr大的時(shí)候是有效電平，即下面設(shè)置的高電平
  75.         //TIM_OCInitStruct.TIM_OCNIdleState
  76.         //TIM_OCInitStruct.TIM_OCNPolarity
  77.         TIM_OCInitStruct.TIM_OCPolarity=TIM_OCPolarity_High;//有效極性輸出為高
  78.         //TIM_OCInitStruct.TIM_OutputNState
  79.         TIM_OCInitStruct.TIM_OutputState=TIM_OutputState_Enable;//enable
  80.         //TIM_OCInitStruct.TIM_Pulse
  81.         TIM_OC4Init(TIM3,&TIM_OCInitStruct);//
  82.        
  83.         TIM_OC1PreloadConfig(TIM3,TIM_OCPreload_Enable);//1
  84.         TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable);//2
  85.         TIM_OC3PreloadConfig(TIM3,TIM_OCPreload_Enable);//定時(shí)器3使能預(yù)裝載值
  86.         TIM_OC4PreloadConfig(TIM3,TIM_OCPreload_Enable);//4
  87.        
  88.         TIM_Cmd(TIM3,ENABLE);//使能定時(shí)器
  89.        
  90.        
  91. }

復(fù)制代碼


所有資料51hei提供下載:
小車避障.rar (296.56 KB, 下載次數(shù): 59)


作者: rwdxgg    時(shí)間: 2019-5-12 17:16
很不錯(cuò)的帖子
作者: altium154    時(shí)間: 2019-5-12 20:30
非常感謝樓主
作者: CerGiant_vice    時(shí)間: 2019-5-26 21:06
就只有測(cè)距的程序？？



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