簡介這是一套面向智能小車與機(jī)器人視覺導(dǎo)航的OV7670攝像頭循跡工程源碼利用CMOS圖像傳感器采集環(huán)境圖像通過灰度化、二值化、邊緣檢測等預(yù)處理突出賽道邊界再結(jié)合PID控制算法調(diào)節(jié)電機(jī)轉(zhuǎn)速實(shí)現(xiàn)穩(wěn)定的路徑跟蹤。資源共204個(gè)文件以C語言源文件與頭文件為主包含STM32定時(shí)器、ADC、I2C、Flash等外設(shè)驅(qū)動(dòng)以及LCD顯示等模塊還附帶編譯生成的Hex、AXF燒錄文件、Keil工程配置和輔助批處理腳本壓縮包約4.91MB。目前已有3688人學(xué)習(xí)查看該工程特別記錄了將CameraBlackWhiteWarShip項(xiàng)目移植到紀(jì)偉最小系統(tǒng)版的過程涉及SPI/I2C通信參數(shù)調(diào)整、內(nèi)存優(yōu)化等細(xì)節(jié)有助于開發(fā)者理解不同硬件平臺(tái)間的適配思路。通過研讀完整源碼讀者可掌握攝像頭循跡從圖像采集、預(yù)處理、邊緣識(shí)別到運(yùn)動(dòng)控制的完整閉環(huán)并學(xué)習(xí)中斷處理、外設(shè)初始化與實(shí)時(shí)控制策略適合嵌入式視覺導(dǎo)航方向的開發(fā)者作為實(shí)戰(zhàn)參考。1. OV7670攝像頭循跡 程序源碼從花屏到穩(wěn)過環(huán)的完整鏈路OV7670攝像頭循跡最勸退人的地方不是你寫不好算法而是辛辛苦苦燒完程序屏幕上只有雪花、花屏、或者一整片灰。很多第一次做視覺循跡的開發(fā)者拿著現(xiàn)成源碼也跑不出圖像最后只能把車子丟在角落積灰。我早期做模擬項(xiàng)目X時(shí)也翻過這個(gè)車前后折騰了一個(gè)多星期才明白循跡不是“拍一張照再找線”而是一條完整的數(shù)據(jù)鏈路SCCB配置、像素時(shí)鐘采集、幀緩沖搬運(yùn)、二值化與質(zhì)量中心計(jì)算、PID差速輸出每一環(huán)節(jié)都必須同時(shí)正確。這篇筆記按“先跑通、再調(diào)穩(wěn)”的順序展開適合已經(jīng)有基本單片機(jī)基礎(chǔ)、想從紅外循跡升級(jí)到視覺循跡的開發(fā)者也適合準(zhǔn)備競賽底車但還沒理清時(shí)序的朋友。先別追求畫面多清晰把一幀數(shù)據(jù)穩(wěn)定拿到手后面一切才談得上。2. 硬件連接與SCCB配置先讓OV7670輸出一幀可用圖像很多程序跑不起來不是算法不行是硬件通道根本沒打通。OV7670模塊上有兩條通路一條是SCCB配置總線用來寫寄存器另一條是DVP數(shù)據(jù)通路用來輸出圖像。你燒錄源碼之前必須先把這兩條路的電氣連接和初始化順序理清楚。2.1 接線以外的三件事電源時(shí)序、引腳驅(qū)動(dòng)與DVP匹配先把最基礎(chǔ)的引腳映射列出來方便你對照手頭主控板核對攝像頭側(cè)主控側(cè)作用XCLK定時(shí)器復(fù)用輸出給攝像頭提供外部時(shí)鐘常見頻率為24MHzPCLKDVP像素時(shí)鐘輸入每次有效邊沿輸出一個(gè)像素VSYNCDVP VSYNC輸入幀同步信號(hào)一幀開始或結(jié)束的標(biāo)志HREFDVP HREF輸入行有效信號(hào)高電平期間輸出一行像素D0-D7DVP數(shù)據(jù)總線并行圖像數(shù)據(jù)8位SIO_CSCCB SCL配置時(shí)鐘SIO_DSCCB SDA配置數(shù)據(jù)接線最容易翻車的不是數(shù)據(jù)線而是 XCLK。我之前接過一個(gè)模塊XCLK浮空沒給時(shí)鐘SCCB怎么寫都像石沉大海因?yàn)閿z像頭內(nèi)部邏輯根本沒跑起來。正確的順序是先保證主控給 XCLK 一個(gè)穩(wěn)定的 24MHz 信號(hào)再操作 SCCB。另一個(gè)容易被忽略的點(diǎn)是 SIO_D 必須接上拉電阻模塊上雖然有上拉但個(gè)別開發(fā)板內(nèi)部上拉很弱最好外接 4.7k 到 3.3V。我一般會(huì)在硬件初始化里把引腳分成三組配置代碼骨架如下void ov7670_hw_init(void) { // 第1組XCLK 用定時(shí)器復(fù)用輸出產(chǎn)生 24MHz 時(shí)鐘 gpio_alt_config(XCLK_PIN, GPIO_AF_TIMER); timer_pwm_config(XCLK_TIMER, 24000000); // 第2組SCCB 的 SCL 和 SDA 配置為開漏輸出外部已有上拉 gpio_open_drain_config(SIO_C_PIN); gpio_open_drain_config(SIO_D_PIN); // 第3組DVP 數(shù)據(jù)與同步引腳全部設(shè)為輸入注意關(guān)閉內(nèi)部上拉 gpio_input_config(D0_D7_PINS); gpio_input_config(PCLK_PIN); gpio_input_config(VSYNC_PIN); gpio_input_config(HREF_PIN); }這段代碼本身不復(fù)雜但順序很重要。如果先初始化 DVP 數(shù)據(jù)腳再給 XCLK模塊上電瞬間可能輸出不穩(wěn)定電平導(dǎo)致主控引腳狀態(tài)混亂。我會(huì)把 XCLK 放在第一步確保攝像頭在任何 SCCB 操作之前就有時(shí)鐘源。還有一個(gè)細(xì)節(jié)D0-D7 這組引腳不要開內(nèi)部上拉數(shù)據(jù)線懸空時(shí)容易產(chǎn)生毛刺干擾 DMA 傳輸判斷。電源時(shí)序上OV7670 模塊通常 3.3V 供電上電后要等待幾十毫秒再寫 SCCB。有的源碼把軟復(fù)位放在寄存器配置最開始這沒問題但復(fù)位命令和正常配置之間要留足夠延時(shí)否則寄存器可能寫入失敗。你可以用邏輯分析儀測量 SCCB 的波形但更快的辦法是寫一個(gè)寄存器讀回函數(shù)寫進(jìn)去再讀出來對比確認(rèn)總線真的通了。2.2 SCCB寫寄存器代碼單字節(jié)配置背后的時(shí)序門檻SCCB 在單字節(jié)寫場景下和 I2C 很接近但它不是嚴(yán)格意義上的 I2C有些模塊不支持連續(xù)讀或者要求第 9 位回應(yīng)方式不同。為了避免玄學(xué)問題我建議你自己寫一個(gè)軟件 SCCB把時(shí)序握在手里排查起來也直觀。下面是一套最常見的軟件時(shí)序?qū)崿F(xiàn)static void sccb_start(void) { SDA_DIR_OUT(); SCL_LOW(); SDA_HIGH(); delay_us(2); SCL_HIGH(); delay_us(2); SDA_LOW(); // SDA 在 SCL 高電平期間拉低表示起始 delay_us(2); SCL_LOW(); } static void sccb_stop(void) { SDA_DIR_OUT(); SCL_LOW(); SDA_LOW(); delay_us(2); SCL_HIGH(); delay_us(2); SDA_HIGH(); // SCL 高電平期間 SDA 拉高表示停止 delay_us(2); } static uint8_t sccb_write_byte(uint8_t dat) { uint8_t i, ack; for (i 0; i 8; i) { SCL_LOW(); if (dat 0x80) SDA_HIGH(); else SDA_LOW(); delay_us(1); SCL_HIGH(); delay_us(1); dat 1; } // 第9個(gè)時(shí)鐘用于讀取從設(shè)備應(yīng)答 SCL_LOW(); SDA_DIR_IN(); SCL_HIGH(); delay_us(1); ack SDA_READ(); // 低電平表示應(yīng)答 SCL_LOW(); SDA_DIR_OUT(); return ack; }這段代碼的關(guān)鍵點(diǎn)是位序必須從最高位開始發(fā)OV7670 的寄存器地址和數(shù)據(jù)都是 8 位MSB first 是硬性要求。很多新手把 I2C 的習(xí)慣帶進(jìn)來先發(fā)低位結(jié)果寄存器地址完全錯(cuò)亂畫面輸出就別提了。另外SCCB 的應(yīng)答位在有些實(shí)現(xiàn)里不被檢查但這正是我建議保留的原因配置完某個(gè)關(guān)鍵寄存器后讀回或者至少在初始化后掃描一遍能快速排除總線問題。寫寄存器函數(shù)按地址加數(shù)據(jù)的格式組織uint8_t ov7670_write_reg(uint8_t reg_addr, uint8_t reg_val) { uint8_t err 0; sccb_start(); err | sccb_write_byte(0x42); // 器件地址寫方向 err | sccb_write_byte(reg_addr); err | sccb_write_byte(reg_val); sccb_stop(); return err; // 0 表示應(yīng)答正常 }器件地址 0x42 是常見寫法也就是 0x21 左移一位。不同廠商模塊可能有差異如果初始化時(shí)發(fā)現(xiàn)寄存器寫不進(jìn)去第一件事查模塊的器件地址而不是懷疑時(shí)序。返回值 err 里任何一位是 1都說明鏈路有異常不要繼續(xù)往下走。2.3 初始化參數(shù)表從RGB565到QQVGA的分辨率取舍配置寄存器沒有統(tǒng)一標(biāo)準(zhǔn)答案但常見初始化流程基本逃不出下面這幾個(gè)動(dòng)作軟復(fù)位、設(shè)置輸出格式、設(shè)置時(shí)鐘分頻、設(shè)置窗口、關(guān)閉或保留自動(dòng)增益。下面這張表是我做底車時(shí)固定下來的最小配置寄存器地址寫入值作用說明0x120x80軟復(fù)位0x120x00退出復(fù)位狀態(tài)0x110x03PCLK 分頻降低像素時(shí)鐘到可用范圍0x400x10RGB565 輸出格式0x170x13水平窗口起點(diǎn)用于設(shè)置可視區(qū)域0x180x01水平窗口大小的高位字節(jié)0x190x02垂直窗口起點(diǎn)0x1A0x7A垂直窗口大小這里要強(qiáng)調(diào)不要把別人代碼里的寄存器表當(dāng)成萬能靈藥不同分辨率下窗口寄存器組合差異很大。我一般會(huì)先把輸出固定在 160x120 的 QQVGA 尺寸上跑通再考慮往更高分辨率走。選 QQVGA 出于三個(gè)理由第一一幀只有 19200 個(gè)像素RGB565 下約 38KB普通主控內(nèi)部 RAM 能裝得下雙緩沖第二像素點(diǎn)少二值化和質(zhì)量中心計(jì)算能在幾毫秒內(nèi)完成第三攝像頭幀率受 PCLK 分頻影響分辨率越低單位像素時(shí)鐘越充裕畫面撕裂的概率越小。初始化代碼中寄存器寫入順序也有講究。建議先復(fù)位等穩(wěn)定再寫輸出格式最后改窗口。如果把格式和窗口混在一起寫有概率觸發(fā)內(nèi)部狀態(tài)機(jī)異常。你可以用一個(gè)循環(huán)把配置表跑一遍const uint8_t ov7670_init_table[][2] { {0x12, 0x80}, {0x12, 0x00}, {0x11, 0x03}, {0x40, 0x10}, {0x17, 0x13}, {0x18, 0x01}, {0x19, 0x02}, {0x1A, 0x7A}, }; void ov7670_init(void) { for (uint8_t i 0; i sizeof(ov7670_init_table) / 2; i) { ov7670_write_reg(ov7670_init_table[i][0], ov7670_init_table[i][1]); delay_ms(5); // 每個(gè)寄存器之間加延時(shí)避免寫入過快 } }注釋里那個(gè) 5ms 延時(shí)是我調(diào)試后加的習(xí)慣不是必須但能明顯減少寫入失敗率。等初始化全部完成再用一幀 VSYNC 信號(hào)確認(rèn)數(shù)據(jù)通路是否已經(jīng)活躍。此時(shí)如果你有調(diào)試手段可以直接讀 PCLK 引腳波形沒有示波器就靠代碼判斷配置完后延時(shí) 200ms再輪詢 VSYNC 引腳如果一直是死電平大概率是 XCLK 或 SCCB 配置有問題。3. 幀緩沖與行數(shù)據(jù)從VSYNC到一幀完整畫面的采集機(jī)制寄存器配置好了攝像頭開始輸出圖像但主控怎么知道哪一段數(shù)據(jù)是完整一幀這就要吃透 VSYNC、HREF、PCLK 三根線的關(guān)系。很多循跡源碼跑出殘影、半邊畫面都是因?yàn)閹鹗寂袛鄬戝e(cuò)了。3.1 數(shù)據(jù)流拆解PCLK、HREF、VSYNC各管哪一段一句話描述數(shù)據(jù)流VSYNC 告訴你一幀從哪里開始HREF 告訴你哪些時(shí)鐘周期屬于有效像素PCLK 負(fù)責(zé)一拍一像素地把數(shù)據(jù)吐出來。時(shí)序關(guān)系是這樣的VSYNC 有效沿到來后緊接著 HREF 會(huì)連續(xù)跳變每行有效期間 HREF 維持高電平同時(shí) PCLK 持續(xù)翻轉(zhuǎn)。在 HREF 為高時(shí)每個(gè) PCLK 上升沿對應(yīng)的 D0-D7 就是一個(gè)像素?cái)?shù)據(jù)。HREF 為低時(shí)輸出的數(shù)據(jù)要忽略掉那是行消隱區(qū)。我在采集代碼里不會(huì)單獨(dú)去數(shù) HREF 的脈沖數(shù)那樣太慢。常見做法是讓硬件 DVP 控制器自己處理行同步主控只關(guān)心幀開始信號(hào)volatile uint8_t frame_ready_flag 0; void vsync_isr(void) { // VSYNC 有效沿表示新的一幀開始 frame_ready_flag 1; // 立刻搬走上一幀的數(shù)據(jù)或者啟動(dòng)新一幀的DMA接收 dvp_dma_start((uint32_t)frame_buffer[work_index], 160 * 120); }這段代碼的核心思路是“用中斷標(biāo)記幀開始用 DMA 把像素搬進(jìn)內(nèi)存”。不要在中斷里做像素處理中斷服務(wù)函數(shù)越短越好。work_index 是一個(gè)在雙緩沖里切換的索引后面會(huì)講。很多新手在這里犯的錯(cuò)是在 while 循環(huán)里等待 VSYNC 拉高然后開始讀數(shù)據(jù)。這個(gè)做法在低分辨率下勉強(qiáng)能跑但一旦處理耗時(shí)超過一幀間隔就會(huì)漏幀或者重復(fù)處理同一幀。正確做法是讓 VSYNC 觸發(fā)中斷中斷里只改標(biāo)志位主循環(huán)消費(fèi)標(biāo)志位。3.2 用DMA搬運(yùn)圖像幀雙緩沖防撕裂的代碼寫法如果靠 CPU 一個(gè)一個(gè)像素去讀 DVP 數(shù)據(jù)寄存器160x120 一幀有 19200 個(gè)像素就算每個(gè)像素三條指令也是幾萬條指令主控直接卡死在采集上。用 DMA 是標(biāo)配做法。DMA 配置的關(guān)鍵參數(shù)有三個(gè)外設(shè)地址固定為 DVP 數(shù)據(jù)寄存器內(nèi)存地址是幀緩沖傳輸長度等于一幀像素?cái)?shù)。下面是一個(gè)典型配置骨架void dvp_dma_config(void) { dma_channel_t *ch dma_get_channel(DVP_DMA_CH); dma_reset(ch); dma_periph_addr(ch, (uint32_t)DVP_DATA_REG); dma_memory_addr(ch, (uint32_t)frame_buffer[0]); dma_transfer_count(ch, 160 * 120); // 一幀像素總量 dma_direction_periph_to_mem(ch); dma_memory_size_16bit(ch); // 如果配置為RGB565數(shù)據(jù)寬度16位 dma_enable_transfer_done_interrupt(ch); dma_enable(ch); }注意數(shù)據(jù)寬度。OV7670 在 RGB565 模式下一個(gè)像素是兩個(gè) 8 位數(shù)據(jù)所以 DMA 數(shù)據(jù)寬度配置成 16 位更合理。如果配成 8 位傳輸計(jì)數(shù)要換成 160 * 120 * 2否則只搬了半個(gè)像素。傳輸完成中斷里要切換緩沖區(qū)索引避免還在處理舊幀時(shí) DMA 把新數(shù)據(jù)覆蓋進(jìn)來void dma_isr(void) { // 當(dāng)前工作緩沖區(qū)已填完切換到另一塊 work_index ^ 1; frame_ready_flag 1; }只有一塊緩沖區(qū)時(shí)處理函數(shù)剛讀到一半DMA 又往同一塊內(nèi)存寫畫面就會(huì)出橫向撕裂條紋。雙緩沖就是為了解決這個(gè)沖突DMA 寫一塊CPU 讀另一塊讀完再交換。循跡要求實(shí)時(shí)性撕裂畫面會(huì)直接導(dǎo)致中線計(jì)算跳變車子左右擺。3.3 幀率預(yù)算為什么160x120比VGA更適合循跡有人會(huì)問OV7670 最高支持 VGA為什么不用更高分辨率道理很現(xiàn)實(shí)分辨率越高單幀數(shù)據(jù)量越大DMA 搬運(yùn)時(shí)間和主控處理時(shí)間都線性增長而循跡需要的只是“線在哪”這一個(gè)信息。算一筆賬160x120 灰度圖一幀 19200 字節(jié)24MHz PCLK 下純傳輸時(shí)間不到 1ms。主控跑圖像處理二值化和質(zhì)量中心計(jì)算大約 2~3ms主頻幾十 MHz 就夠。整幀周期可以控制在 10ms 以內(nèi)也就是幀率接近 100fps 的采集能力。換成 VGA 640x480單幀數(shù)據(jù)量是 16 倍不要說處理DMA 騰挪內(nèi)存都?jí)騿?。所以我的建議是做循跡初始化直接配到 160x120 或者更低別讓分辨率成為流暢度的瓶頸。你需要的是一條線的橫坐標(biāo)不是一張高清照片。圖像處理里常說的“降采樣”在循跡場景下不如直接從源頭鎖死分辨率。4. 循跡算法與控制輸出從像素中心線到電機(jī)差速圖像已經(jīng)穩(wěn)定進(jìn)內(nèi)存了接下來才輪到真正的循跡邏輯。整個(gè)控制鏈可以拆成三段從彩色像素到灰度、從灰度到二值線、從線位置到電機(jī)差速。本末別倒置代碼不用一次寫完但思路要清晰。4.1 灰度化與自適應(yīng)閾值背景亮度變了怎么辦OV7670 配置成 RGB565 后每個(gè)像素兩個(gè)字節(jié)分別是高字節(jié)和低字節(jié)。循跡不需要顏色信息只要亮度。最省算力的近似做法是直接取高字節(jié)當(dāng)灰度值雖然不精確但響應(yīng)快對找線完全夠用。static inline uint8_t pixel_gray(uint8_t high_byte, uint8_t low_byte) { (void)low_byte; return high_byte; }如果你要求高一點(diǎn)可以用加權(quán)公式但會(huì)引入乘法和額外指令。在 160x120 分辨率下全幀算下來差距不大就怕主控還要同時(shí)處理電機(jī)控制能省的地方盡量省。接下來是二值化。固定閾值最怕環(huán)境光變化上午能看清的黑線下午陽光一斜畫面亮度整體偏移固定閾值直接把線淹了。我一般會(huì)做一個(gè)簡單的自適應(yīng)閾值每幀先統(tǒng)計(jì)平均亮度再設(shè)置一個(gè)偏移量uint8_t compute_threshold(uint8_t *gray, uint16_t count, int8_t offset) { uint32_t sum 0; for (uint16_t i 0; i count; i) { sum gray[i]; } uint8_t avg (uint8_t)(sum / count); if (avg 80) avg 80; if (avg 200) avg 200; return avg offset; }avg 被限制在 80 到 200 之間是為了防止極端畫面下閾值飄到完全無效區(qū)間。offset 用來適應(yīng)線色差異黑線白地offset 通常負(fù) 10 到負(fù) 30白線黑地offset 可以取正。這個(gè) offset 不用每幀改但你要留出接口方便后期調(diào)車。二值化就是對每個(gè)像素做一次比較同時(shí)輸出線標(biāo)志static void image_binary(uint8_t *gray, uint8_t *bin, uint16_t count, uint8_t threshold) { for (uint16_t i 0; i count; i) { // 黑色線比地面暗像素值小于閾值判定為線 bin[i] (gray[i] threshold) ? 0xff : 0x00; } }方向別搞反了。如果你的賽道是白線深色地板就把比較符號(hào)反過來。看到全黑或全白的二值圖先檢查符號(hào)而不是閾值。4.2 質(zhì)量中心法提取中線丟線判斷與計(jì)算量優(yōu)化二值圖里線像素是 0xff其他是 0x00。最簡單的中線算法是“質(zhì)量中心法”把所有線像素的橫坐標(biāo)累加除以線像素總數(shù)得到平均中心。int16_t line_center(uint8_t *bin, uint16_t w, uint16_t h) { uint32_t sum_x 0; uint32_t line_cnt 0; for (uint16_t y 0; y h; y) { for (uint16_t x 0; x w; x) { if (bin[y * w x] 0xff) { sum_x x; line_cnt; } } } if (line_cnt 0) { return -1; // 丟線標(biāo)志 } return (int16_t)(sum_x / line_cnt); }返回 -1 表示整幀沒有發(fā)現(xiàn)有效線像素。這個(gè)信號(hào)非常重要它告訴控制邏輯“當(dāng)前是丟線狀態(tài)”應(yīng)該強(qiáng)制轉(zhuǎn)向?qū)ぞ€而不是把上一次中心當(dāng)作有效輸入繼續(xù)執(zhí)行。差速控制里最怕的就是丟線后還按舊的偏差輸出車直沖出去。質(zhì)量中心法的好處是抗噪個(gè)別噪點(diǎn)對平均值影響很小。如果你用“找每行最亮點(diǎn)”再連線遇到地面反光會(huì)非常痛苦。另外可以加一個(gè) ROI 優(yōu)化只統(tǒng)計(jì)圖像下半部分。攝像頭安裝后賽道主要在畫面下方上半部分是遠(yuǎn)處背景加入計(jì)算只會(huì)引入干擾。改循環(huán)邊界就行// 從 h*2/3 開始統(tǒng)計(jì)只看靠近車頭的位置 for (uint16_t y h * 2 / 3; y h; y) { ... }這個(gè)改動(dòng)同時(shí)減少了 1/3 的計(jì)算量建議底車階段就加上。4.3 PID與運(yùn)動(dòng)控制誤差如何轉(zhuǎn)換成左右輪差速圖像中心算出來了和畫面中線的偏差就是轉(zhuǎn)向誤差。假設(shè)畫面寬 160目標(biāo)中心是第 80 列那么誤差就是int16_t err center - 80;如果 err 為正說明線偏右車要向右轉(zhuǎn)為負(fù)則向左。最簡單的轉(zhuǎn)向輸出可以用比例加微分控制微分項(xiàng)能抑制小車在彎道出口的擺動(dòng)。static int16_t last_err 0; int16_t pid_output(int16_t err) { int16_t out; // P項(xiàng)決定轉(zhuǎn)向力度D項(xiàng)抑制突變 out (int16_t)(KP * err KD * (err - last_err)); last_err err; if (out 300) out 300; if (out -300) out -300; return out; }KP 和 KD 的取值沒有絕對標(biāo)準(zhǔn)。我通常從 KP1.0、KD0.5 起步把基礎(chǔ)速度放低先看直道是否穩(wěn)定再逐步提速。轉(zhuǎn)向輸出要限幅不然差速過大會(huì)讓內(nèi)側(cè)輪反轉(zhuǎn)車在跑道上原地打轉(zhuǎn)。最終加到底層電機(jī)控制int16_t steer pid_output(err); left_speed BASE_SPEED - steer; right_speed BASE_SPEED steer; if (left_speed 0) left_speed 0; if (right_speed 0) right_speed 0; pwm_set_left(left_speed); pwm_set_right(right_speed);BASE_SPEED 是直道時(shí)的目標(biāo)速度我一般設(shè)成占空比的 40% 左右太高會(huì)讓攝像頭處理跟不上。丟線狀態(tài)要單獨(dú)處理if (center -1) { // 按上次誤差方向強(qiáng)制轉(zhuǎn)動(dòng)持續(xù)尋線 if (last_err 0) steer 300; else steer -300; }這里用 last_err 方向去轉(zhuǎn)配合限幅能保證出彎丟線時(shí)車不會(huì)直沖。等重新找到線PID 重新接管。5. OV7670攝像頭循跡 常見問題與排查手記這一章把我在實(shí)際調(diào)試中踩過、以及幫別人排查過的高頻問題整理出來每條按照“現(xiàn)象 → 原因 → 解決”展開。這些問題你在任何指南里都會(huì)看到不少排除思路但真正落地時(shí)細(xì)節(jié)往往不一樣。5.1 上電全灰或無圖SCCB握手失敗和XCLK缺失現(xiàn)象寄存器配置流程跑完了VSYNC 引腳有電平變化但圖像緩沖里全是一種顏色沒有任何輪廓。原因最常見是兩個(gè)一個(gè)是 SCCB 從未真正寫入成功攝像頭還停留在內(nèi)部默認(rèn)狀態(tài)另一個(gè)是 XCLK 頻率不對攝像頭輸出時(shí)序混亂。解決先做一個(gè)寄存器回讀測試寫一個(gè)寄存器再讀回來對比能立刻定位總線問題。SCCB 初始化之前用 GPIO 翻轉(zhuǎn)方式分別測試 SIO_C 和 SIO_D 的波形確認(rèn)主控中斷沒有把引腳占用。XCLK 用示波器或邏輯分析儀量一下頻率沒有儀器就把定時(shí)器分頻往低里調(diào)再試圖像是否出現(xiàn)。模塊上電前確認(rèn)電源沒有疊加在數(shù)據(jù)引腳上。5.2 花屏與色彩錯(cuò)亂數(shù)據(jù)線序、時(shí)鐘沿與高低字節(jié)現(xiàn)象畫面不是常見黑白灰而是明顯紅綠或藍(lán)綠穿插或者出現(xiàn)彩色噪點(diǎn)線條輪廓根本沒法二值化。原因D0-D7 數(shù)據(jù)線順序接反RGB565 高低字節(jié)順序配反PCLK 采樣的時(shí)鐘沿選錯(cuò)。最常見的是排線從攝像頭到主控中間插了一根杜邦線順序全錯(cuò)位。解決先用邏輯分析儀抓 D0-D7 和 PCLK 的關(guān)系確認(rèn)采樣沿。如果沒儀器把采集到的 RGB 高字節(jié)和低字節(jié)分別打印出來用串口看數(shù)值規(guī)律。高低字節(jié)反了就把 DMA 搬運(yùn)的數(shù)據(jù)做一次字節(jié)交換或者直接修改 DMA 數(shù)據(jù)寬度配置。數(shù)據(jù)線順序問題只能靠接線核對解決程序里沒法補(bǔ)救。這塊沒有捷徑耐心對一遍比寫一百行補(bǔ)償代碼都有效。5.3 圖像下半幀丟失或卡死VSYNC檢測與緩沖競爭現(xiàn)象畫面能出但經(jīng)常只有上半部分或者畫面像被橫切了一刀下半部分是上一幀的殘留。原因VSYNC 中斷觸發(fā)點(diǎn)在幀中間而不是幀頭DMA 啟動(dòng)時(shí)機(jī)晚于數(shù)據(jù)輸出導(dǎo)致丟行。另一個(gè)原因是緩沖只有一個(gè)處理函數(shù)讀到一半新幀覆蓋進(jìn)來。解決用示波器看 VSYNC 極性部分模塊是下降沿有效部分上升沿配置成對應(yīng)邊沿觸發(fā)。DMA 啟動(dòng)放在 VSYNC 中斷后立刻執(zhí)行不要在前面加長延時(shí)。正式做循跡務(wù)必上雙緩沖雖然多占十幾 KB 內(nèi)存但能徹底消除撕裂。5.4 循跡丟線亂擺閾值和PID對抗的常見誤區(qū)現(xiàn)象直道還能走一到彎道就沖出賽道或者明明走直道車卻高頻左右擺動(dòng)。原因閾值偏移設(shè)置不對二值圖把大量地面噪點(diǎn)也算成線質(zhì)量中心被干擾。另一個(gè)原因是 PID 的 D 項(xiàng)過大或者處理延遲太高誤差還沒收斂就連續(xù)輸出。解決先把二值圖通過串口上傳到電腦看確認(rèn)圖像里只有一條線是白色。有噪點(diǎn)就先調(diào)整閾值和 ROI別動(dòng) PID。如果直道擺動(dòng)減小 KD再看是不是處理一幀時(shí)間太長導(dǎo)致誤差累積。循跡小車跑不穩(wěn)八成不是 PID 問題而是前面圖像數(shù)據(jù)就是臟的。6. 從能跑通到跑得穩(wěn)三個(gè)驗(yàn)證技巧與最后的實(shí)話6.1 用串口回傳二值圖肉眼確認(rèn)圖像數(shù)據(jù)正確調(diào)車時(shí)沒有屏幕怎么辦把二值圖用串口打出字符畫一幀也就 19200 個(gè)像素串口速度 115200 下大概幾百毫秒。我不追求實(shí)時(shí)只把它當(dāng)調(diào)試手段每觸發(fā)一次按鍵發(fā)一幀。void dump_binary_image(uint8_t *bin, uint16_t w, uint16_t h) { for (uint16_t y 0; y h; y) { for (uint16_t x 0; x w; x) { uart_putch(bin[y * w x] ? * : -); } uart_putch(\n); } }看到字符畫里線是一條干凈的白色豎條二值化和閾值就過關(guān)了再去談 PID。這一步能幫你省下大量“玄學(xué)調(diào)參”時(shí)間。6.2 物理調(diào)車鏡頭高度、俯仰角與閾值的聯(lián)動(dòng)鏡頭離地高度直接影響視野寬度。太高線在畫面里變細(xì)閾值稍微偏移就丟線太低只能看到近距離一小段彎道來不及反應(yīng)。我一般先把鏡頭放到離地 6 到 8 厘米俯仰角略微向前傾斜 15 度左右讓車頭前方 10 到 30 厘米的賽道段落在畫面下半部分。調(diào)好物理位姿后再重新計(jì)算閾值偏移量不要鏡頭動(dòng)完不動(dòng)閾值就上賽道。6.3 我走過的一段彎路調(diào)參不是調(diào)PID先調(diào)數(shù)據(jù)源我最開始調(diào)模擬項(xiàng)目X時(shí)連續(xù)兩天在改 KP、KD車還是在彎道前翻。后來把二值圖打出來才發(fā)現(xiàn)整個(gè)畫面下方三分之一的閾值全錯(cuò)了地面反光被識(shí)別成線質(zhì)量中心被拉到一邊。那一刻我才明白視覺循跡的第一優(yōu)先級(jí)永遠(yuǎn)是確認(rèn)輸入數(shù)據(jù)干凈控制算法只是錦上添花。從那以后我每換一個(gè)場地第一件事是回傳圖像第二件事才是調(diào) PID。這個(gè)順序讓我后來再也沒白熬過夜。如果你正準(zhǔn)備做自己的循跡小車先別急著上高級(jí)算法把這一幀圖盯明白車自然就能跑穩(wěn)。希望幫到你。本文還有配套的精品資源點(diǎn)擊獲取