做控制的同行應(yīng)該都有這種體驗(yàn)連續(xù)狀態(tài)方程離散化這步?jīng)]做對(duì)后面整個(gè)數(shù)字控制器都是空中樓閣。明明在連續(xù)域里設(shè)計(jì)得好好的觀測器和控制器一上單片機(jī)或者工控機(jī)波形要么發(fā)散要么震蕩幅度大得離譜。多數(shù)時(shí)候問題不出在控制算法本身而是出在連續(xù)模型到離散模型這一步——選錯(cuò)方法、選錯(cuò)采樣周期、忽略穩(wěn)定性驗(yàn)證任何一個(gè)環(huán)節(jié)翻車都會(huì)讓前期的仿真白做。這篇文章我想把連續(xù)狀態(tài)方程離散化這件事從頭到尾捋一遍。內(nèi)容包括四種主流離散化方法的數(shù)學(xué)本質(zhì)和適用邊界、一個(gè)完整可復(fù)現(xiàn)的彈簧-質(zhì)量-阻尼系統(tǒng)算例、采樣周期選擇的工程經(jīng)驗(yàn)以及離散化之后必須做的一系列體檢。不管你是剛開始接觸數(shù)字控制的學(xué)生還是已經(jīng)在做嵌入式控制系統(tǒng)開發(fā)的工程師這篇文章都值得收藏起來當(dāng)一份自查清單用。1. 數(shù)字控制器落地前必須先過的一關(guān)連續(xù)模型為什么要翻譯成離散形式1.1 連續(xù)域與數(shù)字域的天然鴻溝真實(shí)的物理世界是連續(xù)的。彈簧的形變、電機(jī)的轉(zhuǎn)速、電池的電壓這些物理量隨時(shí)間連續(xù)變化用微分方程描述它們是最自然的方式。但數(shù)字控制器本質(zhì)上是定時(shí)器驅(qū)動(dòng)的狀態(tài)機(jī)——每隔固定的時(shí)間間隔采集一次傳感器數(shù)據(jù)跑一遍控制算法輸出一次控制量然后等待下一個(gè)周期。它只能處理離散時(shí)間點(diǎn)上的數(shù)值無法直接積分微分方程。這就是連續(xù)狀態(tài)方程離散化的核心動(dòng)機(jī)把形如?(t) Ax(t) Bu(t)的連續(xù)模型轉(zhuǎn)換成形如x[k1] Φx[k] Γu[k]的離散模型。其中Φ是狀態(tài)轉(zhuǎn)移矩陣Γ是輸入矩陣。轉(zhuǎn)換完成之后這段差分方程才能真正寫進(jìn)C語言或者Python的控制循環(huán)里。1.2 兩個(gè)域之間差異的直觀感受用一個(gè)簡單類比來理解連續(xù)模型像是水流每時(shí)每刻都有精確的狀態(tài)離散模型像是快門相機(jī)只在特定的時(shí)間點(diǎn)記錄畫面。相機(jī)的快門速度采樣周期越快照片序列越接近真實(shí)水流快門越慢中間丟失的細(xì)節(jié)就越多甚至可能出現(xiàn)螺旋槳倒轉(zhuǎn)這種錯(cuò)覺?？刂葡到y(tǒng)里也有類似的錯(cuò)覺——混疊。如果采樣頻率不夠高連續(xù)系統(tǒng)里的高頻動(dòng)態(tài)會(huì)在離散信號(hào)里偽裝成低頻成分控制器看到的是一個(gè)完全錯(cuò)誤的世界。1.3 離散化做錯(cuò)的后果我在實(shí)際工程中見過太多類似的debug場景狀態(tài)觀測器在連續(xù)域仿真里收斂得好好的燒錄到嵌入式平臺(tái)之后估算狀態(tài)在啟動(dòng)階段直接飛掉PID控制器在Simulink里用連續(xù)模塊調(diào)參完成換成離散模塊之后同樣的增益卻穩(wěn)不住系統(tǒng)。這些問題的根源幾乎都是離散化這一步走了彎路。所以不要小看這個(gè)翻譯環(huán)節(jié)。它是連接控制理論與工程實(shí)現(xiàn)之間的橋梁橋搭得不穩(wěn)過橋必翻車。2. 四種離散化方法的推導(dǎo)邏輯與適用邊界對(duì)比離散化方法不止一種每種方法背后的數(shù)學(xué)假設(shè)不同適用的工程場景也不同。這一節(jié)把最常用的四種方法掰開揉碎講清楚。2.1 前向歐拉法最直觀但穩(wěn)定性約束最嚴(yán)前向歐拉法的思路來自導(dǎo)數(shù)的定義。當(dāng)采樣周期T足夠小時(shí)可以用一階差分近似導(dǎo)數(shù)?(t) ≈ (x[k1] - x[k]) / T代入連續(xù)方程得到x[k1] x[k] T(Ax[k] Bu[k]) (I TA)x[k] TBu[k]所以Φ I TAΓ TB。這是最簡單、最容易理解的離散化方式手算都能算。但它的代價(jià)是穩(wěn)定性條件苛刻。從特征值的角度看連續(xù)系統(tǒng)穩(wěn)定的條件是所有特征值位于復(fù)平面左半平面。前向歐拉離散化之后連續(xù)特征值λ被映射為z域特征值1 λT。左半平面映射到z平面上以(-1/T, 0)為圓心、1/T為半徑的圓內(nèi)。也就是說即使連續(xù)系統(tǒng)非常穩(wěn)定只要T取得不夠小離散后的極點(diǎn)也可能跑出單位圓導(dǎo)致系統(tǒng)發(fā)散。工程建議只有系統(tǒng)動(dòng)態(tài)遠(yuǎn)慢于采樣頻率即|λT|遠(yuǎn)小于1時(shí)前向歐拉才可靠。對(duì)于快速系統(tǒng)慎用。2.2 后向歐拉法穩(wěn)定性更好但精度同樣受限后向歐拉法用的是后向差分?((k1)T) ≈ (x[k1] - x[k]) / T注意這里的導(dǎo)數(shù)取在k1時(shí)刻而不是k時(shí)刻。代入連續(xù)方程時(shí)右邊也要取k1時(shí)刻的狀態(tài)x[k1] x[k] T(Ax[k1] Bu[k1])整理得到x[k1] (I - TA)?1(x[k] TBu[k1])如果輸入采用零階保持器即u[k1] u[k]則Φ (I - TA)?1Γ (I - TA)?1TB后向歐拉的穩(wěn)定性特性更好連續(xù)左半平面映射到z平面的單位圓內(nèi)所以連續(xù)穩(wěn)定系統(tǒng)離散化之后仍然穩(wěn)定。但代價(jià)是引入了隱含的代數(shù)方程而且頻率響應(yīng)會(huì)發(fā)生比較明顯的畸變尤其是在采樣周期比較大的時(shí)候。2.3 雙線性變換法Tustin法精度與穩(wěn)定性的折中雙線性變換法源于對(duì)指數(shù)函數(shù)z e^{sT}的Pade近似z ≈ (1 sT/2) / (1 - sT/2)反解出ss ≈ (2/T) · (z - 1) / (z 1)把連續(xù)狀態(tài)方程做拉普拉斯變換然后代入上述s的表達(dá)式整理后可以得到Φ (I - TA/2)?1(I TA/2) Γ (I - TA/2)?1TB雙線性變換的突出優(yōu)點(diǎn)有兩個(gè)。第一它把s平面的整個(gè)左半平面映射到z平面的單位圓內(nèi)部連續(xù)穩(wěn)定系統(tǒng)離散化后必然穩(wěn)定第二它的精度比前向、后向歐拉高一個(gè)量級(jí)因?yàn)樗腔谝浑A有理逼近相當(dāng)于在頻域上做了梯形積分。但雙線性變換有個(gè)著名的副作用頻率畸變。連續(xù)頻率ω和離散頻率ω_d之間的關(guān)系是ω_d (2/T) · tan(ωT/2)這意味著在奈奎斯特頻率附近離散化后的頻率響應(yīng)會(huì)被壓縮。解決方法是預(yù)畸變?cè)谠O(shè)計(jì)連續(xù)控制器時(shí)把目標(biāo)頻率替換為Ω (2/T)tan(ωT/2)這樣離散化之后實(shí)際頻率才對(duì)準(zhǔn)。雙線性變換是我個(gè)人在工程中使用頻率最高的方法。它不需要系統(tǒng)矩陣A可逆數(shù)值穩(wěn)定性好適用于大多數(shù)線性控制系統(tǒng)。2.4 精確ZOH離散化最接近物理真實(shí)但有前提條件如果你追求最準(zhǔn)確的離散化效果應(yīng)該使用零階保持器ZOH假設(shè)下的精確離散化。它的思想是連續(xù)系統(tǒng)的輸入u(t)在每個(gè)采樣周期內(nèi)保持不變由DAC的保持特性決定在這一假設(shè)下直接求解微分方程。連續(xù)狀態(tài)方程的通解是x(t) e^{A(t-t?)}x(t?) ∫_{t?}^{t} e^{A(t-τ)}Bu(τ)dτ在ZOH假設(shè)下u(τ)在[kT, (k1)T]區(qū)間內(nèi)恒等于u[k]代進(jìn)去得到Φ e^{AT} Γ ∫?^T e^{Aτ}dτ · B其中e^{AT}是矩陣指數(shù)工程上用Padé近似加縮放平方法求解。Γ的數(shù)值計(jì)算是常見工程坑后面我會(huì)專門講。精確ZOH離散化的物理意義是最準(zhǔn)確的因?yàn)樗鼑?yán)格遵循了DAC零階保持器的行為。但它有一個(gè)暗含前提系統(tǒng)矩陣A必須滿足矩陣指數(shù)的收斂性要求并且你能夠可靠地計(jì)算出矩陣指數(shù)和積分項(xiàng)。當(dāng)A奇異時(shí)Γ的積分中值公式不能直接用A?1(Φ - I)B來算需要用增廣矩陣法。2.5 四種方法橫向?qū)Ρ确椒é当磉_(dá)式穩(wěn)定性保持精度量級(jí)適用場景前向歐拉I TA有條件λT約束后向歐拉(I - TA)?1能保持穩(wěn)定O(T2)對(duì)穩(wěn)定性要求高的系統(tǒng)雙線性變換(I - TA/2)?1(I TA/2)必然保持穩(wěn)定O(T3)大多數(shù)工程系統(tǒng)首選精確ZOHe^{AT}必然保持穩(wěn)定精確有精確模型、仿真校驗(yàn)3. 彈簧-質(zhì)量-阻尼系統(tǒng)的離散化全流程從連續(xù)矩陣到可上機(jī)代碼3.1 系統(tǒng)模型建立用一個(gè)經(jīng)典例子把上面的方法全部走一遍?？紤]一個(gè)彈簧-質(zhì)量-阻尼系統(tǒng)質(zhì)量塊m1kg彈簧剛度k2N/m阻尼系數(shù)c0.5N·s/m。外力F是輸入質(zhì)量塊位移y是輸出。根據(jù)牛頓第二定律m? c? ky F選狀態(tài)變量x?y位移x??速度改寫為狀態(tài)空間形式[??] [ 0 1 ] [x?] [ 0 ] [??] [ -k/m -c/m ] [x?] [ 1/m ] F代入具體參數(shù)A [[0, 1], [-2, -0.5]] B [[0], [1]]系統(tǒng)特征值由det(λI - A) 0求得λ2 0.5λ 2 0解得λ -0.25 ± j1.3919。實(shí)部為負(fù)連續(xù)系統(tǒng)穩(wěn)定自然頻率約1.414rad/s阻尼比約0.177。3.2 選定采樣周期系統(tǒng)最高關(guān)注頻率取自然頻率的5~10倍約7~14rad/s。采樣頻率至少高于這個(gè)值的10倍即70~140rad/s折算成采樣周期T約為0.045~0.09s。這里取T0.1s作為演示雖然稍微偏大但能更清楚地暴露出不同離散化方法之間的差異。3.3 Python代碼實(shí)現(xiàn)四種離散化下面是完整可運(yùn)行的Python代碼使用了NumPy和SciPyimport numpy as np from scipy.linalg import expm # 連續(xù)系統(tǒng)參數(shù) m, c, k 1.0, 0.5, 2.0 A np.array([[0.0, 1.0], [-k/m, -c/m]]) B np.array([[0.0], [1.0/m]]) T 0.1 # --- 前向歐拉 --- Phi_fe np.eye(2) T * A Gamma_fe T * B # --- 后向歐拉 --- I_minus_TA np.eye(2) - T * A Phi_be np.linalg.inv(I_minus_TA) Gamma_be np.linalg.solve(I_minus_TA, T * B) # --- 雙線性變換 --- I_minus_TA_half np.eye(2) - T/2 * A I_plus_TA_half np.eye(2) T/2 * A Phi_bl np.linalg.solve(I_minus_TA_half, I_plus_TA_half) Gamma_bl np.linalg.solve(I_minus_TA_half, T * B) # --- 精確ZOH離散化增廣矩陣法求Gamma--- n A.shape[0] M np.zeros((n1, n1)) M[:n, :n] A M[:n, n] B.flatten() M_exp expm(M * T) Phi_zoh M_exp[:n, :n] Gamma_zoh M_exp[:n, n:].reshape(n, 1) print(Phi (ZOH):\n, Phi_zoh) print(Gamma (ZOH):\n, Gamma_zoh)3.4 運(yùn)行結(jié)果對(duì)比與原理解讀運(yùn)行上面的代碼得到的四種離散化矩陣大致如下方法ΦΓ前向歐拉[[1.0, 0.1], [-0.2, 0.95]][0.0, 0.1]?后向歐拉[[0.98131, 0.09346], [-0.18692, 0.93458]][0.00935, 0.09346]?雙線性[[0.99029, 0.09709], [-0.19417, 0.94175]][0.00485, 0.09709]?精確ZOH[[0.99018, 0.09727], [-0.19454, 0.94155]][0.00491, 0.09727]?觀察這些數(shù)據(jù)前向歐拉的Γ第一行是0意味著外力對(duì)位移狀態(tài)沒有直接傳遞作用——這與連續(xù)系統(tǒng)的物理直覺明顯不符。因?yàn)榍跋驓W拉只用當(dāng)前時(shí)刻的狀態(tài)差分近似導(dǎo)數(shù)輸入的影響要經(jīng)過一個(gè)周期才滲透到位移通道。雙線性變換與精確ZOH的結(jié)果非常接近誤差在10?3量級(jí)這符合理論預(yù)期。后向歐拉的結(jié)果也還可以但精度略遜于雙線性變換。我還對(duì)比了離散化之后的極點(diǎn)位置方法離散極點(diǎn)極點(diǎn)幅值連續(xù)理論映射0.9656 ± j0.13540.9753前向歐拉0.9750 ± j0.13920.9849后向歐拉0.9580 ± j0.13010.9668雙線性0.9660 ± j0.13510.9753精確ZOH0.9656 ± j0.13540.9753雙線性變換的極點(diǎn)幅值與精確ZOH相差無幾再次驗(yàn)證了它在精度和穩(wěn)定性之間的優(yōu)秀平衡。前向歐拉在這個(gè)采樣周期下極點(diǎn)幅值大于1嗎實(shí)際上0.9849小于1系統(tǒng)仍然穩(wěn)定但如果把T增大到0.5s左右前向歐拉的極點(diǎn)就會(huì)跑出單位圓。3.5 增廣矩陣法為什么更安全精確ZOH離散化中最容易翻車的一步是Γ矩陣計(jì)算。教科書上常見公式Γ ∫?^T e^{Aτ}dτ · B A?1(e^{AT} - I)B這個(gè)公式只有在A可逆時(shí)才成立。工程中的狀態(tài)矩陣A經(jīng)常是對(duì)角線元素為0的奇異矩陣比如積分環(huán)節(jié)、單位速度模型此時(shí)A?1不存在公式直接失效。增廣矩陣法的巧妙之處在于把積分過程變成一個(gè)更高維矩陣的指數(shù)運(yùn)算M [[A, B], [0, 0]]對(duì)M求矩陣指數(shù)后再切塊自動(dòng)得到Φ和Γ。這個(gè)方法沒有任何可逆性要求數(shù)值魯棒性比直接算逆矩陣好得多。我在工程中一直用這種方法強(qiáng)烈推薦。4. 采樣周期T的選擇決定離散化成敗的隱藏變量很多初學(xué)者把精力都放在選離散化方法上反而忽略了一個(gè)比方法本身更敏感的參數(shù)——采樣周期T。T選錯(cuò)了再精確的離散化算法也不能讓控制系統(tǒng)正常運(yùn)轉(zhuǎn)。4.1 采樣周期的理論下限和上限理論上限來自香農(nóng)采樣定理采樣頻率必須大于系統(tǒng)最高頻率成分的兩倍否則會(huì)發(fā)生混疊。但工程上兩倍遠(yuǎn)遠(yuǎn)不夠。控制系統(tǒng)需要看到的是閉環(huán)帶寬附近的動(dòng)態(tài)特性采樣頻率至少應(yīng)該是閉環(huán)帶寬的10到20倍。經(jīng)驗(yàn)公式ω_s ≥ (10~30) · ω_bw其中ω_s 2π/Tω_bw是閉環(huán)帶寬。換算成采樣周期T ≤ 1 / (10~30) · (2π / ω_bw)假設(shè)閉環(huán)帶寬是2rad/s那么T大約要小于0.1~0.3s。理論下限來自計(jì)算資源的約束。采樣周期越小每個(gè)控制周期內(nèi)能執(zhí)行的計(jì)算量就越少。如果控制器周期是1kHz那么每個(gè)周期只有1ms的時(shí)間完成AD采樣、狀態(tài)估算、控制量計(jì)算和DA輸出。對(duì)于沒有硬件浮點(diǎn)單元的低端MCU這個(gè)時(shí)間非常緊張。4.2 采樣周期對(duì)離散化精度的影響以2.4節(jié)的彈簧-質(zhì)量-阻尼系統(tǒng)為例我分別用T0.01s、0.1s、0.5s做雙線性變換離散化然后比較離散系統(tǒng)的階躍響應(yīng)與連續(xù)系統(tǒng)的階躍響應(yīng)。T0.01s時(shí)離散響應(yīng)與連續(xù)響應(yīng)幾乎重合差異在肉眼不可見范圍。T0.1s時(shí)穩(wěn)態(tài)值一致但離散響應(yīng)的峰值時(shí)間略有偏移超調(diào)量相差約2%左右。T0.5s時(shí)離散系統(tǒng)的響應(yīng)已經(jīng)明顯失真采樣點(diǎn)之間的信息丟失嚴(yán)重甚至出現(xiàn)了看起來像延遲的現(xiàn)象。這個(gè)實(shí)驗(yàn)說明一個(gè)道理離散化誤差并不是線性的T增大到某個(gè)閾值之后誤差會(huì)急劇惡化。工程上我習(xí)慣用系統(tǒng)最短時(shí)間常數(shù)的十分之一作為T的初始估計(jì)再根據(jù)實(shí)時(shí)性要求往上調(diào)整。4.3 采樣周期與系統(tǒng)穩(wěn)定性的耦合效應(yīng)還有一個(gè)經(jīng)常被忽略的細(xì)節(jié)采樣周期T與連續(xù)系統(tǒng)特征值的乘積λT決定了離散化方法的適用性。對(duì)于前向歐拉法要求所有|λT|遠(yuǎn)小于1對(duì)于雙線性變換和精確ZOH雖然沒有這么嚴(yán)格的要求但λT數(shù)值過大時(shí)矩陣指數(shù)的計(jì)算精度也會(huì)下降。實(shí)際工程中如果系統(tǒng)的動(dòng)態(tài)特別快、而硬件采樣速率跟不上直觀的反應(yīng)可能是換一個(gè)更高級(jí)的離散化方法。但實(shí)際上更應(yīng)該做的是先檢查系統(tǒng)是否真的需要那么高的閉環(huán)帶寬——很多時(shí)候是控制指標(biāo)定得過于激進(jìn)導(dǎo)致對(duì)采樣周期提出不切實(shí)際的要求。4.4 工程中的實(shí)用取值策略綜合以上討論我在實(shí)際項(xiàng)目中慣用的采樣周期選擇流程如下確定閉環(huán)系統(tǒng)的期望帶寬ω_bw來源于響應(yīng)速度、抗擾能力等性能指標(biāo)。令采樣頻率ω_s 20ω_bw作為初始選擇。用仿真驗(yàn)證離散系統(tǒng)的性能包括穩(wěn)定性、超調(diào)量、穩(wěn)態(tài)誤差。如果性能不滿足優(yōu)先提高采樣頻率而不是調(diào)整控制器增益。如果硬件資源受限無法提高采樣頻率再考慮降低指標(biāo)或優(yōu)化控制算法結(jié)構(gòu)。注意采樣周期一旦確定控制器的離散化參數(shù)就必須隨之固定。后續(xù)調(diào)試中如果修改了控制周期一定要重新做離散化不能沿用舊參數(shù)。5. 離散化之后的體檢項(xiàng)目穩(wěn)定性、可控可觀性與頻率特性驗(yàn)證離散化做完不等于大功告成。就像寫完代碼要跑測試一樣離散模型需要通過一系列檢查才能真正進(jìn)入控制器設(shè)計(jì)階段。我把這些檢查稱為體檢清單。5.1 極點(diǎn)位置與穩(wěn)定性檢查第一項(xiàng)必做檢查是計(jì)算離散系統(tǒng)矩陣Φ的特征值。連續(xù)系統(tǒng)的穩(wěn)定性要求是特征值實(shí)部小于0離散系統(tǒng)則是特征值模小于1位于z平面單位圓內(nèi)。用Python檢查eigs np.linalg.eigvals(Phi_zoh) print(Eigenvalues:, eigs) print(Magnitudes:, np.abs(eigs)) if np.max(np.abs(eigs)) 1.0: print(System is stable after discretization) else: print(System is UNSTABLE after discretization)如果離散化的方法選得對(duì)而且采樣周期合理這項(xiàng)檢查通常能通過。但我遇到過T取得過大導(dǎo)致原本連續(xù)穩(wěn)定的系統(tǒng)離散化后不穩(wěn)定的案例——當(dāng)時(shí)用的就是前向歐拉法。極點(diǎn)檢查是離散化是否成功的第一個(gè)照妖鏡。5.2 可控性與可觀性檢查離散化可能會(huì)改變系統(tǒng)的可控性和可觀性。連續(xù)系統(tǒng)可控/可觀離散化之后未必保持。尤其是當(dāng)采樣周期恰好等于連續(xù)系統(tǒng)特征值之差的分?jǐn)?shù)的整數(shù)倍時(shí)離散系統(tǒng)會(huì)丟失某些模態(tài)的可控性。數(shù)學(xué)上的判斷條件是對(duì)于連續(xù)系統(tǒng)兩個(gè)不同的特征值λ?和λ?如果存在某個(gè)非零整數(shù)k使得T(λ? - λ?) j2πk即λ? - λ? j2πk/T那么離散系統(tǒng)就會(huì)在這些模態(tài)上喪失可控性。這種壞采樣周期在工程中很罕見但多模態(tài)高精度系統(tǒng)比如機(jī)械臂關(guān)節(jié)、柔性結(jié)構(gòu)中確實(shí)會(huì)碰到。標(biāo)準(zhǔn)檢查用可控性矩陣和可觀性矩陣的秩來判斷def check_controllability(Phi, Gamma): n Phi.shape[0] Cm np.hstack([np.linalg.matrix_power(Phi, i) Gamma for i in range(n)]) rank np.linalg.matrix_rank(Cm) print(fControllability matrix rank: {rank}/{n}) return rank n check_controllability(Phi_zoh, Gamma_zoh)5.3 階躍響應(yīng)一致性驗(yàn)證離散系統(tǒng)和連續(xù)系統(tǒng)的階躍響應(yīng)應(yīng)該保持形態(tài)一致。我強(qiáng)烈建議每次離散化之后都把兩條階躍響應(yīng)曲線疊在一張圖里看。重點(diǎn)看三點(diǎn)穩(wěn)態(tài)值是否相等、超調(diào)量是否接近、上升時(shí)間是否基本一致。如果離散響應(yīng)比連續(xù)響應(yīng)超調(diào)大了很多最可能的原因是采樣周期偏大或者離散化方法引入了過多的相位滯后。如果穩(wěn)態(tài)值不一致通常說明Γ矩陣計(jì)算有誤優(yōu)先檢查輸入矩陣那一項(xiàng)。5.4 頻率響應(yīng)對(duì)比驗(yàn)證連續(xù)系統(tǒng)和離散系統(tǒng)的頻率響應(yīng)在低頻段應(yīng)該幾乎重合在高頻段會(huì)因?yàn)椴蓸雍捅３中?yīng)出現(xiàn)相位滯后。Bode圖是觀察這一現(xiàn)象最直觀的工具。離散系統(tǒng)的頻率響應(yīng)通常用z e^{jωT}代入脈沖傳遞函數(shù)來計(jì)算。也可以直接對(duì)比連續(xù)傳遞函數(shù)G(s)和離散脈沖傳遞函數(shù)G(z)在關(guān)鍵頻率點(diǎn)直流、截止頻率、奈奎斯特頻率的幅值與相位。提示雙線性變換的頻率畸變雖然在全頻段都存在但在ωT遠(yuǎn)小于1時(shí)幾乎可以忽略。只有在采樣頻率接近信號(hào)頻率時(shí)畸變才明顯。5.5 檢查結(jié)果異常時(shí)的排查路徑體檢發(fā)現(xiàn)問題時(shí)不要急著改控制器參數(shù)先回到離散化這一步排查檢查Φ和Γ的維度是否正確有時(shí)候是矩陣乘法順序弄反了。檢查T的單位是否一致——秒還是毫秒這是最隱蔽的低級(jí)錯(cuò)誤。檢查B矩陣是否存在某些系統(tǒng)是沒有直接輸入的。用增廣矩陣法重算Γ對(duì)比之前的結(jié)果?；氐竭B續(xù)模型確認(rèn)A和B的元素?cái)?shù)值沒有輸錯(cuò)。按照這個(gè)順序排查絕大多數(shù)異常都能定位到具體原因。6. 工程調(diào)試中反復(fù)踩過的五個(gè)坑最后一節(jié)分享幾個(gè)我在實(shí)際項(xiàng)目里踩坑踩出來的教訓(xùn)。這些細(xì)節(jié)教科書上不會(huì)寫但真遇到了會(huì)讓調(diào)試進(jìn)度停滯好幾天。6.1 A矩陣奇異時(shí)直接用A?1求Γ導(dǎo)致報(bào)錯(cuò)初學(xué)時(shí)我拿到ZOH離散化公式看到Γ A?1(Φ - I)B就直接用結(jié)果系統(tǒng)建模里恰好有一個(gè)積分環(huán)節(jié)A矩陣的某一行全為0A不可逆代碼直接崩潰。當(dāng)時(shí)花了很久才明白問題出在A的可逆性上。后來在參考各類開源代碼和工具庫的實(shí)現(xiàn)后發(fā)現(xiàn)規(guī)范做法就是3.5節(jié)說的增廣矩陣法或者用數(shù)值積分處理矩陣指數(shù)。從此我再也沒有手寫過A?1(Φ - I)B這種形式。6.2 雙線性變換的頻率畸變導(dǎo)致截止頻率偏移曾經(jīng)設(shè)計(jì)一個(gè)有源阻尼控制器連續(xù)域里截止頻率算好了是10Hz用雙線性變換離散化并實(shí)現(xiàn)之后實(shí)測Bode圖顯示截止頻率跑到了8.5Hz。一開始以為是濾波系數(shù)寫錯(cuò)了反復(fù)檢查無果后來才想起需要做預(yù)畸變。從那以后我的習(xí)慣是凡是涉及雙線性變換的濾波器或控制器設(shè)計(jì)先把目標(biāo)頻率換算成Ω (2/T)tan(ωT/2)再用Ω去設(shè)計(jì)連續(xù)域的傳遞函數(shù)最后離散化出來的實(shí)際截止頻率才會(huì)落在期望位置。6.3 零階保持器與一階保持器效果差異ZOH離散化假設(shè)輸入在每個(gè)采樣周期內(nèi)保持恒定不變這是DAC的自然行為。但如果系統(tǒng)里有的是通過PWM輸出的執(zhí)行器比如電機(jī)驅(qū)動(dòng)PWM的占空比更新方式并不完全等價(jià)于ZOH它的實(shí)際輸出在周期內(nèi)可能不是恒定值。處理這類問題時(shí)可以把PWM的平均效應(yīng)折算進(jìn)B矩陣或者用一階保持器FOH離散化來更貼近實(shí)際波形。FOH的推導(dǎo)比ZOH復(fù)雜但在高頻PWM驅(qū)動(dòng)場合這個(gè)建模精度上的差異是能明顯看到的。6.4 采樣周期在調(diào)試中途被修改這個(gè)坑特別容易出現(xiàn)在原型驗(yàn)證階段。一開始硬件定時(shí)器配置的是1kHz調(diào)試過程中為了降低CPU負(fù)載把控制頻率改成了500Hz但離散化的Φ和Γ還是舊的。結(jié)果系統(tǒng)突然開始震蕩查了半天才發(fā)現(xiàn)頻率改完之后離散模型沒同步更新。現(xiàn)在我把控制頻率和離散化參數(shù)做成了配置頭文件里的一對(duì)定義每次修改控制頻率編譯期強(qiáng)制要求同步更新離散化參數(shù)從機(jī)制上杜絕這種不一致。6.5 矩陣指數(shù)計(jì)算精度不足引發(fā)的隱性誤差在小規(guī)模系統(tǒng)里手寫泰勒展開求e^{AT}可能還能湊合。但狀態(tài)維度到10階以上時(shí)泰勒展開截?cái)嗾`差和舍入誤差會(huì)明顯累積極點(diǎn)位置可能偏出單位圓導(dǎo)致離散系統(tǒng)看起來不穩(wěn)定。解決辦法就是使用成熟的數(shù)值庫比如SciPy的expm或者M(jìn)ATLAB的expm它們用縮放平方法加Padé近似對(duì)高階矩陣也能保持足夠精度。另外還要注意矩陣指數(shù)里的T必須以標(biāo)量形式乘進(jìn)去而不是乘在矩陣元素上之后忘了乘T。這個(gè)指令寫起來很簡單但確實(shí)見過把expm(A*T)寫成expm(A)然后外面乘T的結(jié)果完全不對(duì)。最后再分享一個(gè)小技巧做離散化驗(yàn)證時(shí)不要只盯著極點(diǎn)或者Bode圖花五分鐘把連續(xù)系統(tǒng)和離散系統(tǒng)的階躍響應(yīng)疊在一張圖里看很多參數(shù)問題一眼就能暴露。尤其注意初始時(shí)刻附近的表現(xiàn)那里最容易暴露離散化方法引入的相位滯后和幅值誤差。離散化這個(gè)主題看似基礎(chǔ)但它是數(shù)字控制從理論走向落地的必經(jīng)之路。把這套流程和檢查清單內(nèi)化成自己的固定操作習(xí)慣后續(xù)做觀測器設(shè)計(jì)、無模型自適應(yīng)控制、數(shù)字濾波都會(huì)順很多。