程序設(shè)計(jì):從SPI配置到斷鏈保護(hù))
簡介這是一份面向嵌入式與物聯(lián)網(wǎng)初學(xué)者的NRF24L01無線小車控制收發(fā)程序旨在解決遙控小車短距離無線指令傳輸與運(yùn)動控制問題。程序基于2.4GHz GFSK調(diào)制方式實(shí)現(xiàn)了數(shù)據(jù)發(fā)送、接收、CRC校驗(yàn)與自動重傳適合有基礎(chǔ)單片機(jī)知識、希望快速掌握無線通信編程的讀者參考。資源壓縮包僅7KB共兩個C語言源文件分別對應(yīng)遙控端與小車主控端核心邏輯遙控端負(fù)責(zé)指令編碼與無線發(fā)射小車端負(fù)責(zé)數(shù)據(jù)解碼并驅(qū)動電機(jī)完成前進(jìn)、后退、轉(zhuǎn)向等動作兩個文件結(jié)構(gòu)清晰可對照學(xué)習(xí)該芯片的初始化、收發(fā)流程、地址配置及中斷處理。目前已有240人學(xué)習(xí)下載通過閱讀代碼讀者可完整理解無線小車的通信鏈路并可在現(xiàn)有框架上擴(kuò)展避障傳感器、多車通信等功能是輕量且實(shí)用的入門樣例。1. 一塊射頻模塊引發(fā)的連鎖反應(yīng)NRF24L01小車控制收發(fā)程序到底在解決什么做小車遙控的方式有很多藍(lán)牙、WiFi、紅外都有各自的短板。NRF24L01作為2.4GHz射頻模塊走SPI接口幾塊錢一片空曠場地實(shí)測三十米起步穿一堵墻也還能穩(wěn)定收發(fā)恰好卡在“比紅外遠(yuǎn)得多、比藍(lán)牙抗干擾、比WiFi省電”的中間位置。它不依賴操作系統(tǒng)裸機(jī)一個定時器加SPI就能跑通所以成了課程設(shè)計(jì)、智能車競賽和大創(chuàng)項(xiàng)目里最常見的一套遙控方案。這套“NRF24L01小車控制收發(fā)程序”拆開看是三件事發(fā)射端把搖桿操作編碼成數(shù)據(jù)包發(fā)送接收端把數(shù)據(jù)包解析成電機(jī)驅(qū)動信號中間靠NRF24L01的射頻鏈路連接。說原理不復(fù)雜但真正動手時你會發(fā)現(xiàn)地址沒配對、CRC參數(shù)不一致、電源紋波干擾、數(shù)據(jù)包沒校驗(yàn)任何一個環(huán)節(jié)出錯都讓小車要么一動不動要么失控亂跑。這篇文章按發(fā)射端、接收端、排錯三層展開最后給出斷鏈保護(hù)和雙向回傳的進(jìn)階寫法適合正在調(diào)車但卡在通信環(huán)節(jié)的人參考。2. 硬件連接與射頻參數(shù)選型先讓模塊在面包板上活起來實(shí)際項(xiàng)目里很少有人直接買成品遙控套件更多是從線上渠道買模塊和車底盤自己搭。NRF24L01一共8個引腳真正用的只有7個VCC、GND、CE、CSN、SCK、MOSI、MISO外加一個IRQ中斷引腳。它只需要一根SPI總線所以無論接哪家MCU邏輯都一樣區(qū)別只在線序和引腳編號的宏定義。2.1 接線注意事項(xiàng)與電源分配為什么模塊總是發(fā)燙或者毫無反應(yīng)第一原則是分供。模塊的VCC接3.3V電機(jī)驅(qū)動單獨(dú)接電池電源絕對不能共用。NRF24L01的引腳不能承受5V如果MCU是5V供電MOSI、SCK、CE這些線必須串電阻分壓或用轉(zhuǎn)換板否則模塊會有概率燒毀最典型的表現(xiàn)是上電后芯片表面發(fā)燙通信完全無響應(yīng)。第二原則是防跌落電池電壓直接進(jìn)模塊而負(fù)載變化大時電壓掉到3V以下模塊就會復(fù)位這在電機(jī)啟動的瞬間尤其常見。我一般這樣接線MCU的SPI1對應(yīng)一組引腳CE、CSN、IRQ各占一個普通GPIO。模塊VCC接3.3V輸出GND和電機(jī)驅(qū)動共地但供電回路分開電機(jī)兩端并聯(lián)一個1000μF電解電容吸收沖擊電流。另外NRF24L01的IRQ引腳默認(rèn)高發(fā)生中斷事件時拉低所以要配置成下拉輸入或外部中斷下降沿觸發(fā)。// 引腳映射的宏定義以某主流MCU的標(biāo)準(zhǔn)庫風(fēng)格為例 #define NRF_CE_PORT GPIOA #define NRF_CE_PIN GPIO_PIN_3 #define NRF_CSN_PORT GPIOA #define NRF_CSN_PIN GPIO_PIN_4 #define NRF_IRQ_PORT GPIOA #define NRF_IRQ_PIN GPIO_PIN_2 // SPI1 已初始化為 8 位數(shù)據(jù)、主機(jī)模式、時鐘極性相位均為模式0這段代碼只做了引腳映射真正的配置在SPI初始化里完成。CE是片選使能拉高時模塊進(jìn)入收發(fā)狀態(tài)拉低時進(jìn)入待機(jī)CSN是SPI片選每次讀寫寄存器前拉低訪問完成后拉高IRQ是中斷標(biāo)志輸出引腳拉低表示有數(shù)據(jù)可讀或發(fā)送完成。輪詢和中斷兩種方式都可以后面章節(jié)會展開。提示NRF24L01的VCC對紋波敏感模塊附近建議至少放一個100μF和一個0.1μF的電容組合兩種電容分別濾低頻和高頻噪聲比單純加大電池容量更有效。2.2 射頻參數(shù)配對地址、頻道與數(shù)據(jù)率的寄存器設(shè)置接收端和發(fā)射端之間能通信的前提是五個要素一致收發(fā)地址、射頻頻道、數(shù)據(jù)率、CRC位數(shù)、地址寬度。NRF24L01默認(rèn)上電后工作在一個比較保守的狀態(tài)改任何寄存器都要在關(guān)掉CE后進(jìn)行改完再拉高CE生效。最容易忽略的是自動應(yīng)答收發(fā)雙方如果只有一方使能了自動應(yīng)答另一方不回應(yīng)鏈路就會一直重發(fā)直到超時表現(xiàn)為主機(jī)發(fā)數(shù)據(jù)很快但小車完全沒有動作。void rf_init(uint8_t is_rx) { uint8_t addr[5] {0xE7, 0xE7, 0xE7, 0xE7, 0xE7}; NRF_CSN_PORT-BRR NRF_CSN_PIN; // 拉低CSN進(jìn)入配置態(tài) spi_write_reg(EN_AA, 0x00); // 關(guān)閉自動應(yīng)答控制指令用連續(xù)發(fā)送替代 spi_write_reg(SETUP_RETR, 0x00); // 關(guān)閉自動重發(fā)避免舊指令堆積 spi_write_reg(SETUP_AW, 0x03); // 地址寬度5字節(jié)收發(fā)雙方必須一致 spi_write_reg(RF_CH, 40); // 射頻頻道40對應(yīng)2440MHz spi_write_reg(RF_SETUP, 0x06); // 1Mbps數(shù)據(jù)率16位CRC spi_write_buf(TX_ADDR, addr, 5); // 發(fā)送地址 spi_write_buf(RX_ADDR_P0, addr, 5); // 接收地址與發(fā)送地址一致 spi_write_reg(EN_RXADDR, 0x01); // 使能數(shù)據(jù)管道0 if (is_rx) { spi_write_reg(CONFIG, 0x0F); // 上電PRX接收模式 NRF_CE_PORT-BSRR NRF_CE_PIN; } else { spi_write_reg(CONFIG, 0x0E); // 上電PTX發(fā)送模式 } }這里有幾個參數(shù)值得細(xì)說。EN_AA關(guān)閉自動應(yīng)答是很多現(xiàn)成例程不會做的事但它對控制類應(yīng)用非常關(guān)鍵遙控指令講究“以最新為準(zhǔn)”而不是“每條必達(dá)”如果開著自動重發(fā)遙控器持續(xù)按住前進(jìn)時重發(fā)隊(duì)列里會有大量相同的歷史指令接收端處理不過來反而產(chǎn)生滯后。RF_CH決定工作頻道多套系統(tǒng)同場時錯開頻道是最直接的抗干擾手段。RF_SETUP的0x06表示1Mbps加16位CRC如果一方寫成2Mbps或8位CRC兩邊就握不上手。數(shù)據(jù)率理論距離抗干擾性適用場景250Kbps最遠(yuǎn)最弱低速率遙測穿透性強(qiáng)1Mbps中等中等小車控制首選平衡性好2Mbps最近最強(qiáng)高速率大數(shù)據(jù)距離要求低模塊選型上PCB天線和SMA外置天線版本實(shí)際差不少。PCB天線在室內(nèi)隔一堵墻還能用到了操場這種開闊地信號衰減得厲害SMA外置天線配一根3dBi的膠棒天線實(shí)測距離能翻一倍以上。如果你做的小車要跑戶外建議直接上外置天線版本多花不到幾塊錢但鏈路余量大很多。天線的方向也有講究天線盡量垂直于地面擺放別橫著貼在底盤上金屬底盤會吃掉一大截增益。市面上很多兼容模塊的上電時序和原版有細(xì)微差別上電后要等一段時間才能進(jìn)入穩(wěn)定工作狀態(tài)我習(xí)慣在上電初始化后加一個10ms的延時再開始收發(fā)。如果初始化后偶爾能通、有時又不通可以先懷疑模塊的晶振起振時間不夠而不是程序?qū)戝e了。2.3 用IRQ中斷還是輪詢兩種接收方式的取舍接收端有兩種取數(shù)據(jù)的方式。輪詢是主循環(huán)里反復(fù)讀STATUS寄存器代碼簡單但對時序不敏感容易把CPU撞死在SPI讀寫上而且主循環(huán)一忙就會漏幀。IRQ中斷則讓模塊在數(shù)據(jù)到達(dá)時主動通知MCU主循環(huán)只管解析和執(zhí)行這是工程上更順手的方案。注意用IRQ必須配置外部中斷并且在中斷服務(wù)程序里清標(biāo)志如果只用輪詢那IRQ引腳懸空不接也沒事。輪詢方式也有它的優(yōu)勢占用引腳少沒有中斷嵌套的風(fēng)險(xiǎn)在資源緊張的小板子上更穩(wěn)。缺點(diǎn)是主循環(huán)必須足夠快如果主循環(huán)里有一兩個耗時操作比如驅(qū)動OLED刷新或者解碼編碼器丟數(shù)據(jù)的概率就會上升。IRQ中斷方式要求ISR盡量短但實(shí)時性好能保證每幀數(shù)據(jù)都在到達(dá)后立刻被取走。兩種方式在室內(nèi)距離下差別不大到了信號弱需要重試的場景IRQ的優(yōu)勢就體現(xiàn)出來了。后面接收端章節(jié)用的就是IRQ中斷方案。3. 發(fā)射端程序搖桿數(shù)據(jù)打包與任務(wù)式發(fā)送發(fā)射端的核心不是把SPI配置好而是想清楚什么時刻發(fā)什么。很多人的第一版程序把發(fā)送函數(shù)放在按鍵掃描里按下就發(fā)一次結(jié)果按鍵抖動、操作過快、天線抖動都會導(dǎo)致小車反應(yīng)斷斷續(xù)續(xù)。正確思路是“定時器節(jié)拍驅(qū)動發(fā)送”每10ms讀一次搖桿無論狀態(tài)有沒有變化都照發(fā)不誤接收端只認(rèn)最新一幀。3.1 搖桿采集與指令映射三字節(jié)數(shù)據(jù)包的設(shè)計(jì)與編碼數(shù)據(jù)包的設(shè)計(jì)直接影響后續(xù)的可靠性校驗(yàn)。我用的包長是3字節(jié)幀頭、數(shù)據(jù)、校驗(yàn)各司其職。幀頭固定為0xAA用來接收端對齊數(shù)據(jù)字節(jié)區(qū)分方向與速度方向高4位、速度低4位校驗(yàn)字節(jié)用方向和速度的異或值防止射頻傳輸過程中單比特翻轉(zhuǎn)。這樣設(shè)計(jì)的好處是接收端解析簡單一條if語句就能完成校驗(yàn)處理一幀的時間在微秒級不會拖慢電機(jī)控制的PWM更新。typedef struct { uint8_t frame_header; // 固定0xAA uint8_t dir_speed; // 高4位方向低4位速度 uint8_t checksum; // 異或校驗(yàn)值 } ctrl_packet_t; #define DIR_STOP 0x00 #define DIR_FORWARD 0x01 #define DIR_BACK 0x02 #define DIR_LEFT 0x03 #define DIR_RIGHT 0x04 uint8_t map_joy_to_dir(int16_t x, int16_t y) { // 搖桿原始值范圍 -512~512先做死區(qū)處理 if (abs(y) 30 abs(x) 30) return DIR_STOP; if (abs(y) abs(x)) { return (y 0) ? DIR_FORWARD : DIR_BACK; } return (x 0) ? DIR_RIGHT : DIR_LEFT; }死區(qū)處理是搖桿方案里最容易被跳過的一步。搖桿回中后讀數(shù)通常不是正好0而是有幾十的漂移如果不處理小車會自己緩慢前進(jìn)或者轉(zhuǎn)向。死區(qū)范圍的標(biāo)定方式很簡單串口打印搖桿回中時的ADC值觀察一兩分鐘取最大偏移量的兩倍作為死區(qū)我這邊常見搖桿模塊回中值在±15以內(nèi)所以取30比較安全。方向判斷用絕對值比較而不是先判斷X后判斷Y這樣斜向推動時能正確識別意圖不會出現(xiàn)推左上搖桿但結(jié)果隨機(jī)走向的問題。方向編碼說明停止0x00搖桿回中或按下急停前進(jìn)0x01搖桿Y軸正向超過死區(qū)后退0x02搖桿Y軸負(fù)向超過死區(qū)左轉(zhuǎn)0x03搖桿X軸負(fù)向且|X||Y|右轉(zhuǎn)0x04搖桿X軸正向且|X||Y|3.2 雙搖桿模式油門與轉(zhuǎn)向獨(dú)立調(diào)節(jié)如果車底盤是差速結(jié)構(gòu)單搖桿的方向判斷沒法滿足“邊加速邊轉(zhuǎn)彎”的操作手感我一般會上雙搖桿。左搖桿負(fù)責(zé)油門和方向右搖桿或者板載撥輪負(fù)責(zé)速度上限調(diào)節(jié)這樣數(shù)據(jù)包要加一個速度字段。常見做法是數(shù)據(jù)包擴(kuò)展成4字節(jié)幀頭、方向、速度、校驗(yàn)速度字段直接來自右搖桿的Y軸ADC值歸一到0~15用映射表轉(zhuǎn)成PWM檔位。這樣左手控制油門大小右手控制轉(zhuǎn)向比例操作邏輯和真車接近新手也容易上手。uint8_t map_speed_raw(uint16_t adc) { // 假設(shè)ADC 12位0~4095對應(yīng)油門最小~最大 if (adc 300) return 0; return (uint8_t)((adc - 300) * 16 / (4095 - 300)); }油門映射這里有個線性度問題。電機(jī)在低占空比下輸出力矩很小PWM從10%升到20%轉(zhuǎn)速可能只加了一點(diǎn)點(diǎn)但從50%升到60%會突然竄出去。所以map_speed_raw返回的是檔位而不是直接占空比檔位到占空比的映射單獨(dú)放一張表。每個底盤的性格不一樣這張表才是真正需要實(shí)車調(diào)的部分同一個表換一輛車就要重新標(biāo)定。3.3 發(fā)送流程與任務(wù)節(jié)拍定時器觸發(fā)、連續(xù)發(fā)送、不等待ACK發(fā)送流程最忌諱的就是每次都等待模塊回應(yīng)。NRF24L01的發(fā)送完成標(biāo)志位需要讀取狀態(tài)寄存器才能清除處理起來繁瑣又容易卡死。常見做法是把發(fā)送函數(shù)放到定時器中斷里用狀態(tài)機(jī)保證同一時刻只有一個發(fā)送任務(wù)在跑。每10ms觸發(fā)一次讀取搖桿、組包、寫FIFO、拉高CE發(fā)送函數(shù)直接返回不管有沒有發(fā)成功下一輪節(jié)拍自然會發(fā)送最新狀態(tài)。uint8_t rf_send_ctrl(uint8_t dir, uint8_t speed) { ctrl_packet_t pkt; pkt.frame_header 0xAA; pkt.dir_speed (dir 4) | (speed 0x0F); pkt.checksum pkt.dir_speed ^ 0xAA; NRF_CSN_PORT-BRR NRF_CSN_PIN; // 拉低CSN準(zhǔn)備寫FIFO spi_write_byte(0xE0); // 寫TX_PAYLOAD指令 spi_write_byte(pkt.frame_header); spi_write_byte(pkt.dir_speed); spi_write_byte(pkt.checksum); NRF_CSN_PORT-BSRR NRF_CSN_PIN; // 拉高CSN結(jié)束寫操作 NRF_CE_PORT-BSRR NRF_CE_PIN; // 拉高CE觸發(fā)發(fā)送 delay_us(15); // 保持至少10微秒 NRF_CE_PORT-BRR NRF_CE_PIN; // 拉低CE回到待機(jī) return 1; }這里不讀發(fā)送完成標(biāo)志原因是NRF24L01發(fā)送后置位TX_DS標(biāo)志讀STATUS再清零的過程不是必須的寫入FIFO并拉高CE就完成了發(fā)送動作鏈路是否能到達(dá)由接收端通過幀頭判斷。15微秒的CE高電平來自數(shù)據(jù)手冊的推薦值太短可能不觸發(fā)發(fā)送太長會占用過多時間窗口在信號差的環(huán)境可以放寬到20微秒。定時器節(jié)拍我習(xí)慣做成10ms這個值比搖桿的物理響應(yīng)快很多又不會讓SPI總線忙不過來。4. 接收端程序數(shù)據(jù)解析與電機(jī)控制的無縫銜接接收端的難點(diǎn)不是讀數(shù)據(jù)而是別讓通信邏輯阻塞了電機(jī)控制。小車底盤上MCU的任務(wù)其實(shí)很重處理射頻中斷、解析數(shù)據(jù)、更新PWM、讀取編碼器任何一個環(huán)節(jié)卡頓都會讓輪子響應(yīng)變慢。所以接收端程序要把射頻接收放到IRQ中斷里中斷里只做“拷貝數(shù)據(jù)打標(biāo)記”主循環(huán)里再解析和執(zhí)行。4.1 IRQ中斷接收與數(shù)據(jù)校驗(yàn)狀態(tài)標(biāo)志位的正確用法NRF24L01的IRQ引腳在三種情況下會拉低收到數(shù)據(jù)、發(fā)送完成、達(dá)到最大重發(fā)次數(shù)。我們關(guān)閉了自動重發(fā)所以對于接收端來說IRQ拉低基本等價(jià)于收到了新數(shù)據(jù)。中斷服務(wù)程序里讀取STATUS寄存器判斷RX_DR位是否為1然后從RX FIFO讀取載荷并清標(biāo)志。注意必須先讀STATUS再讀FIFO順序反了會讀到舊數(shù)據(jù)或丟失當(dāng)前幀。void EXTI_IRQHandler(void) { uint8_t status spi_read_reg(STATUS); uint8_t fifo[4]; if (status 0x40) { // RX_DR置位數(shù)據(jù)到達(dá) NRF_CSN_PORT-BRR NRF_CSN_PIN; // 拉低CSN開始讀FIFO spi_write_byte(0x61); // 讀RX_PAYLOAD指令 spi_read_bytes(fifo, 3); // 讀出3字節(jié)載荷 NRF_CSN_PORT-BSRR NRF_CSN_PIN; // 中斷里只賦值不解析把決策留給主循環(huán) g_rx_valid 1; g_rx_dir (fifo[1] 4) 0x0F; g_rx_speed fifo[1] 0x0F; g_rx_checksum fifo[2]; spi_write_reg(STATUS, 0x40); // 寫1清RX_DR標(biāo)志IRQ引腳恢復(fù)高 } }中斷服務(wù)程序里只做賦值和標(biāo)志位置1這是嵌入式開發(fā)的基本紀(jì)律。如果在中斷里調(diào)用解析函數(shù)、字符串處理或者延時一旦射頻干擾導(dǎo)致中斷頻繁主循環(huán)就會被餓死小車表現(xiàn)為轉(zhuǎn)向反應(yīng)慢或者PWM輸出抖動。另外讀取RX_PAYLOAD后FIFO中的數(shù)據(jù)會自動彈出不用額外FLUSH_RX命令但STATUS標(biāo)志必須用寫1的方式清除如果漏掉IRQ引腳一直保持低電平之后的中斷全部失效這也是常見的“只通一次就再也不通”的根源之一。4.2 主循環(huán)中的解析校驗(yàn)與超時防護(hù)主循環(huán)里檢查g_rx_valid后第一件事是校驗(yàn)。校驗(yàn)公式為checksum與(dir ^ 0xAA)的異或比較符合就執(zhí)行不符合就丟棄這一幀等待下一輪。由于發(fā)射端每10ms發(fā)一幀丟一幀的代價(jià)極小不需要任何重傳機(jī)制。接收方還要維護(hù)一個鏈路健康計(jì)時器每次合法幀清零主循環(huán)用200ms和1s兩個閾值區(qū)分“臨時丟幀”和“鏈路斷開”。void main_loop(void) { if (g_rx_valid) { g_rx_valid 0; if ((g_rx_dir ^ 0xAA) g_rx_checksum) { link_timeout 0; // 合法幀重置超時計(jì)數(shù) motor_control(g_rx_dir, g_rx_speed); } // 校驗(yàn)失敗直接忽略等待下一幀不做重傳 } if (link_timeout 200) { // 200個10ms節(jié)拍2秒無合法幀 motor_control(DIR_STOP, 0); // 斷鏈急停防止小車跑遠(yuǎn) } }這里把校驗(yàn)失敗和鏈路斷開分成兩個層次處理是很實(shí)用的工程習(xí)慣。校驗(yàn)失敗說明射頻鏈路還在通只是這幀壞了下一幀大概率就是好的不用管鏈路斷開說明發(fā)射端真的不在服務(wù)區(qū)必須執(zhí)行安全動作。如果你把這兩種情況都當(dāng)作故障處理小車會頻繁抖動因?yàn)槭覂?nèi)環(huán)境下偶爾丟一幀是常態(tài)。斷鏈保護(hù)的具體時間閾值取決于場地大小后面進(jìn)階章會再講。4.3 PWM與電機(jī)驅(qū)動的聯(lián)動輸出讓小車轉(zhuǎn)向像開真車電機(jī)驅(qū)動芯片的選擇會直接影響控制精度。常見的L298N和TB6612都能驅(qū)動直流電機(jī)但L298N是達(dá)林頓管方案管壓降大、發(fā)熱厲害PWM頻率高了還會嘯叫。TB6612是MOSFET方案體積小效率高最大驅(qū)動電流1.2A單節(jié)鋰電池供電的小車完全夠用。如果車底盤用空心杯電機(jī)電流更小用DRV8833這種超低壓降芯片效果更好。我最近做的小車都換成了TB6612省下的壓降就是電池續(xù)航。參數(shù)L298NTB6612驅(qū)動方式達(dá)林頓管MOSFET管壓降約2V約0.5V最大電流2A(峰值)1.2A(峰值)PWM響應(yīng)一般易發(fā)熱快效率高體積大小PWM定時器設(shè)置上我習(xí)慣用20kHz的PWM頻率高于人耳可聽范圍電機(jī)不會有嘯叫。設(shè)置方法就是把定時器重載值設(shè)為時鐘頻率除以20000再減一比較值從0到重載值。電機(jī)方向由驅(qū)動芯片的IN1、IN2電平?jīng)Q定使能端接PWM。轉(zhuǎn)向邏輯上直行時左右輪要校準(zhǔn)不能直接給同樣占空比因?yàn)閮蓚?cè)機(jī)械阻力總有差異。void motor_control(uint8_t dir, uint8_t speed) { uint16_t pwm_val speed_table[speed]; // 查表得到基礎(chǔ)占空比 switch (dir) { case DIR_FORWARD: // 左輪減10%做力度偏置保持直行具體值以實(shí)車為準(zhǔn) set_motor_left(1, pwm_val - pwm_val / 10); set_motor_right(1, pwm_val); break; case DIR_LEFT: set_motor_left(1, pwm_val / 2); set_motor_right(1, pwm_val); break; case DIR_RIGHT: set_motor_left(1, pwm_val); set_motor_right(1, pwm_val / 2); break; case DIR_STOP: default: set_motor_left(0, 0); set_motor_right(0, 0); break; } }這里有一個新手常犯的錯直行模式下左右PWM設(shè)成一樣的值結(jié)果小車跑歪。原因是兩個電機(jī)的空載轉(zhuǎn)速和摩擦力存在差異必須做力度偏置。左輪減10%是我這邊的經(jīng)驗(yàn)起點(diǎn)如果校準(zhǔn)后發(fā)現(xiàn)還是偏右就改成右輪減10%這個值在實(shí)車調(diào)試時用卷尺和直線跑道反復(fù)試出來。差速轉(zhuǎn)向的PWM比例1/2是經(jīng)驗(yàn)起點(diǎn)如果底盤的電機(jī)扭矩不足過彎會直接卡死需要把比例調(diào)到2/3甚至3/4。轉(zhuǎn)向和直行的校準(zhǔn)是兩個獨(dú)立變量別混在一起調(diào)。5. 通信鏈路避坑指南從收不到數(shù)據(jù)到偶發(fā)抖動的5個常見問題配套例程能跑通和實(shí)際場地穩(wěn)定是兩回事。以下每條都是真實(shí)調(diào)車時遇到并排查過的按出現(xiàn)頻率從高到低排列現(xiàn)象、根因、解決三件套。排錯前先確認(rèn)模塊的供電回路和天線連接這類物理問題比寄存器問題更常出現(xiàn)別一上來就改代碼?,F(xiàn)象優(yōu)先檢查快速驗(yàn)證方法完全無通信地址、頻道自檢代碼循環(huán)打印電機(jī)啟動就死機(jī)電源紋波示波器看電壓跌落距離短SPI速率降分頻系數(shù)搖桿抖動死區(qū)串口打印原始值多車干擾頻道錯開RF_CH5.1 現(xiàn)象一完全無通信SPI寄存器讀寫正常但小車沒反應(yīng)SPI能正常讀寫寄存器說明MCU和模塊之間的鏈路是好的問題出在射頻鏈路。最常見的原因是收發(fā)雙方的地址或頻道不一致比如發(fā)射端用0xE7地址接收端用0xE7E7開頭但少了字節(jié)或者一個RF_CH是40一個是25。SPI讀寫正常會掩蓋這個坑因?yàn)槟隳茏x到模塊返回的狀態(tài)但兩邊射頻根本沒有建鏈。解決寫一段自檢代碼發(fā)射端每隔100ms發(fā)0x55接收端把收到的字節(jié)通過串口打印如果打印全是亂碼或長時間沒輸出就逐項(xiàng)核對地址、頻道、數(shù)據(jù)率、CRC位數(shù)這個方法比拿著萬用表量引腳高效得多。5.2 現(xiàn)象二電機(jī)一啟動接收端就死機(jī)或模塊無響應(yīng)這是電源問題而不是程序問題。電機(jī)啟動瞬間電流可能到1A以上如果MCU、模塊、電機(jī)共享一個電池又沒有濾波電容電壓會被拉到模塊最低工作電壓以下模塊復(fù)位后SPI狀態(tài)丟失程序卡在讀狀態(tài)循環(huán)里。解決電池正負(fù)極之間并聯(lián)1000μF電解電容電機(jī)驅(qū)動電源線單獨(dú)走模塊VCC從穩(wěn)壓輸出取。還有一個便宜好用的技巧給電機(jī)驅(qū)動板電源腳串一個低壓差二極管把電機(jī)側(cè)的電源紋波隔離在穩(wěn)壓器之前。沒有示波器時可以用萬用表峰值保持檔量模塊VCC如果啟動瞬間跌落超過0.3V基本可以斷定是這一路的問題。5.3 現(xiàn)象三近在咫尺能通信隔一兩米就丟包原因是SPI速率太高或者數(shù)據(jù)率設(shè)置不匹配。NRF24L01的SPI時鐘建議不超過10MHz很多人圖省事照搬Flash讀取的18MHz配置讀寫時序不達(dá)標(biāo)模塊返回的數(shù)據(jù)都是錯的。RF_SETUP如果收發(fā)兩端不一致比如一端2Mbps一端1Mbps模塊會進(jìn)入接收失敗重試狀態(tài)。另外SPI的工作模式必須是模式0如果你復(fù)用SD卡初始化過的SPI模式3數(shù)據(jù)位會錯位這是“SPI能通但內(nèi)容錯”的隱蔽問題。解決SPI分頻系數(shù)改成8把SCK降到約2MHzRF_SETUP統(tǒng)一寫成0x06實(shí)測同場地距離從1米提升到20米以上。如果換了外置天線還不行檢查天線有沒有擰緊SMA座子松了一丁點(diǎn)都會讓駐波比激增距離驟降。5.4 現(xiàn)象四搖桿回中小車仍然有緩慢前進(jìn)或者轉(zhuǎn)向搖桿電位器回中后電壓偏移映射出來的方向值會漂。發(fā)射端如果只在狀態(tài)變化時發(fā)數(shù)據(jù)回中漂移的小幅變化也會被當(dāng)成有效指令發(fā)出去。解決發(fā)射端死區(qū)范圍至少覆蓋回中讀數(shù)的兩倍回中時直接發(fā)DIR_STOP而不是發(fā)當(dāng)前讀數(shù)讓停止變成一個明確指令而不是計(jì)算的結(jié)果。如果換了搖桿模塊死區(qū)要重新標(biāo)定一次同一個閾值對不同搖桿不通用這點(diǎn)經(jīng)常被忽略。硬件上可以在搖桿輸出和ADC輸入之間加一個RC低通濾波時間常數(shù)1ms左右軟件上再做一階低通new_val old * 0.8 raw * 0.2但對電位器老化的緩慢漂移沒用死區(qū)才是必須的那道防線濾波只是輔助。5.5 現(xiàn)象五兩輛小車用的是同款模塊互相干擾默認(rèn)頻道40是每套例程都一樣的多套系統(tǒng)同場就撞車了。解決給每對收發(fā)模塊分配不同RF_CH比如10、40、80錯開。接收端和發(fā)射端的頻道在代碼里用宏定義統(tǒng)一管理改一次編譯燒錄兩邊。如果頻道錯開還不夠把地址也改掉頻道和地址雙維度區(qū)隔才是完整的抗干擾方案。另外注意板子附近的其他2.4GHz設(shè)備比如無線鼠標(biāo)接收器或藍(lán)牙音箱如果恰好插在小車旁邊也會引起偶發(fā)丟包這類干擾源比較隱蔽排查起來容易漏。6. 進(jìn)階玩法斷鏈保護(hù)、雙向回傳與多車協(xié)同的落地技巧收發(fā)通路已經(jīng)通了小車能跟著搖桿跑了。但工程化一點(diǎn)看還需要考慮三個場景遙控器沒電或者人走遠(yuǎn)了小車該停下來而不是撞墻想實(shí)時看電池電壓但不想拉一根線多臺小車同場怎么各自獨(dú)立控制。這三個問題分別在斷鏈保護(hù)、雙向回傳、多車協(xié)同三個維度解決。6.1 斷鏈保護(hù)利用通信超時讓小車自動剎車最樸素的方案是初始化一個定時器每收到合法數(shù)據(jù)幀就重置計(jì)數(shù)值主循環(huán)里檢查計(jì)數(shù)值是否超過300ms。超時就把電機(jī)輸出清零和開機(jī)時狀態(tài)保持一致。這個方案的優(yōu)點(diǎn)是純軟件不用改硬件但一定要把“第一次上電默認(rèn)鎖死”狀態(tài)和“斷鏈進(jìn)入停止”狀態(tài)區(qū)分開否則接收端開機(jī)時小車先動彈一下再停下體驗(yàn)很差。void safety_task(void) { g_link_timeout; if (g_link_timeout 30) { // 30個10ms節(jié)拍 300ms無數(shù)據(jù) motor_control(DIR_STOP, 0); g_link_led_off(); } }g_link_timeout在合法幀校驗(yàn)通過后清零。300ms這個數(shù)值是根據(jù)人手最快操作周期定的低于200ms會在正常通信時誤觸發(fā)高于500ms斷鏈后小車會滑出一段距離具體值看你場地大小。還有一點(diǎn)斷鏈后重新收到第一幀數(shù)據(jù)時不要立刻恢復(fù)最新速度先以小油門值恢復(fù)等連續(xù)兩幀合法再放開速度限制避免恢復(fù)瞬間車速突變導(dǎo)致側(cè)翻。注意斷鏈后重新恢復(fù)通信時先以中低油門運(yùn)行一幀再放開速度上限車速突變是翻車的主要誘因。6.2 雙向回傳讓遙控端顯示電池電壓和里程N(yùn)RF24L01的收發(fā)模式切換很快發(fā)射端可以在發(fā)完控制幀的間隙監(jiān)聽一小段窗口。以遙控器為主機(jī)它發(fā)完控制幀后不立即進(jìn)入發(fā)送模式而是切到接收模式窗口50ms小車接收端收到控制幀后把自己的電池電壓和編碼器里程打包發(fā)回。這樣一來一回遙控器上就能顯示底盤電壓跑幾圈下來還能看到里程數(shù)。切換模式時要注意順序先把CE拉低修改CONFIG寄存器配置對應(yīng)的TX/RX地址再拉高CE每一步都要隔幾個微秒不能急著連續(xù)寫寄存器否則PLL鎖定時間不夠切換后前幾幀會丟。6.3 多車協(xié)同頻道分組與頻點(diǎn)規(guī)劃的最小方案三四輛車用RF_CH分組就夠了。每輛車分配一個獨(dú)立頻道遙控器按鍵切換頻道配合一個小OLED顯示當(dāng)前頻點(diǎn)。頻道切換時注意先關(guān)閉CE、修改RF_CH、再拉高CE連續(xù)切換時增加100ms的穩(wěn)定延遲否則射頻PLL鎖定時間不夠會出現(xiàn)切完頻道后短暫失聯(lián)。如果以后車數(shù)量上到十臺以上頻道就不夠分了那時得換用地址分組加跳頻的方案屬于另一套復(fù)雜度。這套程序做到“能控制”和“穩(wěn)定控制”之間的距離基本都落在細(xì)節(jié)上。我第一次把接收端從輪詢改成IRQ中斷時因?yàn)橥浨錝TATUS標(biāo)志導(dǎo)致中斷只觸發(fā)一次車跑出去三米才停后來在中斷入口打印所有標(biāo)志位才定位到問題。調(diào)試射頻鏈路時建議先打印后校驗(yàn)把所有標(biāo)志位全部暴露出來再談優(yōu)化希望這套思路幫到你。本文還有配套的精品資源點(diǎn)擊獲取