做“機(jī)器人被撓腳心”這個(gè)項(xiàng)目起因其實(shí)挺簡(jiǎn)單我想驗(yàn)證一個(gè)小型機(jī)器人對(duì)“突發(fā)觸摸”能做出多自然的反應(yīng)。這個(gè)項(xiàng)目在我自己整理的《FM及機(jī)器人系列》里屬于TK觸覺(jué)互動(dòng)測(cè)試專題后來(lái)做著做著發(fā)現(xiàn)它已經(jīng)不只是一個(gè)整蠱玩具而是一套完整的“觸覺(jué)感知 運(yùn)動(dòng)反饋 狀態(tài)管理”機(jī)器人交互原型。很多做陪伴機(jī)器人、展覽機(jī)器人、教育機(jī)器人的人最后都會(huì)遇到同一個(gè)問(wèn)題機(jī)器人太“木”了摸它沒(méi)反應(yīng)或者反應(yīng)延遲明顯體驗(yàn)非常差。而“撓腳心”恰好是觸發(fā)快速自然反應(yīng)的極佳測(cè)試場(chǎng)景我做完這套之后很多做ROS開(kāi)發(fā)的同事也拿它當(dāng)入門練手項(xiàng)目。這個(gè)項(xiàng)目最適合兩類人一類是剛開(kāi)始學(xué)機(jī)器人控制、ROS系統(tǒng)想找一個(gè)有趣又不枯燥的載體來(lái)練習(xí)的人另一類是已經(jīng)被課程里的正運(yùn)動(dòng)學(xué)、逆運(yùn)動(dòng)學(xué)搞得有點(diǎn)疲憊的初學(xué)者想換個(gè)更有成就感的角度理解傳感器和執(zhí)行器如何協(xié)同工作。我會(huì)從硬件選型、傳感器原理、狀態(tài)機(jī)設(shè)計(jì)、ROS 2集成到完整實(shí)操和常見(jiàn)問(wèn)題把整個(gè)項(xiàng)目展開(kāi)來(lái)講盡量讓你能直接“抄作業(yè)”。1. 整體設(shè)計(jì)思路先想清楚“怕癢”這個(gè)動(dòng)作需要什么1.1 為什么選擇“撓腳心”作為交互場(chǎng)景傳統(tǒng)機(jī)器人給人的印象是“被動(dòng)執(zhí)行”你按按鈕它才動(dòng)你發(fā)指令它才做。但這種模式離“人機(jī)自然交互”非常遠(yuǎn)。這幾年我接觸過(guò)的服務(wù)機(jī)器人、導(dǎo)覽機(jī)器人項(xiàng)目客戶幾乎都會(huì)提一個(gè)需求能不能讓機(jī)器人更有“人情味”其中最容易出效果的一招就是讓它對(duì)自己的身體被觸碰產(chǎn)生反應(yīng)。微軟的小冰、優(yōu)必選的Walker等產(chǎn)品也都做過(guò)“怕癢”“怕摸”這類演示目的就是拉近機(jī)器人和用戶的距離。“撓腳心”是觸發(fā)人類自然反應(yīng)最強(qiáng)的動(dòng)作之一換到機(jī)器人身上它天然具備三個(gè)測(cè)試價(jià)值。首先腳底是機(jī)器人身體上相對(duì)隱蔽、區(qū)域明確的部位傳感器安裝不會(huì)破壞整體外觀。其次觸碰腳底的力度差異很大從輕輕拂過(guò)到用力按壓能很好地測(cè)試傳感器量程和閾值設(shè)計(jì)。最關(guān)鍵的一點(diǎn)是“縮腳”“抖動(dòng)”“發(fā)出聲音”這一整套反應(yīng)在觀感上充滿喜劇色彩非常適合在課堂、展會(huì)、活動(dòng)上做演示容易調(diào)動(dòng)氣氛也讓學(xué)習(xí)者更有動(dòng)力把項(xiàng)目調(diào)好。從本質(zhì)上看這個(gè)項(xiàng)目要解決的三個(gè)技術(shù)問(wèn)題很清晰腳底受到觸碰時(shí)傳感器如何快速準(zhǔn)確感知感知到信號(hào)后機(jī)器人如何選擇并執(zhí)行“反應(yīng)動(dòng)作”整個(gè)過(guò)程的延遲要控制在多短才能讓交互顯得自然。這三個(gè)問(wèn)題分別對(duì)應(yīng)硬件層、控制層和交互層恰好是機(jī)器人開(kāi)發(fā)的三個(gè)基本切面。1.2 整體方案選型分層設(shè)計(jì)避免一鍋燴我在設(shè)計(jì)這個(gè)項(xiàng)目時(shí)沒(méi)有選擇“一塊板子搞定所有事”的做法而是把系統(tǒng)分成了感知層、控制層、表現(xiàn)層三層。感知層用壓敏電阻FSR檢測(cè)腳底壓力控制層用一塊ESP32作為主控負(fù)責(zé)采集信號(hào)、運(yùn)行狀態(tài)機(jī)、輸出控制指令表現(xiàn)層由舵機(jī)、振動(dòng)馬達(dá)和音頻模塊組成分別實(shí)現(xiàn)“縮腳”“顫抖”“笑/求饒”三種反饋。之所以分層是因?yàn)檫@個(gè)項(xiàng)目后續(xù)有很強(qiáng)的擴(kuò)展性。如果你只想做一個(gè)整蠱玩具用一塊Arduino Nano就能完成全部工作但如果你想把項(xiàng)目接入ROS 2或者把“撓癢反應(yīng)”做成整個(gè)機(jī)器人交互系統(tǒng)的一個(gè)子系統(tǒng)就必須把感知、決策、動(dòng)作分開(kāi)。我自己剛開(kāi)始也是圖省事把代碼全寫在一個(gè)loop里后來(lái)加了ROS接口之后不得不重寫了一遍教訓(xùn)很深刻。硬件選型上我最終選用了ESP32而非Arduino Uno原因是ESP32的ADC精度更高、支持Wi-Fi/藍(lán)牙而且雙核處理器可以一個(gè)核跑傳感器采樣、另一個(gè)核跑狀態(tài)機(jī)。不過(guò)要注意ESP32的ADC有非線性問(wèn)題后面我會(huì)專門講怎么校準(zhǔn)。執(zhí)行器方面腳部縮回動(dòng)作用了SG90舵機(jī)但經(jīng)過(guò)幾次測(cè)試后我強(qiáng)烈建議換成MG90S或MG996R因?yàn)镾G90在連續(xù)抖動(dòng)時(shí)很容易發(fā)熱甚至燒毀。振動(dòng)馬達(dá)用的是常見(jiàn)的手機(jī)扁平馬達(dá)通過(guò)一個(gè)S8050三極管驅(qū)動(dòng)音頻部分用了DFPlayer Mini播放MP3音效比直接用蜂鳴器逼真得多。2. 觸覺(jué)感知是怎么實(shí)現(xiàn)的FSR傳感器原理與安裝細(xì)節(jié)2.1 FSR壓敏電阻的工作原理FSRForce Sensing Resistor壓敏電阻是這個(gè)項(xiàng)目感知層的主角。它的工作原理很簡(jiǎn)單當(dāng)壓力施加在傳感器有效區(qū)域上時(shí)內(nèi)部導(dǎo)電粒子和電極之間的接觸面積增加導(dǎo)致電阻值下降。沒(méi)有壓力時(shí)它的電阻通常在1MΩ以上隨著壓力增大可以降到幾kΩ甚至幾百Ω。要讓ESP32讀取這個(gè)電阻變化不能直接把FSR接到ADC引腳因?yàn)锳DC讀的是電壓而不是電阻。標(biāo)準(zhǔn)做法是接一個(gè)分壓電路把FSR和一個(gè)固定電阻串聯(lián)中間抽頭接到ADC輸入。這里有個(gè)非常容易踩的坑很多人以為固定電阻的阻值選得越大越好其實(shí)不是。固定電阻阻值決定了電路的靈敏度范圍選得太大輕輕一碰ADC就到滿量程后面沒(méi)法區(qū)分“輕觸”和“重壓”選得太小重壓時(shí)電壓變化不明顯分辨率又不夠。我最終選的固定電阻是10kΩ這個(gè)值在大多數(shù)場(chǎng)景下能兼顧。舉個(gè)例子我用的FSR型號(hào)是Interlink FSR402它在輕觸時(shí)阻值約為20kΩ重壓時(shí)約2kΩ。用10kΩ固定電阻做分壓時(shí)輕觸狀態(tài)ADC口電壓大概是3.3 * 10 / (20 10) 1.1V重壓狀態(tài)大概是3.3 * 10 / (2 10) 2.75V整個(gè)區(qū)間接近1.65V非常利于分辨率分配。如果你用的是其他型號(hào)FSR可以先用萬(wàn)用表測(cè)一下輕觸和重壓下的實(shí)際阻值再根據(jù)公式R_fixed sqrt(R_light * R_heavy)估算最佳固定電阻這個(gè)公式來(lái)自分壓電路的最大靈敏度條件我實(shí)測(cè)下來(lái)比較可靠。2.2 腳底結(jié)構(gòu)改造與傳感器固定FSR傳感器雖然叫“壓敏電阻”但它對(duì)安裝方式非常挑剔。最理想的狀態(tài)是FSR放置在一個(gè)平整堅(jiān)硬的平面上上方覆蓋一層薄而柔軟的壓力傳遞層。如果直接貼在軟海綿上FSR會(huì)因?yàn)榛膹澢a(chǎn)生非線性輸出如果上方壓著一塊硬塑料壓力又會(huì)集中在某一點(diǎn)導(dǎo)致大面積區(qū)域沒(méi)有參與感應(yīng)。我的做法是先3D打印一個(gè)腳掌形狀的硬底殼底部留一個(gè)和FSR有效區(qū)域尺寸一致的淺槽把FSR用雙面膠粘在槽里再在最上面貼一層1mm厚的硅膠腳墊。FSR的引腳線則沿著腿側(cè)布線用螺旋纏繞管保護(hù)起來(lái)一直延伸到主控板。這里有個(gè)細(xì)節(jié)需要特別強(qiáng)調(diào)FSR的引腳和柔性基材連接處非常脆弱劇烈彎折幾次就會(huì)內(nèi)部斷路而表現(xiàn)癥狀不是完全沒(méi)信號(hào)而是信號(hào)忽大忽小極難排查。我后來(lái)把所有靠近關(guān)節(jié)的線都換了硅膠軟線并在線材進(jìn)入腳掌的位置打了熱熔膠固定這個(gè)問(wèn)題才徹底解決。如果你沒(méi)有3D打印機(jī)也可以用EVA泡棉板手工挖槽代替但一定要注意讓FSR背面貼到的位置是平整的不要在傳感器正下方設(shè)置凸起結(jié)構(gòu)否則長(zhǎng)時(shí)間受壓之后FSR的阻值會(huì)發(fā)生永久性漂移。我拆了一個(gè)客戶寄來(lái)維修的機(jī)器人就是因?yàn)槟_底用了一個(gè)凸點(diǎn)防滑墊半年之后FSR輸出的“無(wú)壓力”電壓從0.8V變成了1.6V觸發(fā)閾值完全錯(cuò)亂。2.3 執(zhí)行機(jī)構(gòu)的配合讓“害怕”有層次傳感器解決的是“被摸到”的問(wèn)題而動(dòng)作執(zhí)行解決的是“怎么反應(yīng)”的問(wèn)題。這個(gè)項(xiàng)目里我用了三種執(zhí)行器分別對(duì)應(yīng)三種不同的反應(yīng)等級(jí)。舵機(jī)控制腳掌縮起模擬“躲開(kāi)”振動(dòng)馬達(dá)裝在身體骨架上模擬“發(fā)抖”DFPlayer音頻模塊負(fù)責(zé)播放聲音可以是笑聲也可以是“不要撓了”的配音。這三種執(zhí)行器的配合順序決定了交互效果是否真實(shí)。我一開(kāi)始的做法是檢測(cè)到觸摸三個(gè)執(zhí)行器同時(shí)啟動(dòng)結(jié)果機(jī)器人顯得很“神經(jīng)質(zhì)”沒(méi)有任何情緒遞進(jìn)。后來(lái)參考了動(dòng)物行為學(xué)里“驚嚇?lè)瓷洹钡母拍钫{(diào)整成有層次的反應(yīng)路徑輕觸時(shí)只縮一下腳停頓0.2秒持續(xù)觸摸時(shí)腳掌連續(xù)抖動(dòng)同時(shí)開(kāi)啟振動(dòng)馬達(dá)壓力繼續(xù)增加或者累計(jì)觸摸時(shí)間超過(guò)2秒才播放聲音并讓舵機(jī)進(jìn)行大幅度擺動(dòng)模擬“掙扎”。這樣的層次感讓整個(gè)交互變得可信很多也讓我意識(shí)到硬件能力其實(shí)早就夠了真正決定“像不像”的是軟件里的狀態(tài)設(shè)計(jì)和動(dòng)作編排。3. 軟件核心狀態(tài)機(jī)驅(qū)動(dòng)“被撓”反應(yīng)3.1 信號(hào)采集與濾波防止誤觸發(fā)FSR信號(hào)采集的第一步是讀取ADC值并做平滑處理。很多人拿到傳感器后直接在loop里面寫一句analogRead()然后拿去和閾值比這種方式在靜態(tài)壓力下沒(méi)有問(wèn)題但用手指撓腳心時(shí)壓力是快速波動(dòng)的單次讀取的值可能一下沖到閾值以上、一下跌回閾值以下導(dǎo)致機(jī)器人短時(shí)間內(nèi)瘋狂觸發(fā)看起來(lái)就像抽風(fēng)。我實(shí)際使用的方案是滑動(dòng)平均濾波每次讀入一個(gè)值和最近5次的值取平均。這個(gè)濾波窗口長(zhǎng)度是經(jīng)過(guò)測(cè)試的窗口太短比如3次濾不掉高頻抖動(dòng)窗口太長(zhǎng)比如10次以上反應(yīng)延遲會(huì)明顯增大觸摸響應(yīng)變得遲鈍。5次窗口在ESP32的ADC采樣率下大約帶來(lái)15ms的延遲人幾乎感知不到。代碼實(shí)現(xiàn)上我放在一個(gè)定時(shí)器中斷里執(zhí)行采樣而不是主循環(huán)里。ESP32的ADC讀取過(guò)程中如果被Wi-Fi任務(wù)打斷會(huì)返回異常值所以采樣代碼做了異常剔除——連續(xù)兩次ADC跳變超過(guò)1000單位就認(rèn)為這次采樣無(wú)效丟棄重讀。這個(gè)處理后面幫我排除了至少一半的“幽靈觸發(fā)”問(wèn)題。3.2 四狀態(tài)狀態(tài)機(jī)空閑、警覺(jué)、掙扎、恢復(fù)整個(gè)反應(yīng)邏輯我用一個(gè)簡(jiǎn)單的狀態(tài)機(jī)來(lái)管理四個(gè)狀態(tài)分別是IDLE空閑、TOUCHED警覺(jué)、STRUGGLE掙扎、RECOVER恢復(fù)。設(shè)計(jì)思路是這樣的IDLE狀態(tài)下系統(tǒng)正常檢測(cè)壓力壓力超過(guò)閾值的時(shí)刻記錄為觸摸起始時(shí)間進(jìn)入TOUCHED。TOUCHED狀態(tài)下機(jī)器人執(zhí)行小幅動(dòng)作比如腳掌縮回一個(gè)小角度但不會(huì)持續(xù)反饋同時(shí)累積一個(gè)“癢感值”。如果觸摸在1秒內(nèi)結(jié)束系統(tǒng)回到IDLE如果觸摸持續(xù)癢感值累加超過(guò)設(shè)定值后進(jìn)入STRUGGLE。STRUGGLE狀態(tài)下才是完整的“掙扎”表現(xiàn)——連續(xù)抖動(dòng)、發(fā)聲、大幅擺動(dòng)。當(dāng)壓力消失后進(jìn)入RECOVER狀態(tài)這個(gè)狀態(tài)有點(diǎn)像一個(gè)“冷卻時(shí)間”5秒內(nèi)不響應(yīng)任何觸摸避免剛安靜下來(lái)又被立刻戳一下導(dǎo)致系統(tǒng)處于永動(dòng)狀態(tài)。冷卻結(jié)束后回到IDLE。這里有一個(gè)非常關(guān)鍵但又容易被忽略的細(xì)節(jié)狀態(tài)切換不能太“陡”。比如從IDLE直接進(jìn)入STRUGGLE如果動(dòng)作突然從靜止跳到最大幅度舵機(jī)在速度很快的情況下會(huì)產(chǎn)生巨大沖擊電流造成電壓跌落甚至讓ESP32重啟。我在狀態(tài)切換時(shí)加入了動(dòng)作淡入機(jī)制也就是每個(gè)動(dòng)作指令都帶一個(gè)加速度限制舵機(jī)速度從當(dāng)前值按步長(zhǎng)逼近目標(biāo)值而不是直接跳到目標(biāo)角度。這個(gè)機(jī)制讓整個(gè)機(jī)器人的動(dòng)作看起來(lái)“肉肉的”反而比機(jī)械式的瞬間到位更有生物感。3.3 壓力和動(dòng)作的映射關(guān)系為了讓“越撓越癢”的感受傳遞出來(lái)我把FSR的壓力值映射成了三個(gè)檔位。輕壓電壓0.8V~1.5V對(duì)應(yīng)“縮腳”動(dòng)作中壓1.5V~2.2V對(duì)應(yīng)“連續(xù)抖動(dòng)振動(dòng)馬達(dá)”重壓2.2V以上對(duì)應(yīng)“大幅掙扎播放音效”。這個(gè)映射不是寫死閾值而是做一個(gè)分段線性映射函數(shù)讓輸出動(dòng)作幅度和輸入壓力成正比。映射的實(shí)現(xiàn)需要一個(gè)校準(zhǔn)過(guò)程。我建議先把ADC原始值通過(guò)串口打印出來(lái)用不同力度多次按壓記錄三個(gè)區(qū)間的典型值。由于FSR在長(zhǎng)期使用后會(huì)有輕微漂移比較穩(wěn)妥的做法是在系統(tǒng)啟動(dòng)時(shí)做一個(gè)短暫的“無(wú)壓力基準(zhǔn)采樣”把這個(gè)基準(zhǔn)值作為零點(diǎn)之后所有判斷都基于相對(duì)壓力而非絕對(duì)電壓。這個(gè)功能代碼量不大但能大大提升長(zhǎng)期使用的穩(wěn)定性。我后面做過(guò)一個(gè)實(shí)驗(yàn)用同一套設(shè)備連續(xù)運(yùn)行72小時(shí)套了基準(zhǔn)校準(zhǔn)后觸發(fā)閾值幾乎沒(méi)變而沒(méi)套校準(zhǔn)的觸發(fā)電平漂了將近0.3V已經(jīng)足夠引起誤觸發(fā)了。4. 接入ROS 2把玩具變成機(jī)器人開(kāi)發(fā)練手工程4.1 為什么非要接ROS 2先聲明一下如果你只是想做一個(gè)整蠱機(jī)器人或者桌面擺件完全不需要上ROS 2用我上面說(shuō)的Arduino單機(jī)方案就夠了。但如果你是想認(rèn)真走機(jī)器人開(kāi)發(fā)路線ROS 2幾乎是繞不過(guò)去的門檻而“能產(chǎn)生直觀交互反饋”的項(xiàng)目是最好的學(xué)習(xí)載體。我在帶新人學(xué)ROS 2的時(shí)候發(fā)現(xiàn)讓人對(duì)著吃灰的說(shuō)明書去學(xué)話題通信效率極低但如果讓我摸一下機(jī)器人、機(jī)器人就掙扎一下新人會(huì)追著問(wèn)“這個(gè)信號(hào)到底是怎么從傳感器傳到執(zhí)行器的”這時(shí)候講話題、講節(jié)點(diǎn)接受度完全不一樣。從系統(tǒng)結(jié)構(gòu)上看ROS 2很適合這個(gè)項(xiàng)目的原因在于“模塊化”。傳感器驅(qū)動(dòng)、狀態(tài)判斷、動(dòng)作執(zhí)行可以是三個(gè)獨(dú)立節(jié)點(diǎn)你甚至可以只在傳感器節(jié)點(diǎn)上做仿真用ros2 topic pub手動(dòng)發(fā)消息就能看見(jiàn)動(dòng)作執(zhí)行的效果。這樣即使硬件還沒(méi)到貨代碼部分已經(jīng)可以并行開(kāi)發(fā)了對(duì)團(tuán)隊(duì)協(xié)作也非常友好。4.2 節(jié)點(diǎn)劃分與話題定義在這個(gè)項(xiàng)目里我劃分了三個(gè)節(jié)點(diǎn)。第一個(gè)是sensor_node負(fù)責(zé)讀取ESP32通過(guò)串口發(fā)來(lái)的壓力值并把float數(shù)據(jù)發(fā)布到 /touch_strength 話題上。選擇這個(gè)做法的原因是ESP32作為單片機(jī)負(fù)責(zé)實(shí)時(shí)采樣ROS 2作為上層負(fù)責(zé)邏輯兩者邊界非常清晰。第二個(gè)是react_node訂閱 /touch_strength運(yùn)行上文提到的狀態(tài)機(jī)計(jì)算當(dāng)前應(yīng)當(dāng)執(zhí)行的反應(yīng)等級(jí)并把結(jié)果發(fā)布到 /react_command 話題。第三個(gè)是action_node訂閱 /react_command把抽象的“掙扎”指令翻譯成具體的串口指令比如“舵機(jī)轉(zhuǎn)到120度振動(dòng)馬達(dá)開(kāi)循環(huán)3次”發(fā)給ESP32執(zhí)行。話題類型上/touch_strength 用的是標(biāo)準(zhǔn)類型 std_msgs/msg/Float32而 /react_command 我自定義了一個(gè)消息包含兩個(gè)字段float32 strength 和 string reaction_type。用自定義消息而不是直接用String是為了將來(lái)擴(kuò)展方便——比如以后要加“表情屏控制”“語(yǔ)音回復(fù)”直接在同一個(gè)消息里加字段就行不用新增話題。這個(gè)架構(gòu)的好處是任何一個(gè)節(jié)點(diǎn)都可以單獨(dú)替換或測(cè)試。有一次我的ESP32硬件壞了我沒(méi)有等新的板子到直接寫了一個(gè)模擬傳感器節(jié)點(diǎn)按正弦波規(guī)律發(fā)布?jí)毫χ嫡麄€(gè)交互邏輯照常跑通。這在傳統(tǒng)的“一坨代碼”式開(kāi)發(fā)里是不可能做到的。4.3 參數(shù)配置與launch啟動(dòng)在ROS 2里我把所有閾值參數(shù)都做成了參數(shù)而不是寫死在代碼里。比如 /react_node 下的 touch_threshold、struggle_threshold、recover_time都可以在launch文件里傳值這樣調(diào)整機(jī)器人“性格”的時(shí)候不需要重新編譯。我還做了一個(gè)很實(shí)用的功能通過(guò)參數(shù)控制 “敏感度模式”把閾值整體除以一個(gè)系數(shù)。展覽演示時(shí)設(shè)為1.5變得很敏感觀眾輕輕碰一下就有反饋家里調(diào)試時(shí)設(shè)為0.8減少誤觸發(fā)。launch文件本身也很簡(jiǎn)單用Python的launch格式把三個(gè)節(jié)點(diǎn)串起來(lái)順手啟動(dòng)一個(gè)串口權(quán)限設(shè)置命令。其實(shí)把這套流程跑通之后你再去理解ROS 2里那些更復(fù)雜的navigation、moveit配置思路都是相通的無(wú)非就是“節(jié)點(diǎn)話題參數(shù)”的組合變化。5. 完整實(shí)操?gòu)慕泳€到跑通的每一步5.1 物料清單與接線方式先列一個(gè)可以直接照著買的物料清單都是非常常見(jiàn)的東西物料型號(hào)/規(guī)格數(shù)量用途主控板ESP32 DevKitC V41采集與底層控制壓敏電阻Interlink FSR4022左右腳底檢測(cè)固定電阻10kΩ 1%2FSR分壓舵機(jī)MG90S金屬齒輪2腳掌抬起/晃動(dòng)振動(dòng)馬達(dá)手機(jī)扁平馬達(dá)3V1顫抖體感三極管S80501驅(qū)動(dòng)振動(dòng)馬達(dá)音頻模塊DFPlayer Mini1音效播放揚(yáng)聲器3W 4Ω1輸出聲音電源5V 3A DC-DC模塊1穩(wěn)定供電3D打印件腳掌殼、腿部支架1套結(jié)構(gòu)支撐硅膠腳墊1mm厚2壓力傳導(dǎo)與防滑接線方面FSR部分按之前說(shuō)的分壓電路連接兩個(gè)FSR分別接ESP32的GPIO34和GPIO35。需要特別提醒的是ESP32的ADC引腳并不是所有GPIO都能用的有些引腳內(nèi)部已經(jīng)連接到flash電路讀取時(shí)會(huì)有很大噪聲。我自己踩過(guò)坑的包括GPIO36?不36和39是純輸入ADC通道沒(méi)有問(wèn)題但像GPIO2、GPIO15之類的被占用引腳就不要碰了。舵機(jī)的信號(hào)線接GPIO12和GPIO13這兩路是硬件PWM通道穩(wěn)定度好于軟件PWM。振動(dòng)馬達(dá)通過(guò)三極管接到GPIO14音頻模塊的RX、TX分別接GPIO16和GPIO17。供電是這個(gè)項(xiàng)目里最容易出問(wèn)題的部分。ESP32的USB供電在舵機(jī)瞬間啟動(dòng)時(shí)會(huì)產(chǎn)生嚴(yán)重壓降表現(xiàn)為機(jī)器人一抖就重啟。我的解決方案是舵機(jī)和主控分開(kāi)供電舵機(jī)直接用5V 3A的DC-DC模塊供電主控板也從同一個(gè)電源取電但通過(guò)一個(gè)大容量電解電容1000μF在電源入口做緩沖。這樣即使舵機(jī)瞬間拉走1.5A電流主控電壓波動(dòng)也能控制在0.2V以內(nèi)。5.2 下位機(jī)代碼與上位機(jī)代碼下位機(jī)ESP32代碼我分成三個(gè)文件main.ino負(fù)責(zé)初始化和主循環(huán)sensor.cpp負(fù)責(zé)FSR采樣和濾波action.cpp負(fù)責(zé)執(zhí)行舵機(jī)、馬達(dá)、音頻的具體動(dòng)作。主循環(huán)的邏輯很簡(jiǎn)潔每10ms讀取一次壓力值將值通過(guò)串口發(fā)送同時(shí)檢查是否收到來(lái)自ROS 2端的控制指令收到就執(zhí)行對(duì)應(yīng)動(dòng)作。由于采樣放在定時(shí)器中斷里主循環(huán)里的串口接收不會(huì)阻塞傳感數(shù)據(jù)的更新。示例里最關(guān)鍵的是定時(shí)器采樣部分hw_timer_t *sampleTimer NULL; volatile float filteredPressure 0; volatile bool sampleReady false; void IRAM_ATTR onSampleTimer() { int raw analogRead(FSR_PIN); // 簡(jiǎn)單的異常剔除跳變過(guò)大時(shí)忽略本次值 static int lastRaw 0; if (abs(raw - lastRaw) 1000) { lastRaw raw; return; } lastRaw raw; // 5點(diǎn)滑動(dòng)平均 static float buf[5] {0}; static int idx 0; buf[idx] raw; idx (idx 1) % 5; float sum 0; for (int i 0; i 5; i) sum buf[i]; filteredPressure sum / 5.0; sampleReady true; }需要注意在ESP32的Arduino環(huán)境里定時(shí)器回調(diào)函數(shù)必須用IRAM_ATTR修飾否則在Wi-Fi棧啟用時(shí)會(huì)觸發(fā)異常重啟。這是ESP32的一個(gè)“經(jīng)典坑”很多新手都會(huì)在這里卡一晚上。上位機(jī)ROS 2部分sensor_node的核心是串口讀取并轉(zhuǎn)換數(shù)據(jù)類型。Python里用pyserial讀串口解析形如P:1.234\n的協(xié)議幀然后發(fā)布到 /touch_strength。整個(gè)循環(huán)用 rclpy.spin_once() 配合小延時(shí)避免串口緩沖區(qū) overflow。5.3 靈敏度標(biāo)定的具體操作標(biāo)定這一步我建議按照以下步驟來(lái)不要跳步。先打開(kāi)串口監(jiān)視器在無(wú)壓力的狀態(tài)下記錄10秒取平均作為基準(zhǔn)零點(diǎn)。然后用手指以你感覺(jué)“很輕”的力度觸碰FSR記錄這一瞬間的電平值記為“輕觸值”再用正常力度按一下記為“中壓值”再用最大力氣按壓記為“重壓值”。把這三個(gè)值填到react_node的params.yaml里作為壓力分檔的錨點(diǎn)。實(shí)際操作中有一個(gè)很容易被忽略的變量溫度。FSR的阻值會(huì)隨溫度漂移尤其是放在腳底這種不透氣的結(jié)構(gòu)里機(jī)器人內(nèi)部溫度升高后基線會(huì)變。所以我把“啟動(dòng)時(shí)自動(dòng)校準(zhǔn)零點(diǎn)”做成了默認(rèn)行為每次上電都會(huì)重新讀取基線而不是用代碼里寫死的0.8V。這個(gè)改動(dòng)小但長(zhǎng)期運(yùn)行穩(wěn)定性的提升非常明顯。5.4 動(dòng)作參數(shù)的調(diào)試心得動(dòng)作表現(xiàn)的調(diào)試本質(zhì)上是在玩一組參數(shù)舵機(jī)目標(biāo)角度、轉(zhuǎn)動(dòng)速度、停頓時(shí)間、循環(huán)次數(shù)。我的參考經(jīng)驗(yàn)是輕觸反應(yīng)舵機(jī)轉(zhuǎn)20度、速度250、停頓300ms掙扎反應(yīng)舵機(jī)轉(zhuǎn)45度、速度600、循環(huán)4次每次間隔80ms。如果發(fā)現(xiàn)動(dòng)作看起來(lái)“假”最常見(jiàn)的原因其實(shí)是舵機(jī)速度太快了快到看起來(lái)像被電擊而不是在發(fā)抖。真人的顫抖頻率大概在5~10Hz如果想讓機(jī)器人看起來(lái)更接近生物抖動(dòng)間隔應(yīng)該在100ms~200ms之間而不是越快越像。這個(gè)經(jīng)驗(yàn)是我調(diào)了很多版才總結(jié)出來(lái)的你可以直接拿去用。6. 常見(jiàn)問(wèn)題與排查技巧實(shí)錄6.1 傳感器不觸發(fā)或者一直觸發(fā)先上排查清單按概率排序現(xiàn)象大概率原因解決辦法完全沒(méi)有信號(hào)FSR引腳扯斷測(cè)FSR兩端電阻量不出變化就是斷了信號(hào)一直滿量程FSR被硬物壓住/分壓電阻接錯(cuò)檢查安裝層重新焊接固定電阻信號(hào)不穩(wěn)定線材內(nèi)部虛斷換硅膠軟線接頭處打膠固定上電時(shí)誤觸發(fā)一次上電瞬間ADC未穩(wěn)定在sampleTimer回調(diào)里加“啟動(dòng)前200ms丟棄”邏輯使用一段時(shí)間后誤觸發(fā)FSR零點(diǎn)漂移啟用啟動(dòng)自動(dòng)校準(zhǔn)重新標(biāo)定有一個(gè)排查小技巧把FSR的兩個(gè)引腳不通過(guò)分壓電路直接接到萬(wàn)用表電阻檔用手按壓看阻值變化。如果阻值變化正常幾千Ω到幾十kΩ那問(wèn)題在電路或者軟件如果阻值不變問(wèn)題在傳感器本身。這樣能快速把問(wèn)題定位到硬件層。6.2 舵機(jī)抖動(dòng)會(huì)導(dǎo)致整機(jī)重啟這個(gè)現(xiàn)象基本都是供電問(wèn)題。舵機(jī)標(biāo)稱工作電流是堵轉(zhuǎn)電流MG90S堵轉(zhuǎn)電流能到1.2A左右而ESP32模塊的穩(wěn)壓芯片根本頂不住這種瞬時(shí)抽載。解決方案有三個(gè)層次第一舵機(jī)電源單獨(dú)走DC-DC模塊不經(jīng)過(guò)主板的3.3V穩(wěn)壓器第二電源輸入端并聯(lián)一個(gè)大電容增強(qiáng)瞬態(tài)響應(yīng)第三軟件上給舵機(jī)指令加“加速/減速”限制不要讓舵機(jī)以最大速度瞬間轉(zhuǎn)向。還有一點(diǎn)很多人不知道舵機(jī)信號(hào)線在上電瞬間會(huì)短暫輸出高電平導(dǎo)致舵機(jī)沖到最大角度如果此時(shí)機(jī)器人擺在不穩(wěn)定的架子上會(huì)摔下來(lái)。解決辦法是在舵機(jī)信號(hào)線和地之間加一個(gè)10kΩ下拉電阻讓上電瞬間信號(hào)保持低電平直到主控程序把PWM信號(hào)穩(wěn)定輸出。6.3 交互延遲大手感“肉”手感“肉”的原因主要有兩個(gè)一是主循環(huán)里用了大量的delay()阻塞代碼傳感器采樣被拖慢了二是ROS 2端的狀態(tài)機(jī)循環(huán)周期太長(zhǎng)比如用默認(rèn)的0.5s定時(shí)器來(lái)做狀態(tài)切換那觸摸到反應(yīng)之間會(huì)有明顯卡頓。我的做法是下位機(jī)用硬件定時(shí)器做毫秒級(jí)采樣狀態(tài)機(jī)跑在ROS 2節(jié)點(diǎn)里但用50ms周期循環(huán)而不是默認(rèn)的500ms。如果你只跑單機(jī)版不接ROS 2那么整個(gè)狀態(tài)機(jī)也放在定時(shí)器回調(diào)里執(zhí)行主循環(huán)只負(fù)責(zé)串口輸出和處理外部指令。實(shí)測(cè)下來(lái)從手指碰到FSR到舵機(jī)開(kāi)始轉(zhuǎn)動(dòng)的延遲能控制在60ms以內(nèi)這個(gè)數(shù)值已經(jīng)低于人類對(duì)“即時(shí)反饋”的感知閾值交互體驗(yàn)非常流暢。6.4 舵機(jī)轉(zhuǎn)動(dòng)時(shí)音頻播放卡頓音頻卡頓的問(wèn)題根源在DFPlayer Mini和舵機(jī)共用電源時(shí)舵機(jī)的干擾導(dǎo)致音頻解碼芯片供電不穩(wěn)。DFPlayer Mini對(duì)電源噪聲非常敏感如果聽(tīng)到卡頓、破音多半是電源不干凈。解決辦法是給DFPlayer Mini單獨(dú)加一個(gè)100μF電容和1mH電感組成的LC濾波或者干脆用一個(gè)獨(dú)立的5V供電給它。此外音頻文件本身要轉(zhuǎn)成不超過(guò)320kbps的MP3采樣率不要用44.1kHz用22.05kHz就夠了這樣解碼負(fù)擔(dān)更小抗干擾能力也更強(qiáng)。在我實(shí)際做的幾個(gè)版本里還有一個(gè)容易忽略的聲音問(wèn)題播放音效和舵機(jī)動(dòng)作同時(shí)啟動(dòng)時(shí)音效的起點(diǎn)會(huì)和動(dòng)作的起點(diǎn)有些微偏差耳朵可能察覺(jué)不到但在視頻回放里會(huì)被放大。最自然的做法是讓音效稍微提前100ms啟動(dòng)因?yàn)槿硕鷮?duì)“先有聲音后有動(dòng)作”比“先有動(dòng)作后有聲音”的容忍度高得多這個(gè)細(xì)節(jié)能讓整體觀感真實(shí)不少。最后分享一點(diǎn)我的個(gè)人體會(huì)做這個(gè)項(xiàng)目最大的收獲不是“讓機(jī)器人怕癢”這個(gè)玩笑本身而是把一個(gè)看起來(lái)很無(wú)厘頭的場(chǎng)景硬生生拆成了傳感、控制、狀態(tài)管理、系統(tǒng)集成這四塊正好覆蓋了機(jī)器人開(kāi)發(fā)的主要環(huán)節(jié)。我前后給三個(gè)朋友做過(guò)類似的項(xiàng)目每次都能在對(duì)外的演示中迅速吸引圍觀甚至有人看到一半就問(wèn)能不能直接把代碼拿去給學(xué)生上課用。如果你也想做我的建議是不要一上來(lái)就追求完美先讓機(jī)器人有最基礎(chǔ)的反應(yīng)——碰到腳底就縮一下這一版跑通了再逐步加入聲音、抖動(dòng)、狀態(tài)機(jī)最后再接ROS 2。這樣每走一步都能看到成果學(xué)習(xí)動(dòng)力會(huì)保持得很好。如果你在調(diào)試中遇到了上面沒(méi)提到的問(wèn)題順著“硬件—感知—電源—軟件”這四個(gè)方向排查絕大多數(shù)難點(diǎn)都能快速定位。希望這個(gè)項(xiàng)目也能讓你在機(jī)器人開(kāi)發(fā)這條路上找到一個(gè)既好玩又有收獲的切入點(diǎn)。