找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 15710|回復: 1
打印 上一主題 下一主題
收起左側(cè)

STM32二輪循跡小車程序+實驗操作步驟

  [復制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:622335 發(fā)表于 2019-11-15 10:30 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
此教程針對二輪循跡小車,使用的芯片為STM32F103C8T6
  • 安裝keil5,具體的安裝方式見文件夾 “keil5安裝/” 里《如何安裝KEIL5(包含安裝芯片包).pdf》,需要用到的安裝包(Keil_uVision_MDK522.EXE)
安裝好Keil5之后需要使用的破解工具(Keil注冊機)
需要擴展的庫文件(ARM.CMSIS.3.20.4.pack  Keil.STM32F1xx_DFP.2.1.0.pack)
都已經(jīng)在文件夾內(nèi)(官網(wǎng)下載庫文件賊慢)
  • 安裝好KEIL5之后,打開軟件
啟動界面
選擇菜單欄 Project –> Open Project
在我的這個文件夾里找到 “HELT” 的文件夾,按圖中所示路徑找到后綴為.uvprojx 的文件打開即可
  •         打開工程之后直接 重新編譯
顯示沒有錯誤
  • 接著連接 J-LINK 下載器,USB端連接電腦,另一端連接小車
先打開小車電源(即小車上面的幾個紅燈是亮的),接著在Keil5中點擊下載按鈕,燒錄程序到小車芯片上
燒錄結(jié)果,如圖則證明燒錄成功!
  • 拔下下載器,開始調(diào)節(jié)小車紅外感應(yīng)模塊的靈敏度(重要!)。
調(diào)節(jié)之前,溫習一下紅外感應(yīng)循跡原理,網(wǎng)上貼圖(懶呀,哈哈)
對于靈敏度的調(diào)節(jié),遵循的原則是:
把你要調(diào)節(jié)的紅外感應(yīng)模塊水平對準一條黑線,調(diào)節(jié)紅外感應(yīng)模塊對應(yīng)的電位器,使得你正在調(diào)節(jié)的紅外模塊的指示燈剛好由亮變滅時停止調(diào)節(jié)。

因為有三個紅外感應(yīng)模塊,所以,依次把你想要調(diào)節(jié)的那個紅外感應(yīng)模塊對準黑線而另外兩個不要對準黑線,反復調(diào)節(jié),使得對準黑線的模塊燈滅而另外兩個沒有檢測到黑線的紅外模塊的燈亮,則證明調(diào)節(jié)完成哈。
(測試的環(huán)境選擇明亮的場所,黑線可以用超市里買的電工膠布即可)
圖 調(diào)節(jié)靈敏度
  • 調(diào)節(jié)完畢,在如下軌道上進行測試,注意在貼軌道時既要有左轉(zhuǎn)彎還要有右轉(zhuǎn)彎,而且要有T字路口(這實驗要求真的狗啊,
  • 可能遇到的一個問題:在T字路口不能右轉(zhuǎn),車很可能會停下來。
解釋一下:因為咱們的小車循跡原則是,如果左邊的紅外感應(yīng)到有黑線,或者左邊和中間的紅外模塊同時感應(yīng)到黑線,那么那就會稍稍左轉(zhuǎn)(保證軌道盡量處于中間),即左輪停止而右輪前轉(zhuǎn)。同理,如果是右邊的紅外模塊感應(yīng)到黑線或者右邊和中間的紅外感應(yīng)模塊同時感應(yīng)到黑線,則小車稍稍右轉(zhuǎn),即右輪停止而左輪前轉(zhuǎn)。如果是只有中間的紅外感應(yīng)模塊感應(yīng)到黑線,那么小車直走,即兩個輪子都前轉(zhuǎn)。而當三個紅外模塊都沒有檢測到黑線,則小車轉(zhuǎn)圈。如果同時三個檢測到黑線,則小車停止,這個條件是為了模擬終點全是一大坨黑塊而設(shè)計的,但是在T字路口可能出現(xiàn)誤判。
針對此問題,我們暫時想到的解決辦法是:把兩側(cè)的紅外感應(yīng)模塊往兩邊移動,中間的保持不動,使得三個感應(yīng)模塊不在同一條水平線上時,可避免誤判的可能(這個不用擔心在終點三個紅外模塊不能同時檢測到給黑線的情況,因為終點設(shè)計有很大一塊黑塊,所以完全會使三個紅外模塊同時檢測到黑線而使得小車停止)
同學們也可以依靠上述的原理來驗證小車的轉(zhuǎn)向是否正確,讓一個紅外模塊對準黑線,觀察輪子轉(zhuǎn)向是否正確,如果反轉(zhuǎn),可以嘗試對調(diào)電機的正負極,則可以讓他正轉(zhuǎn)。


單片機源程序如下:
  1. #include "stm32f10x.h"

  2. struct motor
  3. {
  4.   enum {STOP, FORWARD, BACKWARD} state;
  5.   int forward_opcode;
  6.   int backward_opcode;
  7. };

  8. static struct motor left_motor, right_motor;

  9. void MotorInit()
  10. {
  11.   RCC->APB2ENR |= 1 << 3;
  12.   GPIOB->CRH &= 0xff0000ff;
  13.   GPIOB->CRH |= 0x00333300; //PB10        左后退 , PB11        左前進, PB12        右前進, PB13  右后退
  14.   GPIOB->BSRR = ((1 << 10) | (1 << 11) | (1 << 12) | (1 << 13)) << 16;
  15.         
  16.   left_motor.state = STOP;
  17.   left_motor.forward_opcode = 1 << 11;
  18.   left_motor.backward_opcode = 1 << 10;

  19.   right_motor.state = STOP;
  20.   right_motor.forward_opcode = 1 << 12;
  21.   right_motor.backward_opcode = 1 << 13;        
  22. }

  23. //對某電機施加前轉(zhuǎn)驅(qū)動電平
  24. static void MotorRotateForward(struct motor *pmotor)
  25. {
  26.         if (pmotor->state != FORWARD)
  27.         {
  28.           GPIOB->BSRR = (pmotor->backward_opcode << 16) | pmotor->forward_opcode;
  29.           pmotor->state = FORWARD;
  30.         }
  31. }

  32. //對某電機施加后轉(zhuǎn)驅(qū)動電平
  33. static void MotorRotateBackward(struct motor *pmotor)
  34. {
  35.         if(pmotor->state != BACKWARD)
  36.         {
  37.           GPIOB->BSRR = (pmotor->forward_opcode << 16) | pmotor->backward_opcode;
  38.           pmotor->state = BACKWARD;
  39.         }
  40. }

  41. //對某電機停止驅(qū)動電平
  42. static void MotorStop(struct motor *pmotor)
  43. {
  44.         if (pmotor->state != STOP)
  45.         {
  46.           GPIOB->BSRR = (pmotor->forward_opcode | pmotor->backward_opcode) << 16;
  47.           pmotor->state = STOP;
  48.         }
  49. }

  50. //電機控制函數(shù)
  51. //輸入?yún)?shù):電機標識字符'r'或’l'(右或左)   操作代碼字符'f'、'b'或's'(正轉(zhuǎn)、反轉(zhuǎn)或靜止)
  52. void MotorControl(char motor, char op_cmd)
  53. {
  54.   struct motor *pmotor;
  55.   
  56.   if (motor == 'r')
  57.     pmotor = &right_motor;
  58.   else if (motor == 'l')
  59.     pmotor = &left_motor;
  60.   else
  61.     return;
  62.   if (op_cmd == 'f')
  63.     MotorRotateForward(pmotor);
  64.   if (op_cmd == 'b')
  65.     MotorRotateBackward(pmotor);
  66.   if (op_cmd == 's')
  67.     MotorStop(pmotor);
  68. }
復制代碼

所有資料51hei提供下載:
二輪循跡小車.7z (6.25 MB, 下載次數(shù): 215)


評分

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

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏7 分享淘帖 頂3 踩
回復

使用道具 舉報

沙發(fā)
ID:660220 發(fā)表于 2019-12-10 08:46 | 只看該作者
很有用
回復

使用道具 舉報

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

本版積分規(guī)則

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

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

快速回復 返回頂部 返回列表