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

QQ登錄

只需一步，快速開(kāi)始

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

STM32雙路避障小車制作 附源程序仿真電路圖

  [復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:644357 發(fā)表于 2020-11-17 20:21 | 只看該作者 |只看大圖 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
材料清單：
    1供電：12V航模電池，12V~5V轉(zhuǎn)電壓模塊，開(kāi)關(guān)*1
    2控制：STM32C8T6最小系統(tǒng)板，紅外避障模塊*2
    3驅(qū)動(dòng)：L298N驅(qū)動(dòng)模塊*2
    4對(duì)象：電機(jī)*4的小車
注：紅色部分不可缺。


放實(shí)物圖
   

線路連接圖

  

仿真原理圖如下（proteus仿真工程文件可到本帖附件中下載）


（避障模塊沒(méi)有放進(jìn)去因?yàn)槭堑碗娖接|發(fā)，兩個(gè)避障模塊接B0,B1口）


STM32單片機(jī)源程序文件:
  1. #include "ALLhander.h"

  3. int main(void)
  4. {        

  6.          
  7.          
  8.     LED_Config();
  9.           Motor_enable_Init();
  10.           Motor_PWM_control_GPIO_Config();
  11.       Tim3_mode_Config(T_Period,T_PSC,200);
  12.           Total_NVIC_interrupt_config();
  13.          
  14.           Obstacle_avoidance();

  16.    while(1)
  17.          {
  18. //                 
  19.                    straight();
  20.                  
  21.        Systick_Delay_ms(1000);
  22.       }
  23. }
復(fù)制代碼
L298N配置文件
  1. #include "L298N_GPIO.h"
  2. #include "systick.h"


  5. void LED_Config(void)
  6. {
  7.         GPIO_InitTypeDef  GPIO_InitStruct;
  8.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);
  9.         
  10.         //LED指示燈
  11.         GPIO_InitStruct.GPIO_Pin = GPIO_Pin_13;                                 
  12.         GPIO_InitStruct.GPIO_Mode = GPIO_Mode_Out_PP;                  
  13.         GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
  14.         
  15.         GPIO_Init(GPIOC, &GPIO_InitStruct);                                                  
  16. }


  19. void Front_Motor_enzble_control(void)
  20. {
  21.         GPIO_InitTypeDef  GPIO_InitStructure;
  22.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);
  23.         GPIO_InitStructure.GPIO_Pin = Motor1_cw_Pin|Motor1_ccw_Pin|Motor2_cw_Pin|Motor2_ccw_Pin;
  24.         GPIO_InitStructure.GPIO_Mode =GPIO_Mode_Out_PP;
  25.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  26.         GPIO_Init(GPIOA,&GPIO_InitStructure);
  27. }
  28. void Back_Motor_enzble_control(void)
  29. {
  30.         GPIO_InitTypeDef  GPIO_InitStructure;
  31.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
  32.         GPIO_InitStructure.GPIO_Pin = Motor3_cw_Pin|Motor3_ccw_Pin|Motor4_cw_Pin|Motor4_ccw_Pin;
  33.         GPIO_InitStructure.GPIO_Mode =GPIO_Mode_Out_PP;
  34.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  35.         GPIO_Init(GPIOB,&GPIO_InitStructure);
  36. }

  38. void Motor_enable_Init(void)
  39. {
  40.         Front_Motor_enzble_control();
  41.         Back_Motor_enzble_control();
  42. }

  44. void Motor_PWM_control_GPIO_Config(void)
  45. {
  46.         GPIO_InitTypeDef  GPIO_InitStructure;
  47.         
  48.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);
  49.         //RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);
  50.         //GPIO_PinRemapConfig(GPIO_PartialRemap_TIM3, ENABLE);
  51.         
  52.         GPIO_InitStructure.GPIO_Pin = Speed_control_Pin;
  53.         GPIO_InitStructure.GPIO_Mode =GPIO_Mode_AF_PP;
  54.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  55.         
  56.         GPIO_Init(Speed_control_Port,&GPIO_InitStructure);
  57. }

  59. void Tim3_mode_Config(uint16_t period,uint16_t Prescaler,uint16_t Pulse)
  60. {
  61.                   TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  62.            TIM_OCInitTypeDef TIM_OCInitStructure;
  63.          
  64.          
  65.          //開(kāi)啟定時(shí)器3的時(shí)鐘
  66.          RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE);
  67.          
  68.          //TIM3重映射
  69.          GPIO_PinRemapConfig(GPIO_PartialRemap_TIM3, ENABLE);
  70.          
  71.          // 自動(dòng)重裝載寄存器的值，累計(jì)TIM_Period+1個(gè)頻率后產(chǎn)生一個(gè)更新或者中斷
  72.         TIM_TimeBaseStructure.TIM_Period = period;        
  73.          
  74.         // 驅(qū)動(dòng)CNT計(jì)數(shù)器的時(shí)鐘 = Fck_int/(psc+1)
  75.         TIM_TimeBaseStructure.TIM_Prescaler = Prescaler;
  76.          
  77.          //時(shí)鐘分割
  78.         TIM_TimeBaseStructure.TIM_ClockDivision = 0;  
  79.          
  80. //        // 時(shí)鐘分頻因子 ，配置死區(qū)時(shí)間時(shí)需要用到
  81. //        TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;               

  83.         // 計(jì)數(shù)器計(jì)數(shù)模式，設(shè)置為向上計(jì)數(shù)
  84.         TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up;               
  85.         // 重復(fù)計(jì)數(shù)器的值，沒(méi)用到不用管
  86.         //TIM_TimeBaseStructure.TIM_RepetitionCounter=0;        
  87.         
  88.         // 初始化定時(shí)器
  89.         TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);

  91.          
  92.          
  93.         // 配置為PWM模式1
  94.         TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
  95.         
  96.         // 輸出使能
  97.         TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  98.         // 互補(bǔ)輸出使能
  99.         //TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;
  100.         
  101.         
  102.         // 設(shè)置脈沖寬度 CRR的值，0-65535
  103.         TIM_OCInitStructure.TIM_Pulse = Pulse;
  104.         
  105.         // 輸出通道電平極性配置
  106.         TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
  107.         // 互補(bǔ)輸出通道電平極性配置
  108.         //TIM_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_High;
  109.         
  110.         // 輸出通道空閑電平極性配置
  111.         //TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
  112.         // 互補(bǔ)輸出通道空閑電平極性配置
  113.         //TIM_OCInitStructure.TIM_OCNIdleState = TIM_OCNIdleState_Reset;
  114.         
  115. //  TIM_OC1Init(TIM3, &TIM_OCInitStructure);        
  116. //        TIM_OC1PreloadConfig(TIM2, TIM_OCPreload_Enable);


  119.         TIM_OC1Init(TIM3, &TIM_OCInitStructure);
  120.         TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable);
  121. //        TIM_OC3Init(TIM2, &TIM_OCInitStructure);
  122. //        TIM_OC3PreloadConfig(TIM2, TIM_OCPreload_Enable);
  123. //        TIM_OC4Init(TIM2, &TIM_OCInitStructure);
  124. //        TIM_OC4PreloadConfig(TIM2, TIM_OCPreload_Enable);
  125.         
  126.         TIM_Cmd(TIM3, ENABLE);        
  127.         // 主輸出使能，當(dāng)使用的是通用定時(shí)器時(shí)，這句不需要
  128.         //TIM_CtrlPWMOutputs(ADVANCE_TIM, ENABLE);
  129. }

  131. //電機(jī)1
  132. void Motor1_CW(void)   
  133. {
  134.      GPIO_ResetBits(GPIOA,Motor1_ccw_Pin);
  135.      GPIO_SetBits(GPIOA,Motor1_cw_Pin);
  136. }
  137. void Motor1_CCW(void)  
  138. {
  139.      GPIO_ResetBits(GPIOA,Motor1_cw_Pin);
  140.      GPIO_SetBits(GPIOA,Motor1_ccw_Pin);
  141. }
  142. //電機(jī)2
  143. void Motor2_CW(void)   
  144. {
  145.      GPIO_ResetBits(GPIOA,Motor2_ccw_Pin);
  146.      GPIO_SetBits(GPIOA,Motor2_cw_Pin);
  147. }
  148. void Motor2_CCW(void)  
  149. {
  150.      GPIO_ResetBits(GPIOA,Motor2_cw_Pin);
  151.      GPIO_SetBits(GPIOA,Motor2_ccw_Pin);
  152. }
  153. //電機(jī)3
  154. void Motor3_CW(void)   
  155. {
  156.      GPIO_ResetBits(GPIOB,Motor3_ccw_Pin);
  157.      GPIO_SetBits(GPIOB,Motor3_cw_Pin);
  158. }
  159. void Motor3_CCW(void)  
  160. {
  161.      GPIO_ResetBits(GPIOB,Motor3_cw_Pin);
  162.      GPIO_SetBits(GPIOB,Motor3_ccw_Pin);
  163. }
  164. //電機(jī)4
  165. void Motor4_CW(void)   
  166. {
  167.      GPIO_ResetBits(GPIOB,Motor4_ccw_Pin);
  168.      GPIO_SetBits(GPIOB,Motor4_cw_Pin);
  169. }
  170. void Motor4_CCW(void)  
  171. {
  172.      GPIO_ResetBits(GPIOB,Motor4_cw_Pin);
  173.      GPIO_SetBits(GPIOB,Motor4_ccw_Pin);
  174. }


  177. void straight(void)
  178. {
  179.   
  180.   Motor1_CW();
  181.   Motor2_CW();
  182.   Motor3_CW();
  183.   Motor4_CW();
  184. }
  185. void Turn_left(void)
  186. {
  187.         
  188.         Motor1_CCW();
  189.         Motor2_CW();
  190.         Motor3_CCW();
  191.         Motor4_CW();
  192.         
  193. }
  194. void Turn_left_move(void)
  195. {
  196.         
  197.         Motor1_CCW();
  198.         Motor2_CW();
  199.         Motor3_CW();
  200.         Motor4_CCW();
  201.         
  202. }
  203. void Turn_right(void)
  204. {
  205.         
  206.         Motor1_CW();
  207.         Motor2_CCW();
  208.         Motor3_CW();
  209.         Motor4_CCW();
  210.         
  211. }
  212. void Turn_right_move(void)
  213. {
  214.         
  215.         Motor1_CW();
  216.         Motor2_CCW();
  217.         Motor3_CCW();
  218.         Motor4_CW();
  219.         
  220. }
  221. void Back(void)
  222. {
  223.         
  224.         Motor1_CCW();
  225.         Motor2_CCW();
  226.         Motor3_CCW();
  227.         Motor4_CCW();
  228. }
  229. void Stop_motor1(void)
  230. {
  231.     GPIO_ResetBits(GPIOA,Motor1_cw_Pin);
  232.         GPIO_ResetBits(GPIOA,Motor1_ccw_Pin);
  233. }
  234. void Stop_motor2(void)
  235. {
  236.     GPIO_ResetBits(GPIOA,Motor2_cw_Pin);
  237.         GPIO_ResetBits(GPIOA,Motor2_ccw_Pin);
  238. }
  239. void Stop_motor3(void)
  240. {
  241.     GPIO_ResetBits(GPIOB,Motor3_cw_Pin);
  242.         GPIO_ResetBits(GPIOB,Motor3_ccw_Pin);
  243.         Systick_Delay_ms(300);
  244. }
  245. void Stop_motor4(void)
  246. {
  247.     GPIO_ResetBits(GPIOB,Motor4_cw_Pin);
  248.         GPIO_ResetBits(GPIOB,Motor4_ccw_Pin);
  249. }
復(fù)制代碼
中斷服務(wù)函數(shù)
  1. void Left_spinner_IRQHandler(void)
  2. {
  3.         if(EXTI_GetITStatus(EXTI_Line1) !=RESET)
  4.         {
  5.         Back();
  6.         Systick_Delay_ms(300);
  7.         Turn_right();
  8.         Systick_Delay_ms(200);
  9.         straight();
  10.         EXTI_ClearITPendingBit(EXTI_Line1);
  11.         }

  13. }
  14. void right_spinner_IRQHandler(void)
  15. {
  16.         if(EXTI_GetITStatus(EXTI_Line0) !=RESET)
  17.         {
  18.         Back();
  19.         Systick_Delay_ms(300);
  20.         Turn_left();
  21.         Systick_Delay_ms(200);
  22.         straight();
  23.         EXTI_ClearITPendingBit(EXTI_Line0);
  24.         }
  25.         
  26. }
復(fù)制代碼
帖主的水平可能并沒(méi)有那么高，但是我愿與大家共同分享，一起進(jìn)步，歡迎吐槽打擾
下面包含所有文件：
基于STM32的雙路避障小車仿真圖源程序.7z (328.65 KB, 下載次數(shù): 151)

評(píng)分

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

查看全部評(píng)分

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

使用道具 舉報(bào)

沙發(fā)
ID:328014 發(fā)表于 2020-11-18 05:05 | 只看該作者
好資料，51黑有你更精彩!!!
回復(fù)

使用道具 舉報(bào)

板凳
ID:644292 發(fā)表于 2020-11-18 12:04 來(lái)自手機(jī) | 只看該作者
比賽用的？幾秒跑完？
回復(fù)

使用道具 舉報(bào)

地板
ID:644357 發(fā)表于 2020-11-18 14:57 來(lái)自手機(jī) | 只看該作者
51hei團(tuán)團(tuán) 發(fā)表于 2020-11-18 05:05
好資料，51黑有你更精彩!!!

謝謝管理員完善我的帖子
回復(fù)

使用道具 舉報(bào)

5#
ID:644357 發(fā)表于 2020-11-19 11:24 | 只看該作者
小制作 發(fā)表于 2020-11-18 12:04
比賽用的？幾秒跑完？

并不是比賽，自己做著玩的
回復(fù)

使用道具 舉報(bào)

6#
ID:846386 發(fā)表于 2020-11-22 11:36 | 只看該作者
繼續(xù)完善，加油干
回復(fù)

使用道具 舉報(bào)

7#
ID:644357 發(fā)表于 2020-11-24 10:18 來(lái)自手機(jī) | 只看該作者
kiccleaf 發(fā)表于 2020-11-22 11:36
繼續(xù)完善，加油干

后期會(huì)加入一個(gè)oled顯示屏，和一個(gè)4+  通道的pwm采集，用來(lái)捕獲天地飛的遙控信號(hào)，
回復(fù)

使用道具 舉報(bào)

8#
ID:945217 發(fā)表于 2021-6-26 18:18 | 只看該作者
能加上超聲波模塊避障嗎？
回復(fù)

使用道具 舉報(bào)

9#
ID:644357 發(fā)表于 2023-5-5 09:16 | 只看該作者
hrh123 發(fā)表于 2021-6-26 18:18
能加上超聲波模塊避障嗎？

這個(gè)沒(méi)法在仿真里加，水平有限
回復(fù)

使用道具 舉報(bào)

10#
ID:644357 發(fā)表于 2023-5-5 09:17 | 只看該作者
小制作 發(fā)表于 2020-11-18 12:04
比賽用的？幾秒跑完？

自己愛(ài)好搞得，沒(méi)錢只能仿真
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表