簡介圍繞機械手自適應(yīng)滑?？刂频腗ATLAB/Simulink仿真資源面向自動化、機器人及機電一體化方向的學(xué)生和工程技術(shù)人員旨在解決機械臂模型參數(shù)不確定、摩擦力與外界擾動下的魯棒控制問題。包內(nèi)共6個文件整體僅9KB以5個.m腳本和1個.mdl仿真模型為核心分別承擔(dān)自適應(yīng)參數(shù)更新、滑?？刂破髟O(shè)計、機械手動力學(xué)建模、輸入信號生成和結(jié)果繪圖等功能結(jié)構(gòu)緊湊適合在Simulink中直接運行調(diào)試。壓縮包將自適應(yīng)控制的在線估計思路與滑模控制的強魯棒性整合在一起學(xué)習(xí)時可對照代碼理解切換面構(gòu)造、參數(shù)自適應(yīng)律以及仿真輸出分析便于復(fù)現(xiàn)完整的機械手控制流程。當(dāng)前已有491人學(xué)習(xí)下載可作為控制理論課程設(shè)計、畢業(yè)設(shè)計或機器人仿真入門的實用參考。1. 機械手自適應(yīng)滑?？刂谱岕敯粜圆辉僖远墩駷榇鷥r做機械手軌跡跟蹤的人幾乎都遇過同一個困境滑?？刂茖δＰ驼`差和外部擾動天生不敏感這是它比PID和計算力矩法更吸引人的原因。可一旦把切換增益調(diào)大以保證魯棒性關(guān)節(jié)力矩就開始高頻抖振輕則仿真發(fā)散重則燒掉驅(qū)動器。自適應(yīng)滑?？刂普前堰@兩件事拆開處理——滑模保證系統(tǒng)狀態(tài)一旦到達(dá)滑模面就對匹配不確定性免疫自適應(yīng)律在線估計不確定性和擾動的上界讓切換增益不再靠經(jīng)驗試湊。它的適用場景很明確負(fù)載變化大、連桿參數(shù)辨識不準(zhǔn)、需要把控制器直接下放到實機調(diào)試的機械手系統(tǒng)。這篇文章按“建?！刂破髟O(shè)計→仿真搭建→參數(shù)整定→實機驗證”的順序把機械手自適應(yīng)滑?？刂茝睦碚撏频侥芘艿拇a重點放在那些看論文時容易被一筆帶過的參數(shù)邊界和仿真發(fā)散問題。2. 機械手動力學(xué)建模與滑模面設(shè)計2.1 二連桿機械手的動力學(xué)方程與不確定性分解機械手自適應(yīng)滑?？刂频牡谝徊讲皇菍懣刂破鞫前驯豢貙ο髮懗蛇m合滑模設(shè)計的形式。常見做法是采用拉格朗日方程建立n連桿剛性機械手的動力學(xué)模型% n連桿機械手動力學(xué)方程 % M(q) * qdd C(q, qd) * qd G(q) F(qd) tau_d tau % M(q) 慣性矩陣正定對稱 % C(q,qd) 科氏力和離心力項 % G(q) 重力項 % F(qd) 摩擦力矩 % tau_d 有界外部擾動 % tau 關(guān)節(jié)控制力矩寫仿真代碼時二連桿模型是首選原因是它能完整呈現(xiàn)自適應(yīng)滑?？刂频鸟詈咸匦杂植恢劣诒环柾茖?dǎo)淹沒。動力學(xué)參數(shù)一般取連桿質(zhì)量m1、m2桿長l1、l2質(zhì)心距l(xiāng)c1、lc2關(guān)節(jié)轉(zhuǎn)動慣量I1、I2。實際對象中這些參數(shù)往往存在±20%以上的攝動而自適應(yīng)滑?？刂频膬r值就在于不需要把這些參數(shù)辨識得很準(zhǔn)。把不確定性從模型中分離出來是設(shè)計自適應(yīng)律的前提。將真實模型拆成標(biāo)稱項和不確定項得到% 不確定性分離寫法 % M(q) M0(q) dM(q) % C(q,qd) C0(q,qd) dC(q,qd) % G(q) G0(q) dG(q) % 則動力學(xué)方程可改寫為 % M0(q) * qdd C0(q,qd) * qd G0(q) tau rho % rho 為 lumped 不確定性包含參數(shù)攝動、摩擦和外擾rho是整個自適應(yīng)滑?？刂埔獙Ω兜目倲_動項。值得注意的是rho不一定滿足線性參數(shù)化條件所以不能直接照搬傳統(tǒng)的自適應(yīng)反步法?；？刂圃谶@里的優(yōu)勢就體現(xiàn)出來了只要rho有界就不需要知道它的具體函數(shù)形式。2.2 滑模面與等效控制項的推導(dǎo)定義軌跡跟蹤誤差為e q - qd其中qd為期望關(guān)節(jié)角軌跡。常規(guī)線性滑模面在機械手控制中已經(jīng)夠用不需要上終端滑?；蚍e分滑模% 滑模面定義 % s de lambda * e % lambda 為滑模面斜率系數(shù)正定對角陣 % de dq - dqd速度跟蹤誤差 % e q - qd位置跟蹤誤差 % 當(dāng) s - 0 時跟蹤誤差滿足 de -lambda * e指數(shù)收斂對滑模面求導(dǎo)并代入動力學(xué)方程可以得到等效控制項。等效控制的含義是在系統(tǒng)狀態(tài)位于滑模面上時維持ds 0所需的控制量。這個推導(dǎo)過程在幾乎所有滑?？刂平滩睦锒加羞@里直接給出在Simulink的MATLAB Function中常用的計算式% 等效控制基于標(biāo)稱模型計算 % tau_eq M0(q) * (qdd_d - lambda * de) C0(q,qd) * qd G0(q) % 注意qdd_d 為期望加速度實際實現(xiàn)時M0、C0、G0都是幅值很大的項一旦參數(shù)偏差太大等效控制本身就有誤差。這部分誤差會被切換項兜住但也會讓切換增益的必要值變大從而加劇抖振。解決思路是讓自適應(yīng)律去估計這個“等效控制誤差的上界”而不是估計每個物理參數(shù)這也是機械手自適應(yīng)滑模控制與自適應(yīng)參數(shù)辨識路線最大的區(qū)別。2.3 自適應(yīng)律的構(gòu)造與Lyapunov穩(wěn)定性分析采用直接自適應(yīng)的方法對lumped不確定性rho的范數(shù)上界進(jìn)行在線估計。定義rho_norm為rho的歐幾里得范數(shù)其估計值為rho_hat估計誤差為rho_tilde rho_hat - rho_norm?？刂坡扇? 控制律 % tau tau_eq - K * sat(s / phi) - rho_hat * sign(s) % K 固定增益矩陣 % sat() 飽和函數(shù)邊界層厚度為 phi % sign() 符號函數(shù)僅在 phi - 0 時使用自適應(yīng)律采用梯度法設(shè)計% 自適應(yīng)律 % drho_hat Gamma * norm(s) * (1 - sigma * rho_hat) % Gamma 自適應(yīng)增益決定估計速度 % sigma sigma修正系數(shù)防止參數(shù)漂移Lyapunov函數(shù)取V 0.5 * s * M0 * s 0.5 * Gamma^-1 * rho_tilde^2對時間求導(dǎo)后可以發(fā)現(xiàn)只要固定增益K大于建模誤差引起的等效控制偏差且自適應(yīng)增益Gamma取正定就能保證V的導(dǎo)數(shù)負(fù)定。這里的sigma修正項是工程上必須加的東西——純積分型自適應(yīng)律在持續(xù)激勵不足時會導(dǎo)致rho_hat緩慢漂移最終讓控制力矩飽和。3. 機械手自適應(yīng)滑?？刂频腗ATLAB仿真搭建3.1 最小的可運行S函數(shù)代碼仿真環(huán)境選MATLAB/Simulink原因是Simulink仿真在機械手控制領(lǐng)域最常用調(diào)試手段也最成熟。我用Level-2 MATLAB S-function寫被控對象用普通MATLAB Function寫控制器這樣兩者邊界清晰方便替換成實機接口。先寫被控對象側(cè)的二連桿動力學(xué)S函數(shù)核心部分function 機械手_sfun(block) setup(block); end function setup(block) block.NumInputPorts 1; block.InputPort(1).Dimensions 2; % 關(guān)節(jié)力矩 tau block.NumOutputPorts 4; block.OutputPort(1).Dimensions 2; % q block.OutputPort(2).Dimensions 2; % qd % OutputPort(3)為qddOutputPort(4)為實際rho范數(shù)用于對比 block.SampleTimes [0 0]; % 連續(xù)系統(tǒng) block.RegBlockMethod(Outputs, Outputs); block.RegBlockMethod(Derivatives, Derivatives); end function Derivatives(block, ~, ~, ~, ~, ~) % 輸入為關(guān)節(jié)力矩 tau block.InputPort(1).Data; % 從狀態(tài)中取 q 和 qd q block.ContStates.Data(1:2); qd block.ContStates.Data(3:4); % 計算M、C、G [M, C, G] two_link_params(q, qd, true); % true表示真實參數(shù) % 加入模型攝動真實參數(shù)與標(biāo)稱參數(shù)偏差20% d 0.2 * (M * [sin(3*t); cos(3*t)]); % 模擬擾動 qdd M \ (tau - C * qd - G - d); block.Derivatives.Data [qd; qdd]; end這段代碼的關(guān)鍵在于把真實參數(shù)與控制器使用的標(biāo)稱參數(shù)分開存放。two_link_params函數(shù)的true標(biāo)志位決定返回真實值還是標(biāo)稱值這樣就模擬了參數(shù)攝動。擾動項取時變周期項能更真實地測試自適應(yīng)滑?？刂茖Ψ瞧ヅ鋽_動的抑制能力?？刂破鱾?cè)的Simulink MATLAB Function代碼如下function tau asmc_controller(q, qd, qd_d, qdd_d, rho_hat, param) % 自適應(yīng)滑?？刂破?e q - qd_d; de qd - qdd_d; % 期望速度 s de param.lambda * e; % 等效控制 [M0, C0, G0] two_link_params(q, qd, false); tau_eq M0 * (qdd_d - param.lambda * de) C0 * qd G0; % 切換控制采用飽和函數(shù)代替符號函數(shù) sat_term min(abs(s) / param.phi, 1) .* sign(s); tau_sw -param.K * sat_term - rho_hat .* sign(s); tau tau_eq tau_sw; % 自適應(yīng)律更新在另一個Function中完成本函數(shù)只輸出控制量 end3.2 Simulink模型連線與參數(shù)設(shè)置Simulink模型結(jié)構(gòu)常規(guī)搭法是五個模塊串聯(lián)軌跡生成器期望位置、速度、加速度、控制器、被控對象S-function、自適應(yīng)律模塊、示波器。自適應(yīng)律模塊接收滑模面s和當(dāng)前rho_hat按如下公式更新function rho_hat_new adapt_law(s, rho_hat, param) % 帶sigma修正的自適應(yīng)律 drho param.Gamma * norm(s) * (1 - param.sigma * rho_hat); rho_hat_new rho_hat drho * param.dt; end仿真參數(shù)表如下參數(shù)符號取值說明連桿1質(zhì)量m11.0 kg真實值連桿2質(zhì)量m20.8 kg真實值桿長l1, l21.0 m, 0.8 m質(zhì)心距取桿長一半標(biāo)稱m1m1_hat0.8 kg控制器使用偏差20%滑模面斜率lambda5.0越大收斂越快但放大噪聲固定增益K20.0需大于等效控制誤差上界邊界層厚度phi0.05太小抖振明顯太大損失精度自適應(yīng)增益Gamma10.0影響rho_hat收斂速度sigma修正sigma0.01防止參數(shù)漂移期望軌跡qdsin(t)幅值1 rad頻率1 rad/s仿真步長設(shè)ode45變步長最大步長限制為0.001秒否則在切換瞬間容易產(chǎn)生數(shù)值剛性導(dǎo)致仿真發(fā)散。這個細(xì)節(jié)很多人忽略固定步長ode4步長設(shè)0.0005秒也可以但會明顯拖慢仿真速度。3.3 機械手自適應(yīng)滑?？刂品抡娼Y(jié)果的關(guān)鍵判據(jù)跑完仿真不要只看位置跟蹤曲線重合就算通過。至少要檢查四件事第一s是否在0.5秒內(nèi)進(jìn)入邊界層phi內(nèi)第二rho_hat是否收斂到一個穩(wěn)定值而不是持續(xù)振蕩第三控制力矩是否有高頻分量FFT后如果在50Hz以上還有明顯能量說明邊界層太薄或自適應(yīng)增益太大第四把標(biāo)稱參數(shù)偏差從20%改到40%看跟蹤誤差是否仍在行業(yè)通常要求的0.01 rad以內(nèi)。如果s收斂了但力矩仍然抖振問題幾乎都出在rho_hat上——它把擾動上界估計得過大等效于切換增益被自適應(yīng)律放大。此時需要調(diào)小Gamma或增大sigma讓自適應(yīng)律更保守。4. 機械手自適應(yīng)滑?？刂频膮?shù)整定與仿真發(fā)散排查4.1 機械手自適應(yīng)滑?？刂频乃膫€必調(diào)參數(shù)參數(shù)整定的順序比參數(shù)本身更重要。我一般按“先固定滑模面再調(diào)等效控制最后調(diào)切換項”的順序來做。第一個必調(diào)參數(shù)是滑模面斜率lambda它決定了系統(tǒng)在滑模面上的收斂帶寬。二連桿機械手關(guān)節(jié)速度環(huán)采樣頻率通常在1kHzlambda取3到10之間是安全區(qū)間超過15就會把測量噪聲放大到力矩飽和。第二是固定增益K。這個值在理論上要大于建模誤差導(dǎo)致的等效控制偏差上界。工程中取標(biāo)稱模型力矩的10%-30%作為初值然后看跟蹤誤差是否在0.5秒內(nèi)衰減到穩(wěn)態(tài)值。K過小的特征是誤差呈慢衰減振蕩而非指數(shù)收斂。第三是邊界層厚度phi。傳統(tǒng)滑模用符號函數(shù)會產(chǎn)生理想抖振高散度仿真還能忍實機必然激發(fā)柔性模態(tài)。飽和函數(shù)把切換控制限制在邊界層內(nèi)代價是穩(wěn)態(tài)精度從零變成與phi同量級。phi取0.01到0.1之間比較常見具體要看編碼器分辨率。第四是自適應(yīng)增益Gamma。它控制rho_hat的收斂速度但有個容易被忽略的副作用Gamma太大會讓rho_hat跟著擾動的高頻分量波動把抖振從切換通道轉(zhuǎn)移到自適應(yīng)通道。一個有效的做法是給自適應(yīng)律加低通濾波或者把Gamma調(diào)小到rho_hat的響應(yīng)速度略慢于期望軌跡的基頻。4.2 符號函數(shù)替換sat還是tanh機械手自適應(yīng)滑?？刂坡涞貢r符號函數(shù)的替換是個必選項。仿真里可以直接用sign(s)實際控制器里沒人這么干。兩種替換方案各有特點% 飽和函數(shù)線性區(qū)飽和區(qū)邊界層效果明確 tau_sw -rho_hat * sat(s / phi); % 雙曲正切光滑連續(xù)高頻分量更少但等效邊界層不精確 tau_sw -rho_hat * tanh(s / phi);選型依據(jù)是控制頻率和機械臂的結(jié)構(gòu)剛度。普通六軸工業(yè)機械手關(guān)節(jié)減速比大、柔性高用tanh更安全直線電機驅(qū)動的低成本機械手結(jié)構(gòu)剛度高用sat能獲得更明確的穩(wěn)態(tài)精度。需要特別注意tanh的斜率不能設(shè)置過陡否則等價于一個沒有邊界層約束的符號函數(shù)抖振全部回來。4.3 仿真發(fā)散的直接原因與排查命令Simulink仿真發(fā)散是機械手自適應(yīng)滑?？刂谱畛１粰z索的問題之一。先區(qū)分是數(shù)值發(fā)散還是控制失穩(wěn)數(shù)值發(fā)散的特點是一兩個步長內(nèi)狀態(tài)變?yōu)镹aN或Inf控制失穩(wěn)則是狀態(tài)先振蕩、振幅逐步增大。對于數(shù)值發(fā)散按這個順序排查# 先把 solver 改成 ode15s剛性求解器 # 再限制最大步長 set_param(模型名, MaxStep, 0.001); # 降低自適應(yīng)增益 Gamma max(Gamma * 0.3, 1); # 檢查M矩陣是否奇異 det_M det(M);慣性矩陣在未到達(dá)奇異位形時不應(yīng)出現(xiàn)負(fù)值或過小值。二連桿模型在肘關(guān)節(jié)完全伸展時det(M)會減小這是動力學(xué)本身的性質(zhì)不是故障。但自適應(yīng)律估計的rho_hat如果超過5 * max(abs(tau_eq))控制器輸出會達(dá)到飽和之后系統(tǒng)變得不可控表現(xiàn)為跟隨誤差發(fā)散。此時要在自適應(yīng)律里加上限幅rho_hat min(rho_hat, param.rho_max);rho_max的取值來自執(zhí)行器能力——當(dāng)控制力矩達(dá)到電機峰值力矩的90%時自適應(yīng)律應(yīng)停止增大rho_hat。4.4 自適應(yīng)增益的上下限約束自適應(yīng)律長時間運行會出現(xiàn)參數(shù)漂移這是積分型自適應(yīng)控制的固有毛病。除了之前說的sigma修正還需要給rho_hat加一個帶死區(qū)的投影算子function rho_hat projection(rho_hat, drho, rho_min, rho_max) if (rho_hat rho_max drho 0) || (rho_hat rho_min drho 0) rho_hat_new rho_hat; % 不更新 else rho_hat_new rho_hat drho; end end下限r(nóng)ho_min設(shè)成0或略大于模型標(biāo)稱摩擦的估計值上限r(nóng)ho_max設(shè)為執(zhí)行器峰值力矩的50%到70%。這樣做還有一個好處當(dāng)機械手抓取負(fù)載突變時rho_hat能快速從當(dāng)前值上升到新上界而不會因為從一開始的小初值慢慢爬升導(dǎo)致過渡期跟蹤超調(diào)。5. 機械手自適應(yīng)滑?？刂茖崣C驗證的兩個技巧5.1 用摩擦模型降低自適應(yīng)負(fù)擔(dān)把仿真搬到實機前最值得做的事是先在控制回路里加入一個簡單的LuGre或庫侖粘滯摩擦前饋。工業(yè)機械手關(guān)節(jié)減速器的摩擦力矩常常占電機額定力矩的5%-15%如果不加前饋這部分會被自適應(yīng)律當(dāng)成不確定性估計進(jìn)去導(dǎo)致rho_hat始終偏大切換增益被抬高抖振從有到無做不干凈。常見做法是在等效控制項里加上tau_friction Fc * sign(qd) Fv * qd; tau_eq tau_eq tau_friction;這里的Fc和Fv通過勻速軌跡辨識一次即可。加了摩擦前饋后rho_hat主要剩余高頻擾動和參數(shù)攝動幅值可以降一個量級抗擾能力幾乎不受影響。5.2 初值選取與切換增益在線估計實機調(diào)試時rho_hat(0)不要設(shè)成0。原因是自適應(yīng)律在剛開始的幾十毫秒內(nèi)需要從0逐漸逼近真實上界這個過程中切換增益不足系統(tǒng)可能先偏離滑模面再拉回來等效于人為制造一次擾動。直接把初值設(shè)成辨識得到的摩擦項范數(shù)的1.5倍啟動階段平穩(wěn)得多。最后確認(rèn)一個容易被忽略的細(xì)節(jié)切換增益的在線估計要放在力矩輸出限幅之后用實際輸出的力矩去算滑模面的變化而不是用控制器解算出來的理想力矩。這樣即使電機進(jìn)入飽和區(qū)也不會誤判為擾動變大而把rho_hat盲目推高。順著這條路徑機械手自適應(yīng)滑?？刂凭湍軓姆抡嫫交^渡到實機保留魯棒性的同時把抖振壓到工程可接受的水平。本文還有配套的精品資源點擊獲取