做ESP標(biāo)定和測(cè)試這些年經(jīng)常會(huì)有同行問(wèn)我一個(gè)問(wèn)題ESP系統(tǒng)明明裝了橫擺角速度傳感器為什么還要費(fèi)勁用輪速差去估算Yaw-rate這個(gè)問(wèn)題其實(shí)問(wèn)到了點(diǎn)子上。橫擺角速度Yaw Rate是車(chē)輛繞垂直軸轉(zhuǎn)動(dòng)的角速度它直接決定了ESP能不能判斷出車(chē)輛正在甩尾還是推頭是整個(gè)穩(wěn)定性控制邏輯的核心輸入。但工程上講究冗余和安全輪速差估算并不是為了替代傳感器而是為了校驗(yàn)、備份以及在特定工況下提供更可信的信號(hào)。這篇文章我就把這個(gè)推導(dǎo)過(guò)程完全攤開(kāi)來(lái)講從最基礎(chǔ)的運(yùn)動(dòng)學(xué)幾何關(guān)系出發(fā)一步步推導(dǎo)出輪速差和橫擺角速度之間的數(shù)學(xué)關(guān)系再聊聊量產(chǎn)算法落地時(shí)那些文檔里不會(huì)寫(xiě)的細(xì)節(jié)滾動(dòng)半徑差異、死區(qū)設(shè)置、濾波截止頻率、驅(qū)動(dòng)制動(dòng)工況的干擾等等。無(wú)論你是剛接觸底盤(pán)電控的工程師還是正在做車(chē)輛動(dòng)力學(xué)仿真的學(xué)生這篇文章都能幫你真正搞懂“輪速差估算Yaw-rate”這件事的本質(zhì)。1. ESP系統(tǒng)為什么要知道“橫擺角速度”先從整車(chē)控制的角度理解1.1 橫擺角速度在ESP系統(tǒng)中的定位ESPElectronic Stability Program車(chē)身電子穩(wěn)定系統(tǒng)的核心任務(wù)是當(dāng)車(chē)輛出現(xiàn)縱向或橫向失穩(wěn)趨勢(shì)時(shí)通過(guò)獨(dú)立控制單個(gè)車(chē)輪的制動(dòng)力必要時(shí)還會(huì)請(qǐng)求發(fā)動(dòng)機(jī)降扭把車(chē)輛拉回到駕駛員期望的軌跡上。要完成這個(gè)任務(wù)系統(tǒng)必須先回答一個(gè)基礎(chǔ)問(wèn)題車(chē)輛現(xiàn)在到底處于什么運(yùn)動(dòng)狀態(tài)運(yùn)動(dòng)狀態(tài)可以拆解成幾個(gè)維度縱向速度、橫向速度、橫擺角速度、質(zhì)心側(cè)偏角。其中橫擺角速度是最直觀的“轉(zhuǎn)向響應(yīng)量”之一——方向盤(pán)打了多少角度車(chē)輛實(shí)際繞垂直軸轉(zhuǎn)得有多快這兩者之間的匹配關(guān)系直接決定了車(chē)輛是否在按照駕駛員的意圖行駛。比如在高速?gòu)澋乐腥绻麑?shí)際橫擺角速度明顯小于駕駛員輸入對(duì)應(yīng)的期望值說(shuō)明車(chē)輛在推頭轉(zhuǎn)向不足反之如果實(shí)際值突然大于期望值說(shuō)明車(chē)輛有甩尾轉(zhuǎn)向過(guò)度的趨勢(shì)。這里要區(qū)分兩組概念一個(gè)是駕駛員意圖對(duì)應(yīng)的期望橫擺角速度由轉(zhuǎn)向角傳感器和車(chē)速信號(hào)推導(dǎo)得出另一個(gè)是車(chē)輛實(shí)際發(fā)生的橫擺角速度通常由陀螺儀測(cè)量或者由輪速差等間接信號(hào)估算得到。ESP控制邏輯的核心比較就是拿這兩者做差差值超過(guò)一定閾值穩(wěn)定控制就開(kāi)始介入。所以橫擺角速度不僅是控制量還是整個(gè)ESP邏輯中最關(guān)鍵的反饋信號(hào)。1.2 輪速差從哪來(lái)傳感器與信號(hào)源頭輪速差估算所用到的“原料”是四個(gè)車(chē)輪的轉(zhuǎn)速信號(hào)。現(xiàn)在乘用車(chē)的ESP系統(tǒng)基本上都標(biāo)配了四個(gè)輪速傳感器常見(jiàn)類(lèi)型是磁電式可變磁阻式或霍爾式。磁電式傳感器通過(guò)齒圈旋轉(zhuǎn)切割磁力線產(chǎn)生感應(yīng)電壓脈沖齒圈通常有44到48個(gè)齒ECU通過(guò)測(cè)量脈沖的頻率或者相鄰脈沖的時(shí)間間隔就能換算出車(chē)輪轉(zhuǎn)速。為什么輪速信息能反映橫擺運(yùn)動(dòng)核心原因在于車(chē)輛的轉(zhuǎn)向運(yùn)動(dòng)學(xué)約束當(dāng)車(chē)輛轉(zhuǎn)彎時(shí)外側(cè)車(chē)輪走過(guò)的路徑一定比內(nèi)側(cè)車(chē)輪長(zhǎng)也就是說(shuō)外側(cè)車(chē)輪轉(zhuǎn)速一定高于內(nèi)側(cè)車(chē)輪。這個(gè)速度差的大小和車(chē)輛繞垂直軸的轉(zhuǎn)動(dòng)快慢直接相關(guān)。在差速器的作用下這個(gè)關(guān)系被機(jī)械結(jié)構(gòu)天然保證所以輪速差本質(zhì)上是從車(chē)輪層面“讀”出來(lái)的運(yùn)動(dòng)學(xué)信息。這里有個(gè)容易被忽略的點(diǎn)輪速傳感器測(cè)量的轉(zhuǎn)速只代表車(chē)輪本身的轉(zhuǎn)動(dòng)快慢只有在輪胎與地面之間沒(méi)有明顯滑轉(zhuǎn)、滑移的前提下輪速才能等效于車(chē)輛的實(shí)際縱向速度。這也是后面所有誤差修正和工況判斷的總出發(fā)點(diǎn)。2. 運(yùn)動(dòng)學(xué)推導(dǎo)輪速差與Yaw-rate的數(shù)學(xué)關(guān)系2.1 從轉(zhuǎn)彎半徑說(shuō)起基本運(yùn)動(dòng)學(xué)幾何模型推導(dǎo)之前先把模型簡(jiǎn)化一下?？紤]車(chē)輛在做穩(wěn)態(tài)圓周運(yùn)動(dòng)繞一個(gè)共同的瞬時(shí)旋轉(zhuǎn)中心ICR轉(zhuǎn)動(dòng)。這個(gè)近似在低速轉(zhuǎn)彎或者穩(wěn)定工況下是成立的也是輪速差分公式成立的前提。設(shè)后軸左右輪距為b通常取后軸輪距約1.4到1.6米車(chē)輛橫擺角速度為γ單位rad/s后軸中心點(diǎn)的轉(zhuǎn)彎半徑為R?，F(xiàn)在把后軸左右車(chē)輪單獨(dú)拿出來(lái)看。內(nèi)側(cè)輪以左轉(zhuǎn)彎時(shí)左后輪為例的轉(zhuǎn)彎半徑約為R - b/2外側(cè)輪右后輪的轉(zhuǎn)彎半徑約為R b/2。圓周運(yùn)動(dòng)的基本關(guān)系是線速度等于角速度乘以半徑所以v_L γ × (R - b/2) v_R γ × (R b/2)這里v_L和v_R是左右后輪的線速度m/sγ是兩個(gè)輪子共同繞ICR旋轉(zhuǎn)的角速度也就是整車(chē)的橫擺角速度。把兩個(gè)式子相減中間項(xiàng)正好消掉v_R - v_L γ × [(R b/2) - (R - b/2)] γ × b這個(gè)結(jié)果非常有價(jià)值橫擺角速度等于左右輪速差除以輪距與轉(zhuǎn)彎半徑R完全無(wú)關(guān)。只要輪速測(cè)量準(zhǔn)確無(wú)論彎道又多急這個(gè)運(yùn)動(dòng)學(xué)關(guān)系始終成立。把公式整理成最終形式γ (v_R - v_L) / b實(shí)際使用中要注意內(nèi)外輪的區(qū)分。左轉(zhuǎn)時(shí)v_R是外側(cè)輪速度更大右轉(zhuǎn)時(shí)v_L更大。工程上一般用絕對(duì)值或者帶符號(hào)處理符號(hào)由轉(zhuǎn)向角或輪速差方向決定。后面為了討論方便統(tǒng)一用Δv v_R - v_L來(lái)表示輪速差。2.2 差速器的機(jī)械本質(zhì)為什么這個(gè)公式天然成立有人可能會(huì)問(wèn)這個(gè)公式是不是只存在于紙面推導(dǎo)上實(shí)際上差速器的機(jī)械結(jié)構(gòu)就是按這個(gè)運(yùn)動(dòng)學(xué)關(guān)系設(shè)計(jì)的。傳統(tǒng)差速器的特性可以概括為一句話左右半軸轉(zhuǎn)速之和等于差速器殼轉(zhuǎn)速的兩倍而左右半軸轉(zhuǎn)速之差由齒輪嚙合關(guān)系決定可以任意分配。舉個(gè)例子車(chē)輛左轉(zhuǎn)彎時(shí)中差速器殼或驅(qū)動(dòng)橋差速器殼的轉(zhuǎn)速對(duì)應(yīng)后橋平均速度而左右半軸通過(guò)行星輪嚙合允許右側(cè)半軸轉(zhuǎn)得比左側(cè)快。在附著良好的路面上地面給內(nèi)外輪提供的縱向力形成了力矩平衡使得差速器自動(dòng)把轉(zhuǎn)速按轉(zhuǎn)彎半徑的比例分配出去。換句話說(shuō)輪速差和轉(zhuǎn)彎角速度的比例關(guān)系是機(jī)械系統(tǒng)本身就遵循的規(guī)律公式γ Δv / b只是把這個(gè)規(guī)律數(shù)學(xué)化。順便提一個(gè)對(duì)比開(kāi)過(guò)卡丁車(chē)或者沒(méi)有差速器的車(chē)輛就會(huì)知道直線過(guò)后馬上轉(zhuǎn)彎內(nèi)側(cè)輪要么被拖滑、要么被抬起因?yàn)樽笥因?qū)動(dòng)輪轉(zhuǎn)速被剛性連接鎖死。有差速器的車(chē)轉(zhuǎn)彎順暢就是因?yàn)樵试S左右輪轉(zhuǎn)速自由差動(dòng)而這個(gè)差動(dòng)量精確地等于γ × b。理解了這層機(jī)械原理再去讀公式會(huì)格外有感覺(jué)。2.3 前軸差分公式轉(zhuǎn)向角修正項(xiàng)從哪里來(lái)的前面推導(dǎo)用的是后軸因?yàn)楹筝S輪子不參與轉(zhuǎn)向?qū)^大多數(shù)前驅(qū)和四驅(qū)車(chē)而言運(yùn)動(dòng)學(xué)關(guān)系非常干凈。但有時(shí)候工程上也需要用前輪輪速差來(lái)估算橫擺角速度比如某些算法在低速階段優(yōu)先采用前軸信號(hào)。前軸多了一個(gè)轉(zhuǎn)向角δ情況就沒(méi)那么簡(jiǎn)單了。前輪有了轉(zhuǎn)向角之后左右前輪的速度不再簡(jiǎn)單地垂直于后軸連線。如果把左右前輪的輪速差直接套用γ Δv / b在轉(zhuǎn)向角較大時(shí)會(huì)引入明顯的誤差。幾何分析表明前軸輪速差與橫擺角速度的關(guān)系近似為γ ≈ (v_FR - v_FL) / (b × cos δ)其中δ是前輪平均轉(zhuǎn)向角。分母多出來(lái)的cos δ就是轉(zhuǎn)向角修正項(xiàng)。當(dāng)δ 30°時(shí)cos δ ≈ 0.866如果不做修正直接用b做分母估算出的橫擺角速度會(huì)偏大約15%。這個(gè)誤差在低速大轉(zhuǎn)角工況下已經(jīng)不容忽視了比如倒車(chē)入庫(kù)、連續(xù)掉頭ESP的參考信號(hào)如果偏差15%可能就會(huì)導(dǎo)致系統(tǒng)誤判。不過(guò)實(shí)際量產(chǎn)ESP中前軸差分用得相對(duì)少后軸信號(hào)仍然是主流。原因一是后軸沒(méi)有轉(zhuǎn)向角干擾模型更干凈二是某些四驅(qū)或前驅(qū)車(chē)型在驅(qū)動(dòng)工況下前輪容易打滑輪速可信度反而不如后軸。具體用哪一軸是方案取舍的問(wèn)題不是絕對(duì)的。2.4 量級(jí)驗(yàn)證代入真實(shí)數(shù)據(jù)算一遍公式推出來(lái)總得驗(yàn)證一下有沒(méi)有道理順便感受一下實(shí)際信號(hào)的量級(jí)。假設(shè)一輛車(chē)的輪距b 1.5 m以72 km/h20 m/s行駛通過(guò)一個(gè)轉(zhuǎn)彎半徑為50 m的彎道。橫擺角速度γ v / R 20 / 50 0.4 rad/s換算成習(xí)慣用的角速度單位乘以180/π大約23 deg/s。輪速差Δv γ × b 0.4 × 1.5 0.6 m/s。也就是說(shuō)外側(cè)輪和內(nèi)側(cè)輪的線速度分別約為20.3 m/s和19.7 m/s相對(duì)差異只有3%。再看傳感器層面的表現(xiàn)。假設(shè)輪胎有效滾動(dòng)半徑約0.31 m則內(nèi)外輪轉(zhuǎn)速約為65.5 rad/s和63.5 rad/s。齒圈48齒時(shí)對(duì)應(yīng)脈沖頻率約500 Hz和485 Hz頻率差約15 Hz。也就是說(shuō)ECU需要能從兩只輪子的脈沖頻率中穩(wěn)定分辨出約15 Hz的頻率差才能還原出這個(gè)23 deg/s的橫擺角速度——這個(gè)分辨率對(duì)于成熟的輪速采集電路來(lái)說(shuō)是可以做到的但確實(shí)不是個(gè)可以忽略的量級(jí)。不同速度、不同轉(zhuǎn)彎半徑下的典型數(shù)值我整理成了一個(gè)表格方便直觀感受車(chē)速轉(zhuǎn)彎半徑Y(jié)aw Ratedeg/s輪速差m/s48齒脈沖頻率差Hz5 km/h10 m8.00.215.230 km/h30 m15.90.4210.172 km/h50 m22.90.6015.0120 km/h300 m6.40.174.2低速急彎時(shí)輪速差絕對(duì)值小但車(chē)速低導(dǎo)致輪速信號(hào)的絕對(duì)頻率也低測(cè)量分辨率反而受限于齒圈的齒數(shù)和采集方法。高速大半徑彎道時(shí)橫擺角速度本身不大輪速差被速度放大后傳感器層面卻是可分辨的。這個(gè)平衡關(guān)系做算法時(shí)一定要心里有數(shù)。3. 從公式到量產(chǎn)算法工程實(shí)現(xiàn)中的關(guān)鍵細(xì)節(jié)3.1 有效滾動(dòng)半徑差異精度最大的隱性殺手理論公式假設(shè)左右輪有效滾動(dòng)半徑完全一致但真實(shí)車(chē)輛上這個(gè)假設(shè)幾乎不成立。左右輪胎的氣壓差、磨損程度差異、花紋深度不同、載荷轉(zhuǎn)移導(dǎo)致的輪胎徑向變形差異都會(huì)造成左右輪的有效滾動(dòng)半徑不完全相同。這個(gè)誤差有多大一個(gè)比較典型的場(chǎng)景左右輪胎氣壓差0.3 bar反映到有效滾動(dòng)半徑上的差異大約是0.2%到0.3%。車(chē)輛以60 km/h直線行駛時(shí)輪速約16.7 m/s0.25%的差異對(duì)應(yīng)的輪速差約0.04 m/s。代入γ Δv / bb取1.5 m會(huì)得出一個(gè)約1.5 deg/s的“虛假”橫擺角速度。這個(gè)量級(jí)聽(tīng)起來(lái)不大但對(duì)于ESP控制來(lái)說(shuō)已經(jīng)足以構(gòu)成干擾。控制邏輯一般在期望值和實(shí)際值的偏差超過(guò)2到3 deg/s并持續(xù)一定時(shí)間時(shí)開(kāi)始準(zhǔn)備干預(yù)輪速差估算若帶著1.5 deg/s的系統(tǒng)性誤差很容易誤觸發(fā)或者讓控制邊界變得模糊。量產(chǎn)算法通常用兩種手段來(lái)應(yīng)對(duì)一是動(dòng)態(tài)補(bǔ)償在車(chē)輛直線行駛且狀態(tài)穩(wěn)定時(shí)用轉(zhuǎn)向角傳感器信號(hào)確認(rèn)方向盤(pán)基本居中此時(shí)把左右輪速差記錄下來(lái)估算出滾動(dòng)半徑偏差的比例因子后續(xù)對(duì)這個(gè)比例做實(shí)時(shí)修正二是設(shè)置死區(qū)把低于某個(gè)閾值的輪速差直接當(dāng)作零處理避免系統(tǒng)在直線行駛時(shí)因微小輪速差產(chǎn)生無(wú)意義的波動(dòng)。3.2 死區(qū)與濾波不要讓“偽橫擺”干擾控制死區(qū)設(shè)定的本質(zhì)是承認(rèn)絕對(duì)零誤差做不到干脆在零附近劃一條“不計(jì)較”的區(qū)間。死區(qū)太小起不到過(guò)濾作用太大又會(huì)把真實(shí)的小橫擺角速度一并濾掉影響低速工況下的ESP判斷。實(shí)際工程中死區(qū)通常根據(jù)傳感器噪聲統(tǒng)計(jì)來(lái)標(biāo)定常見(jiàn)范圍在0.5到2 km/h的輪速差對(duì)應(yīng)γ約0.5到3 deg/s。濾波是另一個(gè)必不可少的環(huán)節(jié)。輪速信號(hào)本身帶有量化和噪聲尤其是低速時(shí)用周期法測(cè)量每個(gè)齒的間隔時(shí)間都有抖動(dòng)直接差分出的γ曲線會(huì)帶著明顯的毛刺。設(shè)計(jì)目標(biāo)是在抑制噪聲的同時(shí)不引入過(guò)大的相位延遲否則估算值和真實(shí)值之間出現(xiàn)滯后會(huì)影響控制介入的時(shí)機(jī)。工程上常用的做法是一階低通濾波截止頻率在5到10 Hz之間。這個(gè)頻段能保留車(chē)輛實(shí)際的橫擺動(dòng)態(tài)車(chē)輛橫擺模態(tài)的頻帶通常在2到3 Hz以內(nèi)同時(shí)抑制大部分輪速量化噪聲。做離線數(shù)據(jù)分析時(shí)我習(xí)慣用零相位濾波進(jìn)一步處理但在實(shí)時(shí)控制代碼里零相位濾波不可實(shí)現(xiàn)只能靠合理選截止頻率來(lái)平衡。3.3 驅(qū)動(dòng)與制動(dòng)工況輪速信號(hào)什么時(shí)候不能信這是整個(gè)輪速差分法最脆弱的地方。輪胎一旦出現(xiàn)縱向滑轉(zhuǎn)或滑移輪速就不再等于車(chē)輛的實(shí)際速度差分公式的前提就被破壞了。驅(qū)動(dòng)工況下的典型場(chǎng)景是急加速或低附路面起步驅(qū)動(dòng)輪轉(zhuǎn)速高于車(chē)輛實(shí)際速度內(nèi)外輪打滑程度還可能不一致導(dǎo)致輪速差被明顯放大估算出的橫擺角速度隨之失真。制動(dòng)工況下情況類(lèi)似特別是ABS或ESP主動(dòng)制動(dòng)介入時(shí)輪速會(huì)被主動(dòng)調(diào)制脈沖波動(dòng)頻繁此時(shí)輪速差已經(jīng)不能反映車(chē)輛真實(shí)的橫擺運(yùn)動(dòng)。解決方案通常有兩類(lèi)一是采用非驅(qū)動(dòng)軸的輪速信號(hào)做差分前驅(qū)車(chē)用后軸后驅(qū)車(chē)用前軸四驅(qū)車(chē)則需結(jié)合具體扭矩分配策略判斷哪一軸狀態(tài)更“干凈”二是在檢測(cè)到車(chē)輪滑移率超過(guò)閾值時(shí)將該信號(hào)源的權(quán)重調(diào)低切換到陀螺儀或橫向加速度信號(hào)作為主要參考。這里我多說(shuō)一句ESP的輪速差分估算并不需要時(shí)刻處于激活狀態(tài)。更穩(wěn)妥的設(shè)計(jì)是把它設(shè)計(jì)成一個(gè)可信任度自適應(yīng)變化的信號(hào)源——狀態(tài)好時(shí)參與融合甚至作為主信號(hào)狀態(tài)差時(shí)自動(dòng)退出讓位給陀螺儀。理解了這一點(diǎn)也就理解了為什么ESP算法很少單靠一個(gè)信號(hào)干活。4. 這臺(tái)“估算器”什么時(shí)候靠得住誤差來(lái)源與工況邊界4.1 陀螺儀與輪速差分各自的長(zhǎng)處和短板工程上有個(gè)常見(jiàn)的誤解陀螺儀直接測(cè)量橫擺角速度精度一定更好輪速差分只是性能閹割的替代品。實(shí)際情況沒(méi)那么簡(jiǎn)單。陀螺儀的短板在于零偏漂移和積分漂移特別是低速長(zhǎng)時(shí)間直線行駛時(shí)微小的零偏如果被積分位置誤差會(huì)逐漸積累輪速差分則不存在積分問(wèn)題它是純比例關(guān)系低速時(shí)信號(hào)弱、噪聲大但漂移問(wèn)題是天生的。輪速差分的強(qiáng)項(xiàng)是它的物理基準(zhǔn)非常穩(wěn)定——輪距b是固定的機(jī)械參數(shù)不隨溫度和時(shí)間漂移只要輪速脈沖計(jì)數(shù)可靠計(jì)算出的比例關(guān)系就可靠。陀螺儀的優(yōu)勢(shì)在于帶寬高、動(dòng)態(tài)響應(yīng)快不受輪胎打滑影響。兩者的短板正好互補(bǔ)所以現(xiàn)代ESP系統(tǒng)中它們不是競(jìng)爭(zhēng)關(guān)系而是互為冗余、互為校驗(yàn)的關(guān)系。比較一下幾個(gè)關(guān)鍵維度維度輪速差分法陀螺儀測(cè)量低速精度較差信號(hào)弱噪聲大較好但存在零偏漂移高速精度受滾動(dòng)半徑差異影響穩(wěn)定動(dòng)態(tài)響應(yīng)有濾波延遲帶寬高響應(yīng)快輪胎打滑影響嚴(yán)重?zé)o直接影響長(zhǎng)期漂移無(wú)有故障風(fēng)險(xiǎn)源輪速傳感器陀螺儀自身4.2 哪些場(chǎng)景會(huì)“失效”四類(lèi)典型工況分析輪速差分法失效的場(chǎng)景歸納起來(lái)主要有四類(lèi)。第一類(lèi)是低附路面冰雪、積水、沙地輪胎縱向力接近附著極限驅(qū)動(dòng)和制動(dòng)都容易引發(fā)滑轉(zhuǎn)滑移輪速信號(hào)喪失了對(duì)車(chē)速的代表性此時(shí)差分結(jié)果不可信ESP會(huì)切換信號(hào)源。第二類(lèi)是急轉(zhuǎn)向工況。大橫向加速度下輪胎進(jìn)入非線性側(cè)偏區(qū)車(chē)輛存在明顯的質(zhì)心側(cè)偏角此時(shí)剛性運(yùn)動(dòng)學(xué)假設(shè)開(kāi)始松動(dòng)。雖然輪速差與橫擺角速度在純幾何關(guān)系上依然成立但車(chē)輛的瞬時(shí)運(yùn)動(dòng)已經(jīng)不能簡(jiǎn)單用穩(wěn)態(tài)圓周運(yùn)動(dòng)描述差分公式需要更復(fù)雜的模型修正。第三類(lèi)是高速大半徑彎道。前面量級(jí)表也看到了120 km/h過(guò)300 m半徑的彎道橫擺角速度只有約6.4 deg/s輪速差約0.17 m/s。這個(gè)差值放在傳感器分辨率面前勉強(qiáng)能分辨但一旦疊加滾動(dòng)半徑差異或者微小滑移信噪比就很差了。第四類(lèi)是ESP主動(dòng)干預(yù)過(guò)程中的制動(dòng)工況。系統(tǒng)正在對(duì)單輪施加制動(dòng)力時(shí)該輪轉(zhuǎn)速被人為降低輪速差被人為制造出來(lái)此時(shí)差分結(jié)果反映的已經(jīng)不是車(chē)輛運(yùn)動(dòng)而是控制動(dòng)作本身。這種情況需要用干預(yù)狀態(tài)標(biāo)志把輪速差分信號(hào)強(qiáng)制置為不可用。4.3 信號(hào)融合原則多互相校驗(yàn)才能活下來(lái)量產(chǎn)ESP的橫擺角速度信號(hào)基本不會(huì)只用單一來(lái)源。典型的融合策略是正常工況下以陀螺儀為主輪速差分作為合理性校驗(yàn)。校驗(yàn)方法很直接——計(jì)算v × γ這個(gè)值在運(yùn)動(dòng)學(xué)上應(yīng)該約等于橫向加速度傳感器測(cè)得的a_y如果兩者偏差超過(guò)閾值并持續(xù)一段時(shí)間系統(tǒng)判定某一通道異常觸發(fā)故障診斷邏輯。在低速工況比如30 km/h以下陀螺儀的零偏影響相對(duì)占比變大而輪速差分在這種速度下雖然噪聲大但在良好路面上仍然有參考價(jià)值部分方案會(huì)加大輪速差分的權(quán)重輔助陀螺儀完成低速段的漂移修正。再補(bǔ)充一個(gè)標(biāo)定經(jīng)驗(yàn)設(shè)置故障診斷閾值時(shí)不要只看單個(gè)時(shí)刻的偏差要結(jié)合持續(xù)時(shí)間來(lái)判斷。瞬時(shí)超限可能是顛簸路面造成的傳感器沖擊連續(xù)幾百毫秒超限才值得觸發(fā)電控故障。閾值和時(shí)間的組合需要在整車(chē)耐久測(cè)試中反復(fù)驗(yàn)證過(guò)靈敏容易誤報(bào)故障碼過(guò)遲鈍則失去故障預(yù)警的意義。5. 工程實(shí)戰(zhàn)經(jīng)驗(yàn)算法落地、常見(jiàn)問(wèn)題與排查方法5.1 從CAN數(shù)據(jù)復(fù)現(xiàn)“輪速差Yaw-rate”手把手實(shí)操很多人在實(shí)車(chē)數(shù)據(jù)回放時(shí)想驗(yàn)證一下輪速差分估算效果這里給你一套最簡(jiǎn)單的復(fù)現(xiàn)流程。先從CAN總線上把四個(gè)輪速信號(hào)和陀螺儀yaw rate信號(hào)抓下來(lái)輪速通常以km/h為單位廣播先統(tǒng)一換算成m/s除以3.6。如果拿到的是電機(jī)轉(zhuǎn)速信號(hào)而非輪速還需要乘以有效滾動(dòng)半徑換算成線速度。取左右后輪速度以非驅(qū)動(dòng)軸優(yōu)先做差得到Δv。將這個(gè)差值除以輪距b就得到rad/s為單位的橫擺角速度估算值。如果想和陀螺儀輸出對(duì)比記得把單位統(tǒng)一——陀螺儀一般直接給deg/s需要把估算值乘以180/π或者反過(guò)來(lái)把陀螺儀的值除以57.3。實(shí)際處理時(shí)有個(gè)細(xì)節(jié)容易出問(wèn)題CAN報(bào)文上的輪速信號(hào)可能是經(jīng)過(guò)濾波和限幅的采樣時(shí)刻也可能與yaw rate不完全對(duì)齊。做離線分析時(shí)先檢查時(shí)間戳如果存在固定延遲先做時(shí)間對(duì)齊再做差分計(jì)算。我踩過(guò)這類(lèi)坑對(duì)不齊時(shí)間軸得到的對(duì)比曲線會(huì)帶著錯(cuò)覺(jué)般的“超前滯后”讓人誤以為是算法問(wèn)題實(shí)際是數(shù)據(jù)處理問(wèn)題。5.2 常見(jiàn)問(wèn)題速查為什么我算出來(lái)的值和傳感器對(duì)不上平時(shí)被問(wèn)到最多的一類(lèi)問(wèn)題就是“為什么我用公式算出的yaw rate和陀螺儀對(duì)不上”這里我把常見(jiàn)原因和排查思路整理成一個(gè)速查表現(xiàn)象可能原因排查方法估算值整體偏大使用了驅(qū)動(dòng)軸輪速且存在微小打滑改用非驅(qū)動(dòng)軸輪速重新計(jì)算直線行駛時(shí)有緩慢波動(dòng)左右輪滾動(dòng)半徑差異未補(bǔ)償檢測(cè)胎壓、檢查輪胎規(guī)格是否一致低速時(shí)噪聲極大輪速測(cè)量分辨率不足檢查是否用了周期法測(cè)量嘗試提高采樣分辨率動(dòng)態(tài)工況跟蹤滯后濾波截止頻率設(shè)置過(guò)低查看原始CAN信號(hào)的更新率調(diào)整濾波參數(shù)轉(zhuǎn)向角大時(shí)偏差明顯未做轉(zhuǎn)向角修正換用后軸信號(hào)或確認(rèn)算法是否支持前軸公式修正制動(dòng)時(shí)突然嚴(yán)重失真制動(dòng)干預(yù)導(dǎo)致輪速被主動(dòng)調(diào)制確認(rèn)此時(shí)ESP干預(yù)標(biāo)志位是否置位排除該工況排查這類(lèi)問(wèn)題有一個(gè)笨但有效的原則先確認(rèn)輸入信號(hào)質(zhì)量再懷疑算法。輪速信號(hào)是否可靠、是否存在斷線、通道里是否有異常的脈沖干擾這些基礎(chǔ)問(wèn)題不排查后面再精細(xì)的公式分析都是白搭。5.3 標(biāo)定過(guò)程中的幾個(gè)細(xì)節(jié)心得最后分享幾個(gè)我自己在標(biāo)定和測(cè)試中積累的細(xì)節(jié)經(jīng)驗(yàn)。第一個(gè)是死區(qū)和滾動(dòng)半徑補(bǔ)償?shù)臉?biāo)定順序問(wèn)題先做滾動(dòng)半徑補(bǔ)償再做死區(qū)標(biāo)定順序反了死區(qū)值會(huì)被舊誤差污染整個(gè)參數(shù)庫(kù)都跟著亂。第二個(gè)是關(guān)于齒圈誤差。輪速齒圈的安裝偏心或齒形加工誤差會(huì)在一個(gè)車(chē)輪旋轉(zhuǎn)周期內(nèi)產(chǎn)生周期性的頻率脈動(dòng)這個(gè)脈動(dòng)的頻率和輪速頻率直接相關(guān)。在高速工況下如果輪速差分信號(hào)出現(xiàn)了和車(chē)輪轉(zhuǎn)速頻率同步的周期性波動(dòng)建議優(yōu)先懷疑齒圈同心度問(wèn)題。第三個(gè)經(jīng)驗(yàn)是關(guān)于濾波方向的。實(shí)時(shí)算法做低通濾波時(shí)不可避免地會(huì)引入延遲。標(biāo)定中要平衡噪聲抑制和延遲之間的矛盾一個(gè)可行的手法是把濾波后的估算值和陀螺儀值做動(dòng)態(tài)加權(quán)——?jiǎng)討B(tài)工況多一點(diǎn)信任陀螺儀穩(wěn)態(tài)工況多一點(diǎn)信任輪速差分兩種濾波器參數(shù)通過(guò)工況權(quán)重切換效果往往好過(guò)單一固定參數(shù)。還有一個(gè)是我反復(fù)提醒自己的輪速差分給出的橫擺角速度本質(zhì)上是一個(gè)運(yùn)動(dòng)學(xué)約束解不是動(dòng)力學(xué)解。它告訴你“輪子這樣轉(zhuǎn)車(chē)身應(yīng)該繞什么軸轉(zhuǎn)”但它不包含任何關(guān)于輪胎力、側(cè)偏剛度、附著極限的信息。所以它很適合作參考、校驗(yàn)和冗余備份但不適合單獨(dú)撐著ESP的核心控制邏輯。使用任何間接估算信號(hào)時(shí)都保持這一點(diǎn)清醒能避免很多原理層面的誤判。