深圳華熙晟|AGV小車導航系統中的自適應控制
AGV 小車的“導航系統”里說的自適應控制,本質是在車輛參數、地面摩擦、載荷、輪胎打滑、傳感器漂移等不斷變化的情況下,讓底盤還能穩定、準、快地跟蹤路線與速度,不至于一換地面/一加重就跑偏、擺動、甚至振蕩。
1) 為什么 AGV 導航需要自適應控制?
載荷變化:空車/滿載慣量差很大,轉彎、剎車響應不同
摩擦變化:環氧地坪、瓷磚、粉塵、濕滑導致輪胎側偏/打滑
輪徑/輪距誤差與磨損:里程計模型漂移,長距離累積誤差
坡度/地面不平:等效擾動改變
執行器變化:電機溫升、減速箱背隙、驅動限制導致動態變慢或非線性變強
傳統做法是“調一個 PID 適配所有”,但在這種變化下很難兼顧:要么保守慢吞吞,要么快了就超調、抖動、蛇形。
2) 自適應控制在導航系統里具體管什么?
定位與狀態估計(融合里程計、IMU、激光/視覺/二維碼/磁條等)
路徑跟蹤/軌跡跟蹤控制(控制橫向:方向/角速度;縱向:速度/加速度)
底盤執行控制(輪速閉環、電機電流/扭矩、差速或舵輪機構)
自適應控制最常出現的位置是 第 2、3 層:
軌跡跟蹤層:根據當前誤差與工況變化,在線調整控制增益或模型參數,減少橫向誤差、角度誤差、抖動
底盤層:在線估計電機/傳動延遲、摩擦擾動,增強速度環/角速度環的魯棒性

3) 常見的自適應方案:
A. 自適應 PID / 增益調度(工業落地最多)
不是“學術自適應”,但最實用:
根據 速度 v、曲率 κ、載荷、地面摩擦指標、誤差大小,在線切換或連續調整 Kp,Ki,KdKp, Ki, KdKp,Ki,Kd
例如:高速+小曲率時增益更溫和,低速+大曲率時增強轉向跟蹤能力
優點:實現簡單、可解釋、容易過安規;缺點:對極端工況需要覆蓋規則,調參工作量不小。
B. 自適應前饋 + 反饋(“跟得準”關鍵)
路徑跟蹤常用結構:
前饋:根據路徑曲率給出期望角速度/轉向量(理想模型下不需要誤差也能走圓)
反饋:糾偏用(橫向誤差、航向誤差)
自適應常用于前饋:在線估計“曲率→轉向/角速度”的比例系數(受輪徑、摩擦、載荷影響),讓同樣曲率下的轉向更準。
C. MRAC(模型參考自適應控制)
給一個“希望系統表現成什么樣”的參考模型,控制器參數在線更新,使真實系統逼近參考模型。
適合:車輛動態變化明顯(載荷、摩擦)且你能給出簡化模型;
難點:穩定性分析與參數投影/飽和處理,工程上要防參數飄。
D. 自適應 MPC(帶約束的自適應軌跡跟蹤)
MPC 的優勢是能把速度/加速度/角速度/轉角限制、避障/跟蹤權重統一起來。自適應做法是在線更新模型參數(如輪胎側偏等效系數、執行器延遲)或在線更新權重。
適合:對“平滑、不過限、貼邊”要求高的場景(窄巷道、貨架旁)。
成本:算力與實現復雜度更高,需要良好狀態估計。
E. 擾動觀測器 DOB / ESO(把未知當擾動估計出來)
很多 AGV 的不確定性可以“等效成擾動”:地面阻力變化、坡度、摩擦變化、外力碰撞。
DOB/ESO 在線估計擾動并補償,常用于速度環、角速度環,效果往往立竿見影:更穩、更抗干擾。
F. L1 自適應 / 魯棒自適應(追求快速適應同時保穩定)
更偏高級控制:通過濾波結構把快速參數變化與控制輸入解耦,工程上適合“動態變化快但不能抖”的場景。實現門檻較高,但在一些高速移動平臺上很有價值。
4) 在 AGV 路徑跟蹤里,自適應通常怎么“用起來”?
以常見的“差速/四輪差速”AGV 為例,跟蹤誤差常用:
橫向誤差 eye_yey
航向誤差 eθe_\thetaeθ
速度誤差 eve_vev
一個實用落地套路(不依賴復雜學術推導):
基礎控制器先能跑穩:如 Pure Pursuit / Stanley / LQR / 簡化 MPC
把不確定性分解:
慢變化(輪徑、載荷慣量)→ 參數自適應/增益調度
快變化(打滑、坡度、外力)→ 擾動觀測與補償
加入工況識別指標(可選但很有效):
輪速與 IMU 加速度不一致 → 疑似打滑
橫向誤差持續增大且角速度輸出已飽和 → 摩擦不足或模型偏差
在線調整:
打滑時:降低期望角速度/加速度上限,增大穩定項權重
載荷大時:縱向加速度指令更保守,速度環增益相應調整
模型偏差時:更新曲率前饋系數、角速度環等效增益
5) 工程落地最容易踩的坑
把定位誤差當控制問題:定位漂了,再強的自適應也只會“追著錯位置跑”
參數更新太快導致抖動:自適應律需要限幅、濾波、投影(保證在合理范圍內)
執行器飽和不處理:角速度/轉角/輪速到頂后,誤差還在積累,會引發積分飽和、回彈振蕩
打滑時仍強行跟蹤:應進入“牽引力受限模式”(降速、降曲率響應、限制角加速度)
只看平均誤差,不看峰值與穩定性:AGV 更怕瞬時超界碰貨架
6) 評價指標:怎么判斷自適應“真有用”?
建議至少看這些:
橫向誤差峰值與 95 分位(貼邊能力)
航向誤差峰值(轉彎穩定性)
角速度/轉角指令是否抖動(舒適性與機械壽命)
飽和次數與飽和持續時間(是否經常“頂死”)
換載荷/換地面后的參數收斂時間(適應速度)
低摩擦工況下是否能安全降級(安全策略有效性)
相關新聞









