器人：機(jī)械結(jié)構(gòu)、步態(tài)規(guī)劃與調(diào)試指南)
1. 從“四足”到“三足”P(pán)etoi Quaddle 的設(shè)計(jì)哲學(xué)與核心定位第一次看到 Petoi Quaddle 這個(gè)名字很多人會(huì)下意識(shí)以為它是 Petoi 家又一款四足機(jī)器人。畢竟 Petoi 這個(gè)品牌在創(chuàng)客圈里最出名的就是 Bittle 和 Nybble 這兩只貓狗形態(tài)的四足平臺(tái)。但 Quaddle 走了一條完全不同的路——它是一臺(tái)三輪足式機(jī)器人用三條腿完成行走、轉(zhuǎn)向、平衡和越障。這個(gè)形態(tài)在開(kāi)源機(jī)器人圈子里相當(dāng)少見(jiàn)也正是它最值得聊的地方。Quaddle 解決的核心問(wèn)題其實(shí)很明確在保持足式機(jī)器人越障能力的同時(shí)把機(jī)械復(fù)雜度和成本壓到最低。四足機(jī)器人每條腿都需要獨(dú)立的驅(qū)動(dòng)和協(xié)調(diào)算法12 個(gè)自由度意味著 12 個(gè)舵機(jī)、12 路控制信號(hào)以及一套相當(dāng)復(fù)雜的步態(tài)規(guī)劃。而 Quaddle 用三條腿、更少的舵機(jī)數(shù)量實(shí)現(xiàn)了“能走、能轉(zhuǎn)、能爬小坡、能保持動(dòng)態(tài)平衡”的基礎(chǔ)能力。對(duì)于想入門(mén)足式機(jī)器人、又不想一上來(lái)就被四足步態(tài)勸退的玩家來(lái)說(shuō)這是一個(gè)非常友好的切入點(diǎn)。它適合誰(shuí)我把它歸為三類(lèi)人第一類(lèi)是剛接觸機(jī)器人編程的學(xué)生或愛(ài)好者想用一塊主控板加幾個(gè)舵機(jī)就搭出一臺(tái)會(huì)走路的機(jī)器第二類(lèi)是做 STEM 教學(xué)的老師需要一臺(tái)結(jié)構(gòu)簡(jiǎn)單、原理清晰、方便拆解講解的教具第三類(lèi)是想研究非四足步態(tài)的研究者或極客三足步態(tài)本身就是一個(gè)有趣的課題靜態(tài)穩(wěn)定三角支撐和動(dòng)態(tài)行走之間的切換很有研究?jī)r(jià)值。無(wú)論你是哪一類(lèi)Quaddle 的機(jī)械結(jié)構(gòu)和控制邏輯都足夠透明你能真正看懂它每一步是怎么邁出去的。我拿到這臺(tái)機(jī)器的時(shí)候第一反應(yīng)是“三條腿怎么站得住”。這個(gè)問(wèn)題后面會(huì)詳細(xì)拆但先給個(gè)結(jié)論三足機(jī)器人的穩(wěn)定性來(lái)自重心投影始終落在支撐三角形內(nèi)而 Quaddle 通過(guò)身體重心的主動(dòng)偏移和步態(tài)時(shí)序設(shè)計(jì)讓這個(gè)條件在行走過(guò)程中持續(xù)滿(mǎn)足。聽(tīng)起來(lái)簡(jiǎn)單做起來(lái)全是細(xì)節(jié)。2. 機(jī)械結(jié)構(gòu)拆解三條腿如何撐起一臺(tái)會(huì)走路的機(jī)器2.1 腿部構(gòu)型與自由度分配Quaddle 的每條腿采用了兩自由度設(shè)計(jì)一個(gè)髖關(guān)節(jié)舵機(jī)負(fù)責(zé)腿的前后擺動(dòng)一個(gè)膝關(guān)節(jié)舵機(jī)負(fù)責(zé)腿的抬起和落下。三條腿一共 6 個(gè)舵機(jī)加上身體姿態(tài)調(diào)整可能用到的一到兩個(gè)舵機(jī)整機(jī)舵機(jī)數(shù)量控制在 8 個(gè)以?xún)?nèi)。這個(gè)數(shù)字相比四足機(jī)器人動(dòng)輒 12 個(gè)舵機(jī)成本和裝配難度都下降了一個(gè)檔次。為什么是兩自由度而不是三自由度這里有個(gè)很實(shí)際的取舍。三自由度腿髖偏航、髖俯仰、膝俯仰能讓足端到達(dá)空間任意位置步態(tài)更靈活但控制維度多了一維逆運(yùn)動(dòng)學(xué)求解和步態(tài)規(guī)劃復(fù)雜度顯著上升。Quaddle 的目標(biāo)不是做高動(dòng)態(tài)運(yùn)動(dòng)而是穩(wěn)定行走所以?xún)勺杂啥韧扰浜仙眢w姿態(tài)調(diào)整已經(jīng)夠用。髖關(guān)節(jié)控制步幅膝關(guān)節(jié)控制抬腿高度身體通過(guò)重心偏移來(lái)輔助平衡這套組合在實(shí)際測(cè)試中能覆蓋平地行走、小坡度爬升和緩慢轉(zhuǎn)向。三條腿的布局是前二后一還是前一后二這會(huì)直接影響步態(tài)設(shè)計(jì)。從公開(kāi)資料和常見(jiàn)實(shí)現(xiàn)來(lái)看Quaddle 采用的是前二后一的三角布局也就是前面兩條腿、后面一條腿。這種布局的好處是前方支撐面寬行走時(shí)重心更容易控制在前方視覺(jué)上也更像一臺(tái)“會(huì)走路的三腳架”。后面那條腿負(fù)責(zé)推進(jìn)和支撐前面兩條腿交替邁步形成一種類(lèi)似三角步態(tài)的循環(huán)。2.2 身體框架與重心設(shè)計(jì)Quaddle 的身體框架通常由 3D 打印件或激光切割亞克力板構(gòu)成主控板和電池固定在身體中央偏后的位置。這個(gè)位置不是隨便放的——電池是整機(jī)最重的部件它的位置直接決定了重心高度和前后分布。如果把電池放在身體正中央重心偏高行走時(shí)容易左右搖晃放在偏后位置重心后移前面兩條腿的負(fù)載會(huì)減輕但后腿壓力增大。我在實(shí)際裝配時(shí)試過(guò)三種電池位置正中央、偏后 2 厘米、偏后 4 厘米。實(shí)測(cè)下來(lái)偏后 2 到 3 厘米是最穩(wěn)的。這個(gè)位置讓重心投影在靜態(tài)站立時(shí)落在三角支撐面的幾何中心附近行走時(shí)前后偏移量最小。如果你自己搭可以用一個(gè)簡(jiǎn)單方法找重心把機(jī)器人放在一根細(xì)木棍上左右調(diào)整直到它能平衡不掉下來(lái)那個(gè)點(diǎn)就是重心投影位置然后確保這個(gè)點(diǎn)落在三條腿構(gòu)成的三角形內(nèi)部。注意重心位置會(huì)隨著腿部姿態(tài)變化而改變。抬腿時(shí)那條腿的重量從支撐面移除重心會(huì)向支撐腿一側(cè)偏移。所以靜態(tài)重心調(diào)好只是第一步動(dòng)態(tài)行走時(shí)還需要通過(guò)身體姿態(tài)舵機(jī)或步態(tài)時(shí)序來(lái)補(bǔ)償。2.3 舵機(jī)選型與扭矩計(jì)算舵機(jī)是足式機(jī)器人的肌肉選型直接決定機(jī)器人能不能站起來(lái)、走得動(dòng)。Quaddle 這類(lèi)小型三足機(jī)器人常用的舵機(jī)型號(hào)是SG90 或 MG90S這類(lèi) 9 克微型舵機(jī)。SG90 便宜、輕、夠小但塑料齒輪容易掃齒MG90S 是金屬齒輪版本扭矩稍大耐用性好很多。如果預(yù)算允許我強(qiáng)烈建議直接上 MG90S省得后期反復(fù)拆換。扭矩夠不夠可以粗略算一下。假設(shè)機(jī)器人整機(jī)重量 300 克三條腿分擔(dān)每條腿靜態(tài)支撐約 100 克。髖關(guān)節(jié)舵機(jī)需要克服的力矩等于腿長(zhǎng)乘以腿部重量和地面反作用力產(chǎn)生的力矩。如果腿長(zhǎng) 5 厘米單腿支撐 100 克力矩大約是 0.05 米 × 0.1 千克 × 9.8 ≈ 0.049 牛米換算成常用單位約 0.5 千克·厘米。SG90 在 4.8V 下堵轉(zhuǎn)扭矩約 1.8 千克·厘米看起來(lái)余量很大但那是堵轉(zhuǎn)扭矩實(shí)際工作扭矩通常只有堵轉(zhuǎn)的三分之一到一半。所以SG90 在輕負(fù)載下夠用但一旦機(jī)器人重量超過(guò) 350 克或者需要爬坡就會(huì)明顯吃力。我自己的配置是髖關(guān)節(jié)用 MG90S膝關(guān)節(jié)用 SG90因?yàn)橄リP(guān)節(jié)主要承擔(dān)抬腿動(dòng)作負(fù)載相對(duì)小。這個(gè)混搭方案在成本和性能之間取得了不錯(cuò)的平衡。如果你要做更重的版本可以考慮MG996R這類(lèi)標(biāo)準(zhǔn)舵機(jī)但體積和重量會(huì)大幅增加需要重新設(shè)計(jì)身體框架。3. 控制邏輯與步態(tài)規(guī)劃三足行走的數(shù)學(xué)與直覺(jué)3.1 靜態(tài)三角步態(tài)的基本原理三足機(jī)器人行走的核心約束是任意時(shí)刻至少有三條腿中的兩條著地且重心投影落在著地腿構(gòu)成的支撐區(qū)域內(nèi)。這聽(tīng)起來(lái)像是一句廢話(huà)但它是所有步態(tài)設(shè)計(jì)的基礎(chǔ)。Quaddle 的靜態(tài)步態(tài)通常采用“抬一條腿、移動(dòng)身體、放下腿、換另一條腿”的循環(huán)每一步只抬一條腿另外兩條腿構(gòu)成一條支撐線(xiàn)。具體來(lái)說(shuō)一個(gè)完整的行走周期分為六個(gè)階段前左腿抬起并前擺、前左腿落下、身體重心前移、前右腿抬起并前擺、前右腿落下、后腿調(diào)整。這個(gè)過(guò)程中重心始終在支撐三角形內(nèi)移動(dòng)。你可以把它想象成一個(gè)人用兩根拐杖走路先把一根拐杖往前放身體重心移過(guò)去再移動(dòng)另一根拐杖。Quaddle 的三條腿就是兩根拐杖加一條真腿的組合。為什么不用動(dòng)態(tài)步態(tài)動(dòng)態(tài)步態(tài)允許機(jī)器人只有一條腿著地靠慣性維持平衡速度快但控制難度高。Quaddle 的定位是入門(mén)級(jí)平臺(tái)靜態(tài)步態(tài)更穩(wěn)、更容易調(diào)試、對(duì)傳感器依賴(lài)低所以是更合理的選擇。等你把靜態(tài)步態(tài)玩透了再?lài)L試動(dòng)態(tài)步態(tài)也不遲。3.2 逆運(yùn)動(dòng)學(xué)求解從足端位置反推舵機(jī)角度要讓腿移動(dòng)到指定位置需要用到逆運(yùn)動(dòng)學(xué)。Quaddle 的兩自由度腿可以簡(jiǎn)化為一個(gè)平面二連桿機(jī)構(gòu)髖關(guān)節(jié)到膝關(guān)節(jié)為第一段連桿膝關(guān)節(jié)到足端為第二段連桿。已知足端目標(biāo)位置 (x, y)求髖關(guān)節(jié)角度 θ1 和膝關(guān)節(jié)角度 θ2。設(shè)第一段連桿長(zhǎng)度為 L1第二段為 L2足端到髖關(guān)節(jié)的距離為 r則r sqrt(x^2 y^2) cos(θ2) (L1^2 L2^2 - r^2) / (2 * L1 * L2) θ2 acos(cos(θ2)) θ1 atan2(y, x) - atan2(L2 * sin(θ2), L1 L2 * cos(θ2))這段公式看起來(lái)有點(diǎn)嚇人但實(shí)際寫(xiě)代碼時(shí)就是幾行三角函數(shù)。關(guān)鍵是理解 θ1 和 θ2 的物理意義θ1 決定腿往前伸多少θ2 決定腿彎多少。調(diào)試時(shí)你可以先固定 θ2只改 θ1觀察腿的前后擺動(dòng)再固定 θ1改 θ2觀察腿的抬起落下。這樣分步調(diào)試比一上來(lái)就調(diào)兩個(gè)角度容易得多。實(shí)操心得逆運(yùn)動(dòng)學(xué)算出來(lái)的角度是理論值實(shí)際舵機(jī)安裝時(shí)會(huì)有偏差。我通常會(huì)在代碼里加一個(gè)offset數(shù)組每個(gè)舵機(jī)一個(gè)偏移量通過(guò)實(shí)驗(yàn)校準(zhǔn)。校準(zhǔn)方法是讓機(jī)器人站立手動(dòng)調(diào)整 offset 直到三條腿長(zhǎng)度一致、身體水平。3.3 步態(tài)時(shí)序與舵機(jī)控制信號(hào)步態(tài)時(shí)序決定了每條腿在什么時(shí)刻抬起、什么時(shí)刻放下。Quaddle 的靜態(tài)步態(tài)周期通常在 1 到 2 秒之間太快會(huì)失穩(wěn)太慢看起來(lái)像慢動(dòng)作。我用的是一個(gè) 1.5 秒的周期分為 6 個(gè) 250 毫秒的階段。每個(gè)階段里相關(guān)舵機(jī)從當(dāng)前角度平滑過(guò)渡到目標(biāo)角度過(guò)渡時(shí)間略小于階段時(shí)間留出一點(diǎn)穩(wěn)定時(shí)間。舵機(jī)控制信號(hào)是標(biāo)準(zhǔn)的 PWM 信號(hào)周期 20 毫秒脈寬 500 到 2500 微秒對(duì)應(yīng) 0 到 180 度。主控板通過(guò)定時(shí)器產(chǎn)生多路 PWM分別接到每個(gè)舵機(jī)的信號(hào)線(xiàn)。這里有個(gè)坑舵機(jī)同時(shí)動(dòng)作時(shí)電流會(huì)瞬間拉高如果電源供電不足主控板會(huì)復(fù)位。我的解決方案是舵機(jī)電源和主控電源分開(kāi)供電共地但不共正極或者加一個(gè)大電容緩沖。# 偽代碼示例控制一條腿的髖關(guān)節(jié)和膝關(guān)節(jié) def move_leg(hip_angle, knee_angle, duration_ms): set_pwm(HIP_PIN, angle_to_pulse(hip_angle)) set_pwm(KNEE_PIN, angle_to_pulse(knee_angle)) sleep(duration_ms) def walk_cycle(): # 階段1前左腿抬起 move_leg(hip_left, knee_left_lift, 250) # 階段2前左腿前擺 move_leg(hip_left_forward, knee_left_lift, 250) # 階段3前左腿落下 move_leg(hip_left_forward, knee_left_down, 250) # 階段4-6前右腿重復(fù)類(lèi)似動(dòng)作 ...這段代碼是簡(jiǎn)化版實(shí)際實(shí)現(xiàn)中還需要加入身體姿態(tài)調(diào)整和重心偏移。但核心邏輯就是這樣按時(shí)間順序給舵機(jī)發(fā)送目標(biāo)角度讓腿按預(yù)定軌跡運(yùn)動(dòng)。4. 主控與編程環(huán)境從 Arduino 到圖形化編程4.1 主控板選型與擴(kuò)展能力Quaddle 的主控板通常選用Arduino Nano 或 Arduino Uno這兩款板子 PWM 引腳多、社區(qū)支持好、價(jià)格便宜。Nano 體積更小適合塞進(jìn)機(jī)器人身體里Uno 調(diào)試方便適合前期開(kāi)發(fā)。如果預(yù)算充足也可以上ESP32自帶 WiFi 和藍(lán)牙能實(shí)現(xiàn)手機(jī)遙控和無(wú)線(xiàn)調(diào)試但要注意 ESP32 的 PWM 頻率和舵機(jī)兼容性需要額外配置。主控板需要引出的引腳包括6 路舵機(jī) PWM、電源輸入、可能的傳感器接口超聲波、紅外、IMU。Arduino Nano 有 6 路硬件 PWM剛好夠用但如果要加傳感器可能需要用軟件 PWM 或者換用 PCA9685 舵機(jī)驅(qū)動(dòng)板。PCA9685 是 16 通道 PWM 驅(qū)動(dòng)通過(guò) I2C 控制只占兩個(gè)引腳能同時(shí)驅(qū)動(dòng) 16 個(gè)舵機(jī)是擴(kuò)展性最好的方案。我自己的配置是 Arduino Nano PCA9685舵機(jī)全部接在 PCA9685 上Nano 只負(fù)責(zé)邏輯運(yùn)算和 I2C 通信。這樣電源管理更簡(jiǎn)單舵機(jī)電流不經(jīng)過(guò) Nano避免了復(fù)位問(wèn)題。PCA9685 的供電是獨(dú)立的 5V 2A 電源Nano 用 USB 供電兩者共地。4.2 編程環(huán)境搭建與庫(kù)選擇編程環(huán)境用Arduino IDE就夠了安裝簡(jiǎn)單庫(kù)管理方便。需要安裝的庫(kù)主要是Adafruit_PWMServoDriver如果用了 PCA9685和WireI2C 通信。如果不用 PCA9685直接用Servo庫(kù)也可以但要注意Servo庫(kù)在 Arduino 上最多支持 12 路舵機(jī)且會(huì)占用定時(shí)器資源。代碼結(jié)構(gòu)上我建議分成三個(gè)模塊硬件抽象層封裝舵機(jī)控制、傳感器讀取、步態(tài)層定義步態(tài)時(shí)序和逆運(yùn)動(dòng)學(xué)、應(yīng)用層主循環(huán)、遙控指令解析。這樣分層的好處是換硬件時(shí)只需要改硬件抽象層步態(tài)算法不用動(dòng)調(diào)步態(tài)時(shí)只改步態(tài)層不影響其他部分。// 硬件抽象層示例 void setServoAngle(uint8_t channel, float angle) { uint16_t pulse map(angle, 0, 180, SERVOMIN, SERVOMAX); pwm.setPWM(channel, 0, pulse); } // 步態(tài)層示例 void walkForward(float stepLength) { float hip_angle calculateHipAngle(stepLength); float knee_angle calculateKneeAngle(stepLength); setServoAngle(LEFT_HIP, hip_angle); setServoAngle(LEFT_KNEE, knee_angle); delay(STEP_DURATION); }4.3 圖形化編程與教學(xué)適配如果是用于教學(xué)Arduino IDE 的代碼門(mén)檻可能偏高。這時(shí)候可以用Scratch 或 Blockly這類(lèi)圖形化編程工具通過(guò)串口或藍(lán)牙發(fā)送指令給主控板。主控板固件里預(yù)置好步態(tài)函數(shù)圖形化程序只需要發(fā)送“前進(jìn)”“后退”“左轉(zhuǎn)”“右轉(zhuǎn)”這樣的高層指令。學(xué)生拖拽積木塊就能讓機(jī)器人動(dòng)起來(lái)同時(shí)還能理解“指令-執(zhí)行”的基本邏輯。我試過(guò)用 Scratch 通過(guò)串口控制 Quaddle延遲大約 50 到 100 毫秒對(duì)于慢速步態(tài)來(lái)說(shuō)完全可接受。具體做法是Arduino 固件里解析串口收到的字符F 前進(jìn)、B 后退、L 左轉(zhuǎn)、R 右轉(zhuǎn)、S 停止。Scratch 里用“當(dāng)按下空格鍵”觸發(fā)發(fā)送對(duì)應(yīng)字符。這套方案簡(jiǎn)單可靠學(xué)生很容易上手。注意串口通信時(shí)Arduino 的Serial.read()是非阻塞的但步態(tài)函數(shù)里的delay()會(huì)阻塞主循環(huán)導(dǎo)致指令響應(yīng)不及時(shí)。解決辦法是把步態(tài)函數(shù)改成狀態(tài)機(jī)形式每次主循環(huán)只執(zhí)行一小步不用delay()。這個(gè)改動(dòng)稍微復(fù)雜一點(diǎn)但能顯著提升響應(yīng)速度。5. 裝配調(diào)試與常見(jiàn)問(wèn)題排查5.1 裝配順序與關(guān)鍵細(xì)節(jié)裝配 Quaddle 的順序很重要順序錯(cuò)了可能要拆了重來(lái)。我的建議是先裝腿、再裝身體、最后接電線(xiàn)和主控。每條腿先單獨(dú)組裝好確認(rèn)髖關(guān)節(jié)和膝關(guān)節(jié)轉(zhuǎn)動(dòng)順暢、沒(méi)有卡頓再裝到身體上。裝腿的時(shí)候注意左右對(duì)稱(chēng)前左腿和前右腿的舵機(jī)安裝方向要鏡像否則代碼里角度正負(fù)會(huì)搞混。舵機(jī)安裝前一定要校準(zhǔn)中位。方法是給舵機(jī)發(fā)送 90 度信號(hào)等它轉(zhuǎn)到中位后再安裝舵盤(pán)和連桿。如果先裝好再校準(zhǔn)舵盤(pán)位置可能不對(duì)導(dǎo)致腿的初始姿態(tài)歪斜。校準(zhǔn)中位后把腿擺到直立位置再固定連桿。這樣上電后機(jī)器人就能保持直立不會(huì)一通電就摔倒。電線(xiàn)管理也是個(gè)細(xì)節(jié)。舵機(jī)線(xiàn)又細(xì)又多如果不整理行走時(shí)線(xiàn)會(huì)纏在一起甚至被腿夾住。我用的是扎帶加熱縮管把三組舵機(jī)線(xiàn)分別捆好沿著身體框架走線(xiàn)最后集中到主控板附近。留一點(diǎn)余量讓腿能自由活動(dòng)但不要留太多否則線(xiàn)會(huì)晃來(lái)晃去。5.2 常見(jiàn)問(wèn)題速查表問(wèn)題現(xiàn)象可能原因排查方法解決方案上電后機(jī)器人立即摔倒舵機(jī)中位未校準(zhǔn)或腿初始角度不對(duì)檢查代碼中初始角度是否為 90 度重新校準(zhǔn)舵機(jī)中位調(diào)整初始角度行走時(shí)左右搖晃嚴(yán)重重心偏高或重心投影偏離支撐三角形手動(dòng)測(cè)試重心位置降低電池位置調(diào)整身體姿態(tài)某條腿不動(dòng)或抖動(dòng)舵機(jī)線(xiàn)接觸不良或舵機(jī)損壞交換舵機(jī)信號(hào)線(xiàn)測(cè)試重新插緊線(xiàn)纜更換舵機(jī)主控板頻繁復(fù)位舵機(jī)電流過(guò)大導(dǎo)致電壓跌落用萬(wàn)用表測(cè)電源電壓舵機(jī)獨(dú)立供電加電容緩沖步態(tài)看起來(lái)不協(xié)調(diào)步態(tài)時(shí)序參數(shù)不合適逐步調(diào)整各階段時(shí)間增加穩(wěn)定階段時(shí)間降低速度轉(zhuǎn)向時(shí)容易翻倒轉(zhuǎn)向時(shí)重心偏移過(guò)大觀察轉(zhuǎn)向時(shí)重心投影減小轉(zhuǎn)向角度增加支撐腿調(diào)整5.3 調(diào)試心得與避坑經(jīng)驗(yàn)調(diào)試 Quaddle 最耗時(shí)的部分不是寫(xiě)代碼而是反復(fù)試錯(cuò)找參數(shù)。步態(tài)周期、抬腿高度、步幅、重心偏移量這些參數(shù)沒(méi)有標(biāo)準(zhǔn)答案取決于你的機(jī)器人重量、腿長(zhǎng)、舵機(jī)性能。我的經(jīng)驗(yàn)是先調(diào)靜態(tài)站立再調(diào)單腿動(dòng)作最后調(diào)完整步態(tài)。靜態(tài)站立穩(wěn)了單腿動(dòng)作順了完整步態(tài)就是水到渠成的事。另一個(gè)坑是舵機(jī)一致性。便宜的舵機(jī)即使同型號(hào)實(shí)際角度也會(huì)有偏差。我買(mǎi)了 10 個(gè) SG90實(shí)測(cè)中位角度從 87 度到 93 度都有。如果代碼里統(tǒng)一用 90 度三條腿就會(huì)不一樣長(zhǎng)。解決辦法是給每個(gè)舵機(jī)單獨(dú)標(biāo)定 offset在代碼里補(bǔ)償。標(biāo)定方法很簡(jiǎn)單發(fā)送 90 度用量角器測(cè)實(shí)際角度差值就是 offset。還有一點(diǎn)不要一上來(lái)就追求速度。我見(jiàn)過(guò)很多人把步態(tài)周期調(diào)到 0.5 秒結(jié)果機(jī)器人走兩步就翻。三足靜態(tài)步態(tài)的物理極限就在那里重心移動(dòng)需要時(shí)間抬腿落下需要時(shí)間。1.5 秒的周期看起來(lái)慢但穩(wěn)定可靠。等你有經(jīng)驗(yàn)了可以嘗試 1 秒甚至 0.8 秒但前提是重心控制和支撐面設(shè)計(jì)都做到位。6. 擴(kuò)展玩法與進(jìn)階方向6.1 傳感器融合與自主行走基礎(chǔ)版 Quaddle 只能執(zhí)行預(yù)設(shè)步態(tài)加上傳感器就能實(shí)現(xiàn)自主行為。最便宜的方案是超聲波模塊裝在身體前方檢測(cè)障礙物距離距離小于閾值就轉(zhuǎn)向。超聲波模塊只要幾塊錢(qián)Arduino 庫(kù)也成熟半天就能搞定。稍微進(jìn)階一點(diǎn)可以用紅外測(cè)距響應(yīng)更快但檢測(cè)范圍窄。再往上就是IMU慣性測(cè)量單元用 MPU6050 這類(lèi)六軸傳感器檢測(cè)身體傾斜實(shí)時(shí)調(diào)整重心讓機(jī)器人在斜坡上也能保持平衡。IMU 的用法稍微復(fù)雜一點(diǎn)。MPU6050 輸出加速度和角速度需要通過(guò)互補(bǔ)濾波或卡爾曼濾波融合出姿態(tài)角。姿態(tài)角反饋給步態(tài)控制器當(dāng)身體前傾時(shí)加快前腿邁步當(dāng)身體側(cè)傾時(shí)調(diào)整支撐腿角度。這套邏輯寫(xiě)起來(lái)不復(fù)雜但調(diào)參需要耐心。我建議先用串口打印姿態(tài)角手動(dòng)傾斜機(jī)器人觀察數(shù)值變化確認(rèn)傳感器工作正常后再接入控制循環(huán)。6.2 無(wú)線(xiàn)遙控與手機(jī) App給 Quaddle 加無(wú)線(xiàn)遙控最直接的是藍(lán)牙模塊 HC-05 或 HC-06手機(jī)裝個(gè)藍(lán)牙串口 App發(fā)送字符指令。HC-05 支持主從模式可以配對(duì)手機(jī)HC-06 只能從模式但更便宜。接線(xiàn)也簡(jiǎn)單VCC、GND、TX、RX 四根線(xiàn)TX 接 Arduino 的 RXRX 接 Arduino 的 TX。注意電平匹配HC-05 是 3.3V 邏輯Arduino 是 5V直接接可能燒模塊最好加電平轉(zhuǎn)換或者用分壓電阻。如果想做手機(jī) App 控制可以用MIT App Inventor拖拽界面通過(guò)藍(lán)牙發(fā)送指令。App Inventor 有現(xiàn)成的藍(lán)牙組件半小時(shí)就能做出一個(gè)帶方向按鈕的控制界面。我做過(guò)一個(gè)四個(gè)方向按鈕加一個(gè)停止按鈕通過(guò)藍(lán)牙發(fā)送 F、B、L、R、S。延遲大約 100 毫秒控制慢速步態(tài)完全夠用。6.3 步態(tài)算法進(jìn)階從靜態(tài)到動(dòng)態(tài)靜態(tài)步態(tài)玩熟了可以嘗試動(dòng)態(tài)步態(tài)。動(dòng)態(tài)步態(tài)的核心是讓機(jī)器人利用慣性維持平衡允許只有一條腿著地。三足機(jī)器人的動(dòng)態(tài)步態(tài)比較少見(jiàn)但原理和雙足機(jī)器人類(lèi)似身體前傾后腿蹬地前腿快速前擺利用重力分量提供前進(jìn)動(dòng)力。這種步態(tài)速度快、動(dòng)作流暢但控制難度高需要精確的時(shí)序和重心控制。另一個(gè)進(jìn)階方向是自適應(yīng)步態(tài)。根據(jù)地面情況自動(dòng)調(diào)整抬腿高度和步幅。比如在粗糙地面上抬高腿避免絆倒在光滑地面上減小步幅防止打滑。這需要傳感器反饋和實(shí)時(shí)計(jì)算對(duì)主控性能有一定要求。ESP32 或 STM32 這類(lèi)性能更強(qiáng)的板子更適合做這個(gè)。我個(gè)人覺(jué)得Quaddle 最大的價(jià)值不在于它現(xiàn)在能做什么而在于它足夠簡(jiǎn)單讓你能看懂每一步的原理然后自己動(dòng)手改。你可以改步態(tài)、加傳感器、換主控、重新設(shè)計(jì)身體結(jié)構(gòu)。它是一塊跳板不是終點(diǎn)。我自己的 Quaddle 已經(jīng)改了三次結(jié)構(gòu)、重寫(xiě)了兩次步態(tài)代碼每次都有新發(fā)現(xiàn)。這種“能拆能改能折騰”的特性才是開(kāi)源硬件最吸引人的地方。 Petoi Quaddle 三足機(jī)器人：機(jī)械結(jié)構(gòu)、步態(tài)規(guī)劃與調(diào)試指南
1. 從“四足”到“三足”P(pán)etoi Quaddle 的設(shè)計(jì)哲學(xué)與核心定位第一次看到 Petoi Quaddle 這個(gè)名字很多人會(huì)下意識(shí)以為它是 Petoi 家又一款四足機(jī)器人。畢竟 Petoi 這個(gè)品牌在創(chuàng)客圈里最出名的就是 Bittle 和 Nybble 這兩只貓狗形態(tài)的四足平臺(tái)。但 Quaddle 走了一條完全不同的路——它是一臺(tái)三輪足式機(jī)器人用三條腿完成行走、轉(zhuǎn)向、平衡和越障。這個(gè)形態(tài)在開(kāi)源機(jī)器人圈子里相當(dāng)少見(jiàn)也正是它最值得聊的地方。Quaddle 解決的核心問(wèn)題其實(shí)很明確在保持足式機(jī)器人越障能力的同時(shí)把機(jī)械復(fù)雜度和成本壓到最低。四足機(jī)器人每條腿都需要獨(dú)立的驅(qū)動(dòng)和協(xié)調(diào)算法12 個(gè)自由度意味著 12 個(gè)舵機(jī)、12 路控制信號(hào)以及一套相當(dāng)復(fù)雜的步態(tài)規(guī)劃。而 Quaddle 用三條腿、更少的舵機(jī)數(shù)量實(shí)現(xiàn)了“能走、能轉(zhuǎn)、能爬小坡、能保持動(dòng)態(tài)平衡”的基礎(chǔ)能力。對(duì)于想入門(mén)足式機(jī)器人、又不想一上來(lái)就被四足步態(tài)勸退的玩家來(lái)說(shuō)這是一個(gè)非常友好的切入點(diǎn)。它適合誰(shuí)我把它歸為三類(lèi)人第一類(lèi)是剛接觸機(jī)器人編程的學(xué)生或愛(ài)好者想用一塊主控板加幾個(gè)舵機(jī)就搭出一臺(tái)會(huì)走路的機(jī)器第二類(lèi)是做 STEM 教學(xué)的老師需要一臺(tái)結(jié)構(gòu)簡(jiǎn)單、原理清晰、方便拆解講解的教具第三類(lèi)是想研究非四足步態(tài)的研究者或極客三足步態(tài)本身就是一個(gè)有趣的課題靜態(tài)穩(wěn)定三角支撐和動(dòng)態(tài)行走之間的切換很有研究?jī)r(jià)值。無(wú)論你是哪一類(lèi)Quaddle 的機(jī)械結(jié)構(gòu)和控制邏輯都足夠透明你能真正看懂它每一步是怎么邁出去的。我拿到這臺(tái)機(jī)器的時(shí)候第一反應(yīng)是“三條腿怎么站得住”。這個(gè)問(wèn)題后面會(huì)詳細(xì)拆但先給個(gè)結(jié)論三足機(jī)器人的穩(wěn)定性來(lái)自重心投影始終落在支撐三角形內(nèi)而 Quaddle 通過(guò)身體重心的主動(dòng)偏移和步態(tài)時(shí)序設(shè)計(jì)讓這個(gè)條件在行走過(guò)程中持續(xù)滿(mǎn)足。聽(tīng)起來(lái)簡(jiǎn)單做起來(lái)全是細(xì)節(jié)。2. 機(jī)械結(jié)構(gòu)拆解三條腿如何撐起一臺(tái)會(huì)走路的機(jī)器2.1 腿部構(gòu)型與自由度分配Quaddle 的每條腿采用了兩自由度設(shè)計(jì)一個(gè)髖關(guān)節(jié)舵機(jī)負(fù)責(zé)腿的前后擺動(dòng)一個(gè)膝關(guān)節(jié)舵機(jī)負(fù)責(zé)腿的抬起和落下。三條腿一共 6 個(gè)舵機(jī)加上身體姿態(tài)調(diào)整可能用到的一到兩個(gè)舵機(jī)整機(jī)舵機(jī)數(shù)量控制在 8 個(gè)以?xún)?nèi)。這個(gè)數(shù)字相比四足機(jī)器人動(dòng)輒 12 個(gè)舵機(jī)成本和裝配難度都下降了一個(gè)檔次。為什么是兩自由度而不是三自由度這里有個(gè)很實(shí)際的取舍。三自由度腿髖偏航、髖俯仰、膝俯仰能讓足端到達(dá)空間任意位置步態(tài)更靈活但控制維度多了一維逆運(yùn)動(dòng)學(xué)求解和步態(tài)規(guī)劃復(fù)雜度顯著上升。Quaddle 的目標(biāo)不是做高動(dòng)態(tài)運(yùn)動(dòng)而是穩(wěn)定行走所以?xún)勺杂啥韧扰浜仙眢w姿態(tài)調(diào)整已經(jīng)夠用。髖關(guān)節(jié)控制步幅膝關(guān)節(jié)控制抬腿高度身體通過(guò)重心偏移來(lái)輔助平衡這套組合在實(shí)際測(cè)試中能覆蓋平地行走、小坡度爬升和緩慢轉(zhuǎn)向。三條腿的布局是前二后一還是前一后二這會(huì)直接影響步態(tài)設(shè)計(jì)。從公開(kāi)資料和常見(jiàn)實(shí)現(xiàn)來(lái)看Quaddle 采用的是前二后一的三角布局也就是前面兩條腿、后面一條腿。這種布局的好處是前方支撐面寬行走時(shí)重心更容易控制在前方視覺(jué)上也更像一臺(tái)“會(huì)走路的三腳架”。后面那條腿負(fù)責(zé)推進(jìn)和支撐前面兩條腿交替邁步形成一種類(lèi)似三角步態(tài)的循環(huán)。2.2 身體框架與重心設(shè)計(jì)Quaddle 的身體框架通常由 3D 打印件或激光切割亞克力板構(gòu)成主控板和電池固定在身體中央偏后的位置。這個(gè)位置不是隨便放的——電池是整機(jī)最重的部件它的位置直接決定了重心高度和前后分布。如果把電池放在身體正中央重心偏高行走時(shí)容易左右搖晃放在偏后位置重心后移前面兩條腿的負(fù)載會(huì)減輕但后腿壓力增大。我在實(shí)際裝配時(shí)試過(guò)三種電池位置正中央、偏后 2 厘米、偏后 4 厘米。實(shí)測(cè)下來(lái)偏后 2 到 3 厘米是最穩(wěn)的。這個(gè)位置讓重心投影在靜態(tài)站立時(shí)落在三角支撐面的幾何中心附近行走時(shí)前后偏移量最小。如果你自己搭可以用一個(gè)簡(jiǎn)單方法找重心把機(jī)器人放在一根細(xì)木棍上左右調(diào)整直到它能平衡不掉下來(lái)那個(gè)點(diǎn)就是重心投影位置然后確保這個(gè)點(diǎn)落在三條腿構(gòu)成的三角形內(nèi)部。注意重心位置會(huì)隨著腿部姿態(tài)變化而改變。抬腿時(shí)那條腿的重量從支撐面移除重心會(huì)向支撐腿一側(cè)偏移。所以靜態(tài)重心調(diào)好只是第一步動(dòng)態(tài)行走時(shí)還需要通過(guò)身體姿態(tài)舵機(jī)或步態(tài)時(shí)序來(lái)補(bǔ)償。2.3 舵機(jī)選型與扭矩計(jì)算舵機(jī)是足式機(jī)器人的肌肉選型直接決定機(jī)器人能不能站起來(lái)、走得動(dòng)。Quaddle 這類(lèi)小型三足機(jī)器人常用的舵機(jī)型號(hào)是SG90 或 MG90S這類(lèi) 9 克微型舵機(jī)。SG90 便宜、輕、夠小但塑料齒輪容易掃齒MG90S 是金屬齒輪版本扭矩稍大耐用性好很多。如果預(yù)算允許我強(qiáng)烈建議直接上 MG90S省得后期反復(fù)拆換。扭矩夠不夠可以粗略算一下。假設(shè)機(jī)器人整機(jī)重量 300 克三條腿分擔(dān)每條腿靜態(tài)支撐約 100 克。髖關(guān)節(jié)舵機(jī)需要克服的力矩等于腿長(zhǎng)乘以腿部重量和地面反作用力產(chǎn)生的力矩。如果腿長(zhǎng) 5 厘米單腿支撐 100 克力矩大約是 0.05 米 × 0.1 千克 × 9.8 ≈ 0.049 牛米換算成常用單位約 0.5 千克·厘米。SG90 在 4.8V 下堵轉(zhuǎn)扭矩約 1.8 千克·厘米看起來(lái)余量很大但那是堵轉(zhuǎn)扭矩實(shí)際工作扭矩通常只有堵轉(zhuǎn)的三分之一到一半。所以SG90 在輕負(fù)載下夠用但一旦機(jī)器人重量超過(guò) 350 克或者需要爬坡就會(huì)明顯吃力。我自己的配置是髖關(guān)節(jié)用 MG90S膝關(guān)節(jié)用 SG90因?yàn)橄リP(guān)節(jié)主要承擔(dān)抬腿動(dòng)作負(fù)載相對(duì)小。這個(gè)混搭方案在成本和性能之間取得了不錯(cuò)的平衡。如果你要做更重的版本可以考慮MG996R這類(lèi)標(biāo)準(zhǔn)舵機(jī)但體積和重量會(huì)大幅增加需要重新設(shè)計(jì)身體框架。3. 控制邏輯與步態(tài)規(guī)劃三足行走的數(shù)學(xué)與直覺(jué)3.1 靜態(tài)三角步態(tài)的基本原理三足機(jī)器人行走的核心約束是任意時(shí)刻至少有三條腿中的兩條著地且重心投影落在著地腿構(gòu)成的支撐區(qū)域內(nèi)。這聽(tīng)起來(lái)像是一句廢話(huà)但它是所有步態(tài)設(shè)計(jì)的基礎(chǔ)。Quaddle 的靜態(tài)步態(tài)通常采用“抬一條腿、移動(dòng)身體、放下腿、換另一條腿”的循環(huán)每一步只抬一條腿另外兩條腿構(gòu)成一條支撐線(xiàn)。具體來(lái)說(shuō)一個(gè)完整的行走周期分為六個(gè)階段前左腿抬起并前擺、前左腿落下、身體重心前移、前右腿抬起并前擺、前右腿落下、后腿調(diào)整。這個(gè)過(guò)程中重心始終在支撐三角形內(nèi)移動(dòng)。你可以把它想象成一個(gè)人用兩根拐杖走路先把一根拐杖往前放身體重心移過(guò)去再移動(dòng)另一根拐杖。Quaddle 的三條腿就是兩根拐杖加一條真腿的組合。為什么不用動(dòng)態(tài)步態(tài)動(dòng)態(tài)步態(tài)允許機(jī)器人只有一條腿著地靠慣性維持平衡速度快但控制難度高。Quaddle 的定位是入門(mén)級(jí)平臺(tái)靜態(tài)步態(tài)更穩(wěn)、更容易調(diào)試、對(duì)傳感器依賴(lài)低所以是更合理的選擇。等你把靜態(tài)步態(tài)玩透了再?lài)L試動(dòng)態(tài)步態(tài)也不遲。3.2 逆運(yùn)動(dòng)學(xué)求解從足端位置反推舵機(jī)角度要讓腿移動(dòng)到指定位置需要用到逆運(yùn)動(dòng)學(xué)。Quaddle 的兩自由度腿可以簡(jiǎn)化為一個(gè)平面二連桿機(jī)構(gòu)髖關(guān)節(jié)到膝關(guān)節(jié)為第一段連桿膝關(guān)節(jié)到足端為第二段連桿。已知足端目標(biāo)位置 (x, y)求髖關(guān)節(jié)角度 θ1 和膝關(guān)節(jié)角度 θ2。設(shè)第一段連桿長(zhǎng)度為 L1第二段為 L2足端到髖關(guān)節(jié)的距離為 r則r sqrt(x^2 y^2) cos(θ2) (L1^2 L2^2 - r^2) / (2 * L1 * L2) θ2 acos(cos(θ2)) θ1 atan2(y, x) - atan2(L2 * sin(θ2), L1 L2 * cos(θ2))這段公式看起來(lái)有點(diǎn)嚇人但實(shí)際寫(xiě)代碼時(shí)就是幾行三角函數(shù)。關(guān)鍵是理解 θ1 和 θ2 的物理意義θ1 決定腿往前伸多少θ2 決定腿彎多少。調(diào)試時(shí)你可以先固定 θ2只改 θ1觀察腿的前后擺動(dòng)再固定 θ1改 θ2觀察腿的抬起落下。這樣分步調(diào)試比一上來(lái)就調(diào)兩個(gè)角度容易得多。實(shí)操心得逆運(yùn)動(dòng)學(xué)算出來(lái)的角度是理論值實(shí)際舵機(jī)安裝時(shí)會(huì)有偏差。我通常會(huì)在代碼里加一個(gè)offset數(shù)組每個(gè)舵機(jī)一個(gè)偏移量通過(guò)實(shí)驗(yàn)校準(zhǔn)。校準(zhǔn)方法是讓機(jī)器人站立手動(dòng)調(diào)整 offset 直到三條腿長(zhǎng)度一致、身體水平。3.3 步態(tài)時(shí)序與舵機(jī)控制信號(hào)步態(tài)時(shí)序決定了每條腿在什么時(shí)刻抬起、什么時(shí)刻放下。Quaddle 的靜態(tài)步態(tài)周期通常在 1 到 2 秒之間太快會(huì)失穩(wěn)太慢看起來(lái)像慢動(dòng)作。我用的是一個(gè) 1.5 秒的周期分為 6 個(gè) 250 毫秒的階段。每個(gè)階段里相關(guān)舵機(jī)從當(dāng)前角度平滑過(guò)渡到目標(biāo)角度過(guò)渡時(shí)間略小于階段時(shí)間留出一點(diǎn)穩(wěn)定時(shí)間。舵機(jī)控制信號(hào)是標(biāo)準(zhǔn)的 PWM 信號(hào)周期 20 毫秒脈寬 500 到 2500 微秒對(duì)應(yīng) 0 到 180 度。主控板通過(guò)定時(shí)器產(chǎn)生多路 PWM分別接到每個(gè)舵機(jī)的信號(hào)線(xiàn)。這里有個(gè)坑舵機(jī)同時(shí)動(dòng)作時(shí)電流會(huì)瞬間拉高如果電源供電不足主控板會(huì)復(fù)位。我的解決方案是舵機(jī)電源和主控電源分開(kāi)供電共地但不共正極或者加一個(gè)大電容緩沖。# 偽代碼示例控制一條腿的髖關(guān)節(jié)和膝關(guān)節(jié) def move_leg(hip_angle, knee_angle, duration_ms): set_pwm(HIP_PIN, angle_to_pulse(hip_angle)) set_pwm(KNEE_PIN, angle_to_pulse(knee_angle)) sleep(duration_ms) def walk_cycle(): # 階段1前左腿抬起 move_leg(hip_left, knee_left_lift, 250) # 階段2前左腿前擺 move_leg(hip_left_forward, knee_left_lift, 250) # 階段3前左腿落下 move_leg(hip_left_forward, knee_left_down, 250) # 階段4-6前右腿重復(fù)類(lèi)似動(dòng)作 ...這段代碼是簡(jiǎn)化版實(shí)際實(shí)現(xiàn)中還需要加入身體姿態(tài)調(diào)整和重心偏移。但核心邏輯就是這樣按時(shí)間順序給舵機(jī)發(fā)送目標(biāo)角度讓腿按預(yù)定軌跡運(yùn)動(dòng)。4. 主控與編程環(huán)境從 Arduino 到圖形化編程4.1 主控板選型與擴(kuò)展能力Quaddle 的主控板通常選用Arduino Nano 或 Arduino Uno這兩款板子 PWM 引腳多、社區(qū)支持好、價(jià)格便宜。Nano 體積更小適合塞進(jìn)機(jī)器人身體里Uno 調(diào)試方便適合前期開(kāi)發(fā)。如果預(yù)算充足也可以上ESP32自帶 WiFi 和藍(lán)牙能實(shí)現(xiàn)手機(jī)遙控和無(wú)線(xiàn)調(diào)試但要注意 ESP32 的 PWM 頻率和舵機(jī)兼容性需要額外配置。主控板需要引出的引腳包括6 路舵機(jī) PWM、電源輸入、可能的傳感器接口超聲波、紅外、IMU。Arduino Nano 有 6 路硬件 PWM剛好夠用但如果要加傳感器可能需要用軟件 PWM 或者換用 PCA9685 舵機(jī)驅(qū)動(dòng)板。PCA9685 是 16 通道 PWM 驅(qū)動(dòng)通過(guò) I2C 控制只占兩個(gè)引腳能同時(shí)驅(qū)動(dòng) 16 個(gè)舵機(jī)是擴(kuò)展性最好的方案。我自己的配置是 Arduino Nano PCA9685舵機(jī)全部接在 PCA9685 上Nano 只負(fù)責(zé)邏輯運(yùn)算和 I2C 通信。這樣電源管理更簡(jiǎn)單舵機(jī)電流不經(jīng)過(guò) Nano避免了復(fù)位問(wèn)題。PCA9685 的供電是獨(dú)立的 5V 2A 電源Nano 用 USB 供電兩者共地。4.2 編程環(huán)境搭建與庫(kù)選擇編程環(huán)境用Arduino IDE就夠了安裝簡(jiǎn)單庫(kù)管理方便。需要安裝的庫(kù)主要是Adafruit_PWMServoDriver如果用了 PCA9685和WireI2C 通信。如果不用 PCA9685直接用Servo庫(kù)也可以但要注意Servo庫(kù)在 Arduino 上最多支持 12 路舵機(jī)且會(huì)占用定時(shí)器資源。代碼結(jié)構(gòu)上我建議分成三個(gè)模塊硬件抽象層封裝舵機(jī)控制、傳感器讀取、步態(tài)層定義步態(tài)時(shí)序和逆運(yùn)動(dòng)學(xué)、應(yīng)用層主循環(huán)、遙控指令解析。這樣分層的好處是換硬件時(shí)只需要改硬件抽象層步態(tài)算法不用動(dòng)調(diào)步態(tài)時(shí)只改步態(tài)層不影響其他部分。// 硬件抽象層示例 void setServoAngle(uint8_t channel, float angle) { uint16_t pulse map(angle, 0, 180, SERVOMIN, SERVOMAX); pwm.setPWM(channel, 0, pulse); } // 步態(tài)層示例 void walkForward(float stepLength) { float hip_angle calculateHipAngle(stepLength); float knee_angle calculateKneeAngle(stepLength); setServoAngle(LEFT_HIP, hip_angle); setServoAngle(LEFT_KNEE, knee_angle); delay(STEP_DURATION); }4.3 圖形化編程與教學(xué)適配如果是用于教學(xué)Arduino IDE 的代碼門(mén)檻可能偏高。這時(shí)候可以用Scratch 或 Blockly這類(lèi)圖形化編程工具通過(guò)串口或藍(lán)牙發(fā)送指令給主控板。主控板固件里預(yù)置好步態(tài)函數(shù)圖形化程序只需要發(fā)送“前進(jìn)”“后退”“左轉(zhuǎn)”“右轉(zhuǎn)”這樣的高層指令。學(xué)生拖拽積木塊就能讓機(jī)器人動(dòng)起來(lái)同時(shí)還能理解“指令-執(zhí)行”的基本邏輯。我試過(guò)用 Scratch 通過(guò)串口控制 Quaddle延遲大約 50 到 100 毫秒對(duì)于慢速步態(tài)來(lái)說(shuō)完全可接受。具體做法是Arduino 固件里解析串口收到的字符F 前進(jìn)、B 后退、L 左轉(zhuǎn)、R 右轉(zhuǎn)、S 停止。Scratch 里用“當(dāng)按下空格鍵”觸發(fā)發(fā)送對(duì)應(yīng)字符。這套方案簡(jiǎn)單可靠學(xué)生很容易上手。注意串口通信時(shí)Arduino 的Serial.read()是非阻塞的但步態(tài)函數(shù)里的delay()會(huì)阻塞主循環(huán)導(dǎo)致指令響應(yīng)不及時(shí)。解決辦法是把步態(tài)函數(shù)改成狀態(tài)機(jī)形式每次主循環(huán)只執(zhí)行一小步不用delay()。這個(gè)改動(dòng)稍微復(fù)雜一點(diǎn)但能顯著提升響應(yīng)速度。5. 裝配調(diào)試與常見(jiàn)問(wèn)題排查5.1 裝配順序與關(guān)鍵細(xì)節(jié)裝配 Quaddle 的順序很重要順序錯(cuò)了可能要拆了重來(lái)。我的建議是先裝腿、再裝身體、最后接電線(xiàn)和主控。每條腿先單獨(dú)組裝好確認(rèn)髖關(guān)節(jié)和膝關(guān)節(jié)轉(zhuǎn)動(dòng)順暢、沒(méi)有卡頓再裝到身體上。裝腿的時(shí)候注意左右對(duì)稱(chēng)前左腿和前右腿的舵機(jī)安裝方向要鏡像否則代碼里角度正負(fù)會(huì)搞混。舵機(jī)安裝前一定要校準(zhǔn)中位。方法是給舵機(jī)發(fā)送 90 度信號(hào)等它轉(zhuǎn)到中位后再安裝舵盤(pán)和連桿。如果先裝好再校準(zhǔn)舵盤(pán)位置可能不對(duì)導(dǎo)致腿的初始姿態(tài)歪斜。校準(zhǔn)中位后把腿擺到直立位置再固定連桿。這樣上電后機(jī)器人就能保持直立不會(huì)一通電就摔倒。電線(xiàn)管理也是個(gè)細(xì)節(jié)。舵機(jī)線(xiàn)又細(xì)又多如果不整理行走時(shí)線(xiàn)會(huì)纏在一起甚至被腿夾住。我用的是扎帶加熱縮管把三組舵機(jī)線(xiàn)分別捆好沿著身體框架走線(xiàn)最后集中到主控板附近。留一點(diǎn)余量讓腿能自由活動(dòng)但不要留太多否則線(xiàn)會(huì)晃來(lái)晃去。5.2 常見(jiàn)問(wèn)題速查表問(wèn)題現(xiàn)象可能原因排查方法解決方案上電后機(jī)器人立即摔倒舵機(jī)中位未校準(zhǔn)或腿初始角度不對(duì)檢查代碼中初始角度是否為 90 度重新校準(zhǔn)舵機(jī)中位調(diào)整初始角度行走時(shí)左右搖晃嚴(yán)重重心偏高或重心投影偏離支撐三角形手動(dòng)測(cè)試重心位置降低電池位置調(diào)整身體姿態(tài)某條腿不動(dòng)或抖動(dòng)舵機(jī)線(xiàn)接觸不良或舵機(jī)損壞交換舵機(jī)信號(hào)線(xiàn)測(cè)試重新插緊線(xiàn)纜更換舵機(jī)主控板頻繁復(fù)位舵機(jī)電流過(guò)大導(dǎo)致電壓跌落用萬(wàn)用表測(cè)電源電壓舵機(jī)獨(dú)立供電加電容緩沖步態(tài)看起來(lái)不協(xié)調(diào)步態(tài)時(shí)序參數(shù)不合適逐步調(diào)整各階段時(shí)間增加穩(wěn)定階段時(shí)間降低速度轉(zhuǎn)向時(shí)容易翻倒轉(zhuǎn)向時(shí)重心偏移過(guò)大觀察轉(zhuǎn)向時(shí)重心投影減小轉(zhuǎn)向角度增加支撐腿調(diào)整5.3 調(diào)試心得與避坑經(jīng)驗(yàn)調(diào)試 Quaddle 最耗時(shí)的部分不是寫(xiě)代碼而是反復(fù)試錯(cuò)找參數(shù)。步態(tài)周期、抬腿高度、步幅、重心偏移量這些參數(shù)沒(méi)有標(biāo)準(zhǔn)答案取決于你的機(jī)器人重量、腿長(zhǎng)、舵機(jī)性能。我的經(jīng)驗(yàn)是先調(diào)靜態(tài)站立再調(diào)單腿動(dòng)作最后調(diào)完整步態(tài)。靜態(tài)站立穩(wěn)了單腿動(dòng)作順了完整步態(tài)就是水到渠成的事。另一個(gè)坑是舵機(jī)一致性。便宜的舵機(jī)即使同型號(hào)實(shí)際角度也會(huì)有偏差。我買(mǎi)了 10 個(gè) SG90實(shí)測(cè)中位角度從 87 度到 93 度都有。如果代碼里統(tǒng)一用 90 度三條腿就會(huì)不一樣長(zhǎng)。解決辦法是給每個(gè)舵機(jī)單獨(dú)標(biāo)定 offset在代碼里補(bǔ)償。標(biāo)定方法很簡(jiǎn)單發(fā)送 90 度用量角器測(cè)實(shí)際角度差值就是 offset。還有一點(diǎn)不要一上來(lái)就追求速度。我見(jiàn)過(guò)很多人把步態(tài)周期調(diào)到 0.5 秒結(jié)果機(jī)器人走兩步就翻。三足靜態(tài)步態(tài)的物理極限就在那里重心移動(dòng)需要時(shí)間抬腿落下需要時(shí)間。1.5 秒的周期看起來(lái)慢但穩(wěn)定可靠。等你有經(jīng)驗(yàn)了可以嘗試 1 秒甚至 0.8 秒但前提是重心控制和支撐面設(shè)計(jì)都做到位。6. 擴(kuò)展玩法與進(jìn)階方向6.1 傳感器融合與自主行走基礎(chǔ)版 Quaddle 只能執(zhí)行預(yù)設(shè)步態(tài)加上傳感器就能實(shí)現(xiàn)自主行為。最便宜的方案是超聲波模塊裝在身體前方檢測(cè)障礙物距離距離小于閾值就轉(zhuǎn)向。超聲波模塊只要幾塊錢(qián)Arduino 庫(kù)也成熟半天就能搞定。稍微進(jìn)階一點(diǎn)可以用紅外測(cè)距響應(yīng)更快但檢測(cè)范圍窄。再往上就是IMU慣性測(cè)量單元用 MPU6050 這類(lèi)六軸傳感器檢測(cè)身體傾斜實(shí)時(shí)調(diào)整重心讓機(jī)器人在斜坡上也能保持平衡。IMU 的用法稍微復(fù)雜一點(diǎn)。MPU6050 輸出加速度和角速度需要通過(guò)互補(bǔ)濾波或卡爾曼濾波融合出姿態(tài)角。姿態(tài)角反饋給步態(tài)控制器當(dāng)身體前傾時(shí)加快前腿邁步當(dāng)身體側(cè)傾時(shí)調(diào)整支撐腿角度。這套邏輯寫(xiě)起來(lái)不復(fù)雜但調(diào)參需要耐心。我建議先用串口打印姿態(tài)角手動(dòng)傾斜機(jī)器人觀察數(shù)值變化確認(rèn)傳感器工作正常后再接入控制循環(huán)。6.2 無(wú)線(xiàn)遙控與手機(jī) App給 Quaddle 加無(wú)線(xiàn)遙控最直接的是藍(lán)牙模塊 HC-05 或 HC-06手機(jī)裝個(gè)藍(lán)牙串口 App發(fā)送字符指令。HC-05 支持主從模式可以配對(duì)手機(jī)HC-06 只能從模式但更便宜。接線(xiàn)也簡(jiǎn)單VCC、GND、TX、RX 四根線(xiàn)TX 接 Arduino 的 RXRX 接 Arduino 的 TX。注意電平匹配HC-05 是 3.3V 邏輯Arduino 是 5V直接接可能燒模塊最好加電平轉(zhuǎn)換或者用分壓電阻。如果想做手機(jī) App 控制可以用MIT App Inventor拖拽界面通過(guò)藍(lán)牙發(fā)送指令。App Inventor 有現(xiàn)成的藍(lán)牙組件半小時(shí)就能做出一個(gè)帶方向按鈕的控制界面。我做過(guò)一個(gè)四個(gè)方向按鈕加一個(gè)停止按鈕通過(guò)藍(lán)牙發(fā)送 F、B、L、R、S。延遲大約 100 毫秒控制慢速步態(tài)完全夠用。6.3 步態(tài)算法進(jìn)階從靜態(tài)到動(dòng)態(tài)靜態(tài)步態(tài)玩熟了可以嘗試動(dòng)態(tài)步態(tài)。動(dòng)態(tài)步態(tài)的核心是讓機(jī)器人利用慣性維持平衡允許只有一條腿著地。三足機(jī)器人的動(dòng)態(tài)步態(tài)比較少見(jiàn)但原理和雙足機(jī)器人類(lèi)似身體前傾后腿蹬地前腿快速前擺利用重力分量提供前進(jìn)動(dòng)力。這種步態(tài)速度快、動(dòng)作流暢但控制難度高需要精確的時(shí)序和重心控制。另一個(gè)進(jìn)階方向是自適應(yīng)步態(tài)。根據(jù)地面情況自動(dòng)調(diào)整抬腿高度和步幅。比如在粗糙地面上抬高腿避免絆倒在光滑地面上減小步幅防止打滑。這需要傳感器反饋和實(shí)時(shí)計(jì)算對(duì)主控性能有一定要求。ESP32 或 STM32 這類(lèi)性能更強(qiáng)的板子更適合做這個(gè)。我個(gè)人覺(jué)得Quaddle 最大的價(jià)值不在于它現(xiàn)在能做什么而在于它足夠簡(jiǎn)單讓你能看懂每一步的原理然后自己動(dòng)手改。你可以改步態(tài)、加傳感器、換主控、重新設(shè)計(jì)身體結(jié)構(gòu)。它是一塊跳板不是終點(diǎn)。我自己的 Quaddle 已經(jīng)改了三次結(jié)構(gòu)、重寫(xiě)了兩次步態(tài)代碼每次都有新發(fā)現(xiàn)。這種“能拆能改能折騰”的特性才是開(kāi)源硬件最吸引人的地方。