基于改進(jìn)卡爾曼濾波的叉車載重快速準(zhǔn)確估計(jì)方法

黃澤雄 劉 蘭 黃運(yùn)保 李海艷 黃東華

1.廣東工業(yè)大學(xué)機(jī)電工程學(xué)院，廣州，510006 2.廣東技術(shù)師范大學(xué)網(wǎng)絡(luò)空間安全學(xué)院，廣州，510655

0 引言

在生產(chǎn)貿(mào)易活動(dòng)中，對(duì)貨物進(jìn)行搬運(yùn)和計(jì)重是貨物估價(jià)必不可缺的環(huán)節(jié)。伸縮臂叉車作為貨物搬運(yùn)作業(yè)最為有效的工程機(jī)械之一，不但具備平衡重式叉車搬運(yùn)貨物的功能，而且在車身不動(dòng)的情況下，可以通過(guò)伸縮臂伸縮和臂架變幅等操作進(jìn)行不同高度與距離下的裝卸作業(yè)，從而被廣泛應(yīng)用于農(nóng)業(yè)、建筑業(yè)和港口裝卸等領(lǐng)域[1-2]。而現(xiàn)有伸縮臂叉車主要通過(guò)轉(zhuǎn)運(yùn)過(guò)秤的開(kāi)環(huán)反饋方式[3]對(duì)所裝卸的貨物進(jìn)行估計(jì)，效率低下，且需要花費(fèi)大量的人力物力。

在工程機(jī)械載重估計(jì)研究領(lǐng)域，目前國(guó)內(nèi)外相關(guān)研究主要集中在挖掘機(jī)、門座起重機(jī)和吊車等工程機(jī)械，而對(duì)伸縮臂叉車載重估計(jì)方面的相關(guān)研究目前還未見(jiàn)報(bào)道。在國(guó)外，MINTAH等[4]于2012年提出了一套液壓挖掘機(jī)自適應(yīng)載重監(jiān)控方案，該方案雖然能夠?qū)崿F(xiàn)載重自適應(yīng)估計(jì)，但由于有效測(cè)量范圍劃分比較難控制，在實(shí)際應(yīng)用中會(huì)受到限制。WALAWALKAR等[5]于2016年提出了一種基于測(cè)量方式的挖掘機(jī)載重估計(jì)方法，但是該種方法需要了解工作附件的慣性參數(shù)，并且其數(shù)學(xué)模型的求解較為復(fù)雜。為此，WALAWALKAR等[6]于2018年通過(guò)估計(jì)工作附件的質(zhì)量、質(zhì)心和質(zhì)量慣性矩等參數(shù)對(duì)載重估計(jì)方法進(jìn)行了改善，但是該方法對(duì)關(guān)節(jié)角加速度和動(dòng)臂慣性參數(shù)的計(jì)算要求很高。PALOMBA等[7]于2019年提出了一種基于狀態(tài)估計(jì)的載重估計(jì)方法，該方法是基于挖掘機(jī)運(yùn)動(dòng)學(xué)和動(dòng)態(tài)模型的兩階段方法進(jìn)行估計(jì)的，從而需要較多種類的傳感器。在國(guó)內(nèi)，溫建明[8]于2008年提出了一套基于模糊神經(jīng)網(wǎng)絡(luò)的門座起重機(jī)載重動(dòng)態(tài)估計(jì)方案，但該方案是在假設(shè)門座起重機(jī)勻速提升貨物的理想化狀態(tài)下進(jìn)行估計(jì)的，且該系統(tǒng)的載重估計(jì)誤差達(dá)到了5%。李婷婷[9]于2017年提出了一種考慮載重重心偏移和考慮地面坡度的叉裝車自動(dòng)載重估計(jì)算法，該算法能夠有效消除動(dòng)臂舉升速度、載重重心偏移和地面坡度對(duì)載重估計(jì)結(jié)果的影響。但該算法僅適用于典型的反轉(zhuǎn)六連桿機(jī)構(gòu)，對(duì)于不同的叉裝車工作裝置結(jié)構(gòu)，需要對(duì)載重估計(jì)數(shù)學(xué)模型進(jìn)行較大的改動(dòng)。何經(jīng)旺[10]于2015年結(jié)合挖掘機(jī)的結(jié)構(gòu)特點(diǎn)和工作環(huán)境的特殊性，根據(jù)Kane動(dòng)力學(xué)理論的動(dòng)力學(xué)和運(yùn)動(dòng)學(xué)，建立了液壓挖掘機(jī)的載重估計(jì)數(shù)學(xué)模型，然后使用遞推最小二乘算法進(jìn)行載重動(dòng)態(tài)估計(jì)。該方法可以在液壓挖掘機(jī)的任何姿態(tài)下估計(jì)出鏟斗載重大小，但因?yàn)槠鋽?shù)學(xué)模型需要辨識(shí)轉(zhuǎn)動(dòng)慣量等變量，而轉(zhuǎn)動(dòng)慣量的辨識(shí)又會(huì)涉及到挖掘機(jī)各個(gè)桿件的實(shí)時(shí)重心位置，所以在實(shí)際作業(yè)中很難進(jìn)行動(dòng)態(tài)準(zhǔn)確估計(jì)。

國(guó)內(nèi)配備有載重估計(jì)技術(shù)的工程機(jī)械的估計(jì)系統(tǒng)在準(zhǔn)確度和穩(wěn)定性控制等方面都與國(guó)外產(chǎn)品有較大的差距，雖然已經(jīng)研發(fā)了一些估計(jì)模型，但計(jì)算過(guò)于復(fù)雜且硬件成本昂貴，目前還沒(méi)有一個(gè)可靠且有效的載重動(dòng)態(tài)估計(jì)模型。研究一套伸縮臂叉車載重估計(jì)方案對(duì)國(guó)內(nèi)工程機(jī)械智能制造和實(shí)現(xiàn)碳達(dá)峰、碳中和目標(biāo)，以及智能化和無(wú)人化的貨物搬運(yùn)場(chǎng)景都具有重大的意義。

本文根據(jù)伸縮臂叉車工作裝置的工作原理和臂架結(jié)構(gòu)的組成特點(diǎn)，對(duì)臂架進(jìn)行動(dòng)力學(xué)分析，建立載重與液壓系統(tǒng)壓力、臂架變幅角度以及伸縮臂伸縮長(zhǎng)度之間成線性關(guān)系的載重估計(jì)數(shù)學(xué)模型，然后使用具有實(shí)時(shí)辨識(shí)遞推特點(diǎn)的卡爾曼濾波算法[11]對(duì)該模型進(jìn)行求解。最后，針對(duì)卡爾曼濾波算法在遞推過(guò)程中載重發(fā)生改變時(shí)新測(cè)量數(shù)據(jù)對(duì)載重估值失去校正能力的缺點(diǎn)，本文提出了一種基于改進(jìn)卡爾曼濾波的載重估計(jì)算法。目前該載重動(dòng)態(tài)估計(jì)方法已初步應(yīng)用到某企業(yè)的超長(zhǎng)重載伸縮臂叉車。

1 載重估計(jì)方案分析

本文研究了超長(zhǎng)重載伸縮臂叉車，實(shí)車如圖1所示，其尺寸和性能參數(shù)如表1所示。

圖1 超長(zhǎng)重載伸縮臂叉車Fig.1 Super long and heavy load telescopic handler

表1 伸縮臂叉車的尺寸和性能參數(shù)

1.1 基于動(dòng)力學(xué)轉(zhuǎn)動(dòng)定律間接估計(jì)

根據(jù)一些已有的工程機(jī)械工作載荷估計(jì)方案，結(jié)合伸縮臂叉車的工作原理，提出了如下三種工作載荷估計(jì)方案：

(1)采用機(jī)械軸式傳感器直接估計(jì)，在伸縮臂叉車第四級(jí)臂與貨叉的支撐鉸鏈處安裝壓力傳感器，然后在某個(gè)固定姿態(tài)下，通過(guò)對(duì)測(cè)得的傳感器信號(hào)進(jìn)行運(yùn)算處理，直接對(duì)載重進(jìn)行估計(jì)；

(2)基于靜力學(xué)力矩平衡原理[12]間接估計(jì)，將臂架固定在某個(gè)確定的變幅角度，用位移傳感器和壓力傳感器分別靜止采集伸縮臂伸縮長(zhǎng)度、變幅液壓缸和隨動(dòng)液壓缸有/無(wú)桿腔壓力，利用靜力學(xué)力矩平衡原理建立載重估計(jì)數(shù)學(xué)模型，間接對(duì)載重進(jìn)行估計(jì)[13]；

(3)基于動(dòng)力學(xué)轉(zhuǎn)動(dòng)定律[14]間接估計(jì)，與第二個(gè)方案不同，該方案是在作業(yè)過(guò)程中動(dòng)態(tài)采集臂架變幅角度、伸縮臂伸縮長(zhǎng)度、變幅液壓缸和隨動(dòng)液壓缸有/無(wú)桿腔壓力，然后根據(jù)動(dòng)力學(xué)轉(zhuǎn)動(dòng)定律建立的函數(shù)關(guān)系式，實(shí)現(xiàn)動(dòng)態(tài)載重估計(jì)。

對(duì)各方案進(jìn)行比較分析：方案(1)雖然以直接測(cè)量的方式能夠?qū)崿F(xiàn)載重動(dòng)態(tài)估計(jì)，且估計(jì)準(zhǔn)確度高、成本低。但是在作業(yè)環(huán)境惡劣、叉具頻繁更換，以及軸銷旋轉(zhuǎn)時(shí)壓力傳感器會(huì)受旋轉(zhuǎn)力作用的情況下，容易導(dǎo)致壓力傳感器失效和損耗，在實(shí)際應(yīng)用中會(huì)存在故障率高、使用壽命短和局限性大等問(wèn)題[15]；方案(2)理論上能達(dá)到較高的稱重精度，但需要靜態(tài)測(cè)量，作業(yè)效率較低；方案(3)所建立的載重估計(jì)數(shù)學(xué)模型具有較強(qiáng)的實(shí)用性和較高的估計(jì)準(zhǔn)確度，被目前工程機(jī)械載重估計(jì)領(lǐng)域應(yīng)用得最為廣泛[16-17]。

綜合比較以上三個(gè)載重估計(jì)方案的優(yōu)缺點(diǎn)，最終確定采用第三個(gè)方案，在不額外增加其他類型傳感器的情況下，利用叉車工作裝置現(xiàn)有功能模塊中已裝配的角度傳感器、位移傳感器和壓力傳感器實(shí)現(xiàn)叉車載重動(dòng)態(tài)估計(jì)。

1.2 建立載重估計(jì)數(shù)學(xué)模型

為了簡(jiǎn)化力學(xué)分析和幾何分析，假設(shè)臂架中心面與底盤縱向中垂面重合，將組成臂架的所有構(gòu)件都置于這一平面坐標(biāo)系內(nèi)，以臂架與車架的回轉(zhuǎn)銷軸鉸接點(diǎn)O為坐標(biāo)原點(diǎn)，沿伸縮臂叉車行駛的水平方向?yàn)閄軸正向，垂直于X軸的豎直向上方向?yàn)閆軸正向。將伸縮臂處于全縮回且處于水平狀態(tài)的位置設(shè)為臂架的初始位置。假設(shè)各構(gòu)件均為均質(zhì)材料，其幾何中心即重心，則構(gòu)件的重心相對(duì)于X軸正向的變幅角度定義為Δθ，除此之外，還假設(shè)重心只沿變幅角度Δθ的射線上偏移。伸縮臂叉車的載重估計(jì)力學(xué)模型簡(jiǎn)圖見(jiàn)圖2，其中，O為臂架與車架的鉸接點(diǎn)；J為變幅液壓缸缸桿與基本臂的鉸接點(diǎn)；S為變幅液壓缸缸筒與車架的鉸接點(diǎn)；M為隨動(dòng)液壓缸缸桿與基本臂的鉸接點(diǎn)；N為隨動(dòng)液壓缸缸筒與車架的鉸接點(diǎn)；F為四級(jí)臂頭部與貨叉的鉸接點(diǎn)。

圖2 伸縮臂叉車的載重估計(jì)力學(xué)模型簡(jiǎn)圖Fig.2 Mechanical model diagram for load estimationof telescopic handler

在計(jì)算臂架自重對(duì)轉(zhuǎn)動(dòng)軸的力矩時(shí)，若直接將四個(gè)節(jié)臂、伸縮液壓缸、調(diào)平液壓缸、搖桿、連桿、貨叉和連接件作為一個(gè)整體分析，當(dāng)叉車進(jìn)行變幅和伸縮等操作時(shí)，其整體重心位置就會(huì)難以確定。所以，這里采用離散化的思想，將臂架分成幾個(gè)主要構(gòu)件，然后逐個(gè)分析臂架伸縮變幅時(shí)各主要構(gòu)件重心的運(yùn)動(dòng)規(guī)律。

由于叉車工作裝置部分在正常工作時(shí)，基本臂是通過(guò)一根水平銷軸與車架松連接的，故臂架受到車架對(duì)其支承力的作用可以忽略不計(jì)，而摩擦力和調(diào)平液壓缸對(duì)貨叉的推力作為臂架的內(nèi)力則不計(jì)算在內(nèi)。臂架在車身縱截面XOZ內(nèi)會(huì)受到變幅液壓缸的作用力Fl、隨動(dòng)液壓缸的作用力Fs、載重重力Gh和臂架中各主要構(gòu)件的自身重力。由于伸縮臂叉車在起吊的時(shí)候必須打開(kāi)支腿且不能移動(dòng)，因此伸縮臂只能在變幅角度內(nèi)運(yùn)動(dòng)，水平慣性力幾乎沒(méi)有。再進(jìn)一步忽略慣性較小的調(diào)平液壓缸等構(gòu)件對(duì)臂架動(dòng)力學(xué)性能的影響后，伸縮臂叉車臂架繞定軸轉(zhuǎn)動(dòng)的微分方程為

JMα=FlLl+FsLs-G1L1-G2L2-
G3L3-G4L4-GbLb-GrLr-GfLf-GhLh

(1)

式中，JM為臂架對(duì)轉(zhuǎn)動(dòng)軸的轉(zhuǎn)動(dòng)慣量；α為臂架的角加速度，即對(duì)臂架變幅角度Δθ求時(shí)間的二階導(dǎo)數(shù)；G1、G2、G3、G4、Gb、Gr、Gf、Gh分別為基本臂、二級(jí)臂、三級(jí)臂、四級(jí)臂、伸縮液壓缸缸筒、伸縮液壓缸缸桿、貨叉以及載重的重力；L1、L2、L3、L4、Lb、Lr、Lf、Lh分別為相對(duì)應(yīng)構(gòu)件重力對(duì)轉(zhuǎn)動(dòng)軸的力臂；Fl、Fs分別為變幅液壓缸和隨動(dòng)液壓缸對(duì)臂架的作用力；Ll、Ls分別為變幅液壓缸和隨動(dòng)液壓缸作用力對(duì)轉(zhuǎn)動(dòng)軸的力臂。

對(duì)式(1)進(jìn)一步分析，在合外力矩給定的情況下，剛體的轉(zhuǎn)動(dòng)慣量越大，則所獲得的角加速度越小，即角速度改變得慢，剛體保持原有轉(zhuǎn)動(dòng)狀態(tài)的慣性就越大。考慮臂架在變幅伸縮動(dòng)作的起始加速和終止減速階段，其角加速度α較大，會(huì)對(duì)載重估計(jì)有影響，但伸縮臂叉車臂架的轉(zhuǎn)動(dòng)慣量也大，且在變幅伸縮過(guò)程中大部分時(shí)間內(nèi)都是處于穩(wěn)定階段的。所以一般認(rèn)為臂架在貨物變幅升降過(guò)程中其角速度是不變的，或者說(shuō)角加速度幾乎為零。這時(shí)，則可以忽略角加速度α的影響，從而避免臂架中各構(gòu)件因質(zhì)量和重心位置的不準(zhǔn)確而造成動(dòng)力學(xué)中關(guān)于轉(zhuǎn)動(dòng)慣量的復(fù)雜計(jì)算[18]。故有合外力矩∑MT=0，則式(1)等價(jià)于：

G1L1+G2L2+G3L3+G4L4+GbLb+GrLr+
GfLf+GhLh=FlLl+FsLs

(2)

如圖3所示，計(jì)算變幅液壓缸推力對(duì)轉(zhuǎn)動(dòng)軸的力臂。先根據(jù)余弦定理，計(jì)算出變幅液壓缸上鉸接點(diǎn)J到變幅液壓缸下鉸接點(diǎn)S的距離lJS，然后用面積公式計(jì)算三角形ΔJOS的面積，最后根據(jù)同一三角形面積相等，即可計(jì)算變幅液壓缸推力對(duì)轉(zhuǎn)動(dòng)軸的力臂Ll，其表達(dá)式為

(3)

θl=θOJ+|θOS|

圖3 變幅液壓缸對(duì)轉(zhuǎn)動(dòng)軸的力臂Fig.3 Luffing hydraulic cylinder to the rotatingshaft force arm

式中，lOJ為臂架處于水平狀態(tài)時(shí)，變幅液壓缸上鉸接點(diǎn)J到轉(zhuǎn)動(dòng)點(diǎn)O的距離；lOS為變幅液壓缸下鉸接點(diǎn)S到轉(zhuǎn)動(dòng)點(diǎn)O的距離；lJS為臂架處于水平狀態(tài)時(shí)，變幅液壓缸上鉸接點(diǎn)J到變幅液壓缸下鉸接點(diǎn)S的距離；θl為臂架處于水平狀態(tài)時(shí)，變幅液壓缸上鉸接點(diǎn)J、下鉸接點(diǎn)S與轉(zhuǎn)動(dòng)點(diǎn)O形成∠JOS的角度；θOJ為臂架處于水平狀態(tài)時(shí)，lOJ與X軸之間的初始角度；θOS為lOS與X軸之間的角度。

隨動(dòng)液壓缸阻尼力對(duì)轉(zhuǎn)動(dòng)軸的力臂Ls也可根據(jù)式(3)同理計(jì)算得到。根據(jù)各臂架中各主要構(gòu)件的幾何結(jié)構(gòu)及其重心位置的平面坐標(biāo)關(guān)系，將求解得到的有關(guān)量代入式(2)，再對(duì)該式的左邊分離出變量臂架變幅角度Δθ和伸縮臂伸縮長(zhǎng)度Δl可得到以下關(guān)系式：

a1cosΔθ-a2sinΔθ+a3ΔLcosΔθ+a4=

(4)

式中,a1、a2、a3、a4為未知參數(shù)；lOM為臂架處于水平狀態(tài)時(shí)，隨動(dòng)液壓缸上鉸接點(diǎn)M到轉(zhuǎn)動(dòng)點(diǎn)O的距離；lON為隨動(dòng)液壓缸下鉸接點(diǎn)N到轉(zhuǎn)動(dòng)點(diǎn)O的距離；lMN為臂架處于水平狀態(tài)時(shí)，隨動(dòng)液壓缸上鉸接點(diǎn)M到隨動(dòng)液壓缸下鉸接點(diǎn)N的距離；θs為臂架處于水平狀態(tài)時(shí)，隨動(dòng)液壓缸上鉸接點(diǎn)M、下鉸接點(diǎn)N與轉(zhuǎn)動(dòng)點(diǎn)O形成∠MON的角度。

進(jìn)一步將式(4)化簡(jiǎn)成矩陣的形式：

Φ·Θ=MT

(5)

Φ=[a1a2a3a4]

Θ=[cosθ-sinθΔlcosθ1]T

式中,MT為變幅液壓缸壓力和隨動(dòng)液壓缸壓力對(duì)臂架的合外力矩。

根據(jù)式(4)，在伸縮臂叉車處于空載的情況下，即Gh=0時(shí)，采集數(shù)學(xué)模型所需的全部可測(cè)變量：臂架變幅角度Δθ，伸縮臂伸縮長(zhǎng)度Δl，以及變幅液壓缸和隨動(dòng)液壓缸有/無(wú)桿腔的壓力plb、plr、psb、psr，然后將信號(hào)數(shù)據(jù)截取有效區(qū)間部分，即可辨識(shí)出四個(gè)未知參數(shù)：a1、a2、a3、a4。

將計(jì)算得到的載重重力對(duì)轉(zhuǎn)動(dòng)軸的力臂代入式(5)，即可求得出載重重力Gh與臂架變幅角度Δθ、伸縮臂伸縮長(zhǎng)度Δl，以及變幅液壓缸和隨動(dòng)液壓缸有/無(wú)桿腔的壓力plb、plr、psb、psr之間的函數(shù)關(guān)系，即載重計(jì)算公式為

LhGh=MT-Φ·Θ

(6)

2 基于改進(jìn)卡爾曼濾波的載重估計(jì)數(shù)學(xué)模型求解算法

參數(shù)估計(jì)法[19]可以將載重估計(jì)作為一個(gè)參數(shù)估計(jì)和預(yù)測(cè)問(wèn)題進(jìn)行辨識(shí)遞推，本質(zhì)上可以看作是載重估計(jì)模型辨識(shí)及其參數(shù)估計(jì)問(wèn)題：將載重估計(jì)過(guò)程作為一個(gè)參數(shù)辯識(shí)的問(wèn)題來(lái)處理，根據(jù)已經(jīng)建立好的載重估計(jì)數(shù)學(xué)模型，推導(dǎo)出一個(gè)含有未知參數(shù)的模型，然后用該模型去擬合載重估計(jì)過(guò)程的輸出信號(hào)，從而獲得最小均方誤差意義上的參數(shù)估計(jì)[20]。

卡爾曼濾波算法屬于模型辨識(shí)與參數(shù)估計(jì)方法中的一種，該算法采用辨識(shí)遞推的方式，只需在上一次結(jié)果的基礎(chǔ)上進(jìn)行下一步的運(yùn)算，不需要將數(shù)據(jù)進(jìn)行儲(chǔ)存，且運(yùn)算量小，適用于實(shí)時(shí)過(guò)程，可以用來(lái)估計(jì)只能被系統(tǒng)本身間接或不精確測(cè)量的狀態(tài)變量。

卡爾曼濾波算法的方程分為兩組：預(yù)測(cè)更新方程和測(cè)量更新方程[21-23]。在預(yù)測(cè)更新階段，利用前一時(shí)刻的狀態(tài)估計(jì)值對(duì)當(dāng)前時(shí)刻狀態(tài)進(jìn)行估計(jì)；而在測(cè)量更新階段，則利用當(dāng)前時(shí)刻狀態(tài)的測(cè)量值修正預(yù)測(cè)更新階段的預(yù)測(cè)值，以獲得一個(gè)更為精確的當(dāng)前時(shí)刻狀態(tài)估計(jì)。

將載重重力Gh作為該載重估計(jì)系統(tǒng)t時(shí)刻的狀態(tài)變量；在該估計(jì)過(guò)程中默認(rèn)前后兩個(gè)時(shí)刻的載重不發(fā)生改變，即相鄰兩個(gè)時(shí)刻的狀態(tài)并無(wú)切換，所以將狀態(tài)轉(zhuǎn)換參數(shù)A設(shè)置為1；由于系統(tǒng)中無(wú)控制信號(hào)輸入，故將控制信號(hào)U(t)設(shè)置為0，控制狀態(tài)參數(shù)B也設(shè)置為0。則預(yù)測(cè)更新方程可表示為

(7)

在預(yù)測(cè)更新階段，還需要計(jì)算t時(shí)刻的先驗(yàn)估計(jì)誤差協(xié)方差P-(t)：

P-(t)=P(t-1)+Q

(8)

式中，P(t-1)為t-1時(shí)刻的后驗(yàn)估計(jì)誤差協(xié)方差；Q為過(guò)程誤差W(t)的協(xié)方差。

將載重計(jì)算公式作為估計(jì)過(guò)程的測(cè)量更新方程：

Z(t)=Lh(t)Gh(t)+V(t)=MT(t)-
Φ·Θ(t)+V(t)

(9)

Θ(t)=[cos(θ(t)) -sin(θ(t)) Δl(t)cos(θ(t)) 1]T

式中,V(t)為測(cè)量誤差。

在測(cè)量更新階段，首先需要根據(jù)預(yù)測(cè)更新部分得到的t時(shí)刻先驗(yàn)估計(jì)誤差協(xié)方差P-(t)和測(cè)量誤差V(t)的協(xié)方差R計(jì)算出t時(shí)刻的卡爾曼增益K(t)：

(10)

(11)

最后，還需要根據(jù)t時(shí)刻的先驗(yàn)估計(jì)誤差協(xié)方差P-(t)和卡爾曼增益K(t)得到t時(shí)刻的后驗(yàn)估計(jì)誤差協(xié)方差P(t)：

P(t)=(1-K(t)Lh(t))P-(t)

(12)

基于卡爾曼濾波的載重估計(jì)算法流程如圖4所示,可以看出，隨著辨識(shí)遞推的進(jìn)行，當(dāng)后驗(yàn)估計(jì)誤差協(xié)方差P(t)減小至0時(shí)，載重估計(jì)過(guò)程將停止。

圖4 基于卡爾曼濾波的載重估計(jì)算法流程Fig.4 Algorithm flow of workload estimation based onKalman filter

在卡爾曼濾波算法辨識(shí)遞推的過(guò)程中，由于后驗(yàn)估計(jì)誤差協(xié)方差P(t)和卡爾曼增益K(t)會(huì)迅速衰減到0，并使得大量新測(cè)量數(shù)據(jù)失去對(duì)狀態(tài)變量的校正能力，這種現(xiàn)象稱為數(shù)據(jù)飽和。因此需考慮校正方案，以保持新測(cè)量數(shù)據(jù)對(duì)狀態(tài)變量估計(jì)的持續(xù)校正能力，進(jìn)而使載重估計(jì)系統(tǒng)能得到準(zhǔn)確的估計(jì)值。如圖5所示的一組數(shù)據(jù)，在t=100 s時(shí)，載重已經(jīng)發(fā)生了很大的改變，但隨著P(t)和K(t)快速減小到0，其估計(jì)值mh并不能很好地從1500 kg附近迅速地遞推到1000 kg附近。

(a)載重質(zhì)量的后驗(yàn)估計(jì)誤差協(xié)方差

對(duì)該現(xiàn)象進(jìn)一步分析可知，當(dāng)載重發(fā)生改變時(shí)，即該估計(jì)過(guò)程的狀態(tài)變量已發(fā)生了變化,此時(shí)的估計(jì)過(guò)程與狀態(tài)變量改變前的估計(jì)過(guò)程已經(jīng)不是同一過(guò)程了，而且此時(shí)的后驗(yàn)估計(jì)誤差協(xié)方差也已減小到0，若再延續(xù)前一估計(jì)過(guò)程繼續(xù)估計(jì)，則卡爾曼濾波算法將會(huì)無(wú)法繼續(xù)準(zhǔn)確遞推。

本文受到交互式多模型(interacting multiple model，IMM)[24]的啟發(fā)，采用兩個(gè)并行計(jì)算的卡爾曼濾波對(duì)載重估計(jì)數(shù)學(xué)模型進(jìn)行辨識(shí)遞推：第一個(gè)卡爾曼濾波主要是起到自適應(yīng)判斷載重是否有較大幅度變化的作用，通過(guò)實(shí)時(shí)監(jiān)控前后兩時(shí)刻狀態(tài)變量之差的更新率，為其設(shè)置合適的閾值，進(jìn)而決定是否重置第二個(gè)卡爾曼濾波的后驗(yàn)估計(jì)誤差協(xié)方差，以達(dá)到快速響應(yīng)的效果；第二個(gè)卡爾曼濾波主要是起到穩(wěn)定估計(jì)值的效果，其狀態(tài)變量作為全過(guò)程載重估計(jì)值的輸出。

基于改進(jìn)卡爾曼濾波的載重估計(jì)算法流程如圖6所示，具體過(guò)程如下。

圖6 基于改進(jìn)卡爾曼濾波的載重估計(jì)算法流程Fig.6 Workflow of workload estimation algorithmbased on improved Kalman filter

后驗(yàn)估計(jì)誤差協(xié)方差P1(t)和P2(t)重置為初始值的目的是，使大量新測(cè)量數(shù)據(jù)保持對(duì)載重估計(jì)的校正能力；而采用兩個(gè)并行計(jì)算的卡爾曼濾波進(jìn)行遞推的方式能夠起到自適應(yīng)估計(jì)的作用，快速辨識(shí)出載重發(fā)生變化的時(shí)間點(diǎn)，并準(zhǔn)確估計(jì)出變化前后的載重。

3 載重估計(jì)試驗(yàn)驗(yàn)證

3.1 試驗(yàn)平臺(tái)搭建

試驗(yàn)平臺(tái)以某企業(yè)研發(fā)的超長(zhǎng)重載伸縮臂叉車為研究對(duì)象，具體的基礎(chǔ)配置、尺寸參數(shù)和性能參數(shù)已在前文給出。為了減小各類型傳感器測(cè)量誤差對(duì)載重估計(jì)準(zhǔn)確度的影響，保證其采集信號(hào)數(shù)據(jù)的測(cè)量精度，試驗(yàn)采用的傳感器包括：Gefran公司GSF系列的位移傳感器，長(zhǎng)沙灣流智能科技有限公司的VALUER SpaceVector高動(dòng)態(tài)空間角度傳感器，Danfoss公司MBS3000型號(hào)的壓力傳感器。傳感器的安裝位置如圖7所示。

(a)角度傳感器 (b)位移傳感器 (c)隨動(dòng)液壓缸 (d)變幅液壓缸圖7 傳感器的安裝位置Fig.7 Installation position of sensor

如圖7a中白實(shí)線圈所示，在第四級(jí)臂的頭部安裝高性能角度傳感器，用于實(shí)時(shí)測(cè)量臂架變幅角度。如圖7b中白實(shí)線圈所示，在基本臂安裝拉繩式位移傳感器，導(dǎo)線掛在第二級(jí)臂，當(dāng)伸縮臂進(jìn)行伸縮動(dòng)作時(shí)，實(shí)時(shí)測(cè)量伸縮臂伸縮長(zhǎng)度。圖7c所示為隨動(dòng)液壓缸；圖7d所示為變幅液壓缸，其中白實(shí)線圈內(nèi)為變幅液壓缸無(wú)桿腔壓力測(cè)點(diǎn)，白虛線圈內(nèi)為變幅液壓缸有桿腔壓力測(cè)點(diǎn)，在測(cè)點(diǎn)處安裝壓力傳感器，則可以測(cè)量變幅液壓缸四個(gè)腔的壓力。

圖8 電氣系統(tǒng)的主要控制架構(gòu)Fig.8 Main control architecture of electrical system

伸縮臂叉車電氣系統(tǒng)的主要控制架構(gòu)如圖8所示。可以看出，位移傳感器和角度傳感器以及與采集電路板檢測(cè)裝置的壓力信號(hào)輸入端連接的四個(gè)壓力傳感器通過(guò)CAN總線將這六個(gè)傳感器的模擬量數(shù)據(jù)發(fā)送到主控制器；然后，由主控制器讀取傳感器輸出得模擬量數(shù)據(jù)并轉(zhuǎn)換成數(shù)字量，再將其發(fā)送到CAN總線；最后，由主控制器中的載重估計(jì)算法模塊進(jìn)行運(yùn)算處理，最后再將估計(jì)結(jié)果發(fā)送到CAN總線，且由顯示器接收并顯示。

在試驗(yàn)平臺(tái)的搭建過(guò)程中，為了能夠充分滿足應(yīng)變、位移和壓力等不同類型信號(hào)數(shù)據(jù)的輸入要求，這里使用HBM公司的SoMat eDAQ數(shù)據(jù)采集系統(tǒng)進(jìn)行數(shù)據(jù)采集與分析。將壓力傳感器連接到臂架系統(tǒng)的液壓油路，從總線中接出電信號(hào)的采集數(shù)據(jù)，將壓力傳感器輸出線接入與計(jì)算機(jī)直接連接的數(shù)據(jù)采集儀，即可將信號(hào)數(shù)據(jù)輸出至計(jì)算機(jī)中，然后使用SoMat TCE軟件進(jìn)行信號(hào)數(shù)據(jù)采集，試驗(yàn)時(shí)的采集頻率設(shè)置為40 Hz。數(shù)據(jù)采集儀與計(jì)算機(jī)直接連接如圖9所示。

圖9 Somat eDAQ數(shù)據(jù)采集儀與計(jì)算機(jī)直接連接Fig.9 Somat EDAQ data acquisition instrument isdirectly connected with the computer

3.2 算法初值選擇和參數(shù)設(shè)置

算法中參數(shù)的說(shuō)明與設(shè)置如下：

(2)后驗(yàn)估計(jì)誤差協(xié)方差初始值。由式(10)可知，在測(cè)量誤差協(xié)方差R確定的情況下，卡爾曼增益K(t)與先驗(yàn)估計(jì)誤差協(xié)方差P-(t)正相關(guān)；而由式(8)可知，在過(guò)程誤差協(xié)方差Q確定的情況下，P-(t)又與后驗(yàn)估計(jì)誤差協(xié)方差P(t)成正比的關(guān)系。故P(t)的初值越大，就會(huì)使遞推過(guò)程中計(jì)算的K(t)就越大，則意味著實(shí)際測(cè)量值Z(t)更可信。在該載重估計(jì)系統(tǒng)中，由于液壓系統(tǒng)壓力的測(cè)量噪聲是很大的，故后驗(yàn)估計(jì)誤差協(xié)方差的初始值P1(0)、P2(0)都設(shè)置為100。

(3)測(cè)量誤差協(xié)方差初始值。由預(yù)測(cè)更新方程和測(cè)量更新方程可知，載重估計(jì)系統(tǒng)某一時(shí)刻的載重值會(huì)有兩個(gè)，分別為經(jīng)驗(yàn)的預(yù)測(cè)值和模型的測(cè)量值，而卡爾曼濾波算法需要在預(yù)測(cè)值和測(cè)量值之間的過(guò)渡階段，結(jié)合過(guò)程噪聲W(t)和測(cè)量誤差V(t)，遞推出該系統(tǒng)在統(tǒng)計(jì)意義下最為接近載重真實(shí)值的最優(yōu)估計(jì)值，因此在遞推過(guò)程中到達(dá)穩(wěn)定估計(jì)值之前會(huì)具有一個(gè)過(guò)渡階段。而測(cè)量誤差協(xié)方差R則會(huì)影響該過(guò)渡階段所需要的時(shí)間以及載重估計(jì)值與真實(shí)值之間的近似程度。當(dāng)R比較小時(shí)，意味著實(shí)際測(cè)量值Z(t)越來(lái)越可信，而估計(jì)測(cè)量值Lh(t)Gh(t)則越來(lái)越不可信，此時(shí)算法收斂至穩(wěn)定估計(jì)值的響應(yīng)時(shí)間很短，但當(dāng)R過(guò)小時(shí)，系統(tǒng)容易出現(xiàn)震蕩現(xiàn)象；當(dāng)R比較大時(shí)，意味著Z(t)的可信度越來(lái)越低，而Lh(t)Gh(t)則越來(lái)越可信，此時(shí)算法收斂速度很慢，系統(tǒng)的響應(yīng)時(shí)間較長(zhǎng)[25]。在實(shí)際應(yīng)用中，可以采集一些離線樣本信號(hào)，并對(duì)其測(cè)量信號(hào)的噪聲，通過(guò)分析純?cè)肼晛?lái)對(duì)R進(jìn)行確定。通過(guò)多次試驗(yàn)的參數(shù)調(diào)整，卡爾曼濾波Γ1和Γ2的R取0.01～1.00。

(4)過(guò)程誤差協(xié)方差初始值。過(guò)程誤差協(xié)方差Q表示建立的預(yù)測(cè)模型本身帶來(lái)的噪聲，該參數(shù)被用來(lái)表示狀態(tài)轉(zhuǎn)換參數(shù)A與實(shí)際過(guò)程之間的誤差。Q會(huì)影響辨識(shí)遞推后曲線的平滑程度，因?yàn)闊o(wú)法直接觀察系統(tǒng)的估計(jì)過(guò)程，所以確定其大小是比較困難的。由于在該載重估計(jì)過(guò)程中默認(rèn)前后兩個(gè)時(shí)刻的載重是不發(fā)生改變的，故卡爾曼濾波Γ1和Γ2的Q都取0[26]。

(5)若卡爾曼濾波Γ1中的閾值γ過(guò)小，則會(huì)影響系統(tǒng)估計(jì)值的不穩(wěn)定性；若γ過(guò)大，則會(huì)延長(zhǎng)估計(jì)系統(tǒng)的響應(yīng)時(shí)間。故γ一般取一到兩個(gè)采樣周期，這里取40～80個(gè)采樣點(diǎn)。閾值β表示為判斷載重發(fā)生變化的幅度，變化幅度一旦超過(guò)閾值就會(huì)觸發(fā)后驗(yàn)估計(jì)誤差協(xié)方差P2(t)重置為初始值，這時(shí)估計(jì)過(guò)程將重新開(kāi)始。閾值β根據(jù)試驗(yàn)時(shí)的經(jīng)驗(yàn)值，取200～500 kg。

3.3 離線試驗(yàn)結(jié)果與分析

進(jìn)行了四組不同載重的離線試驗(yàn)，驗(yàn)證所提出的基于改進(jìn)卡爾曼濾波的載重估計(jì)算法是否達(dá)到以下產(chǎn)品研發(fā)要求：

(1)對(duì)于454 kg的輕載荷，其估計(jì)結(jié)果的最大絕對(duì)誤差應(yīng)小于91 kg。因?yàn)樵撦d重估計(jì)數(shù)學(xué)模型主要利用液壓系統(tǒng)壓力信號(hào)實(shí)現(xiàn)間接估計(jì)，輕載對(duì)液壓缸壓力變化的敏感度較小，伸縮臂叉車臂架的穩(wěn)定性較差，從而會(huì)導(dǎo)致估計(jì)難度陡增，所以在輕載情況下，估計(jì)精度可以適當(dāng)?shù)亟档汀?/p>

(2)對(duì)于2268 kg、3368 kg和4536 kg的重載荷，其估計(jì)結(jié)果的平均絕對(duì)百分比誤差應(yīng)小于3%。

(3)在臂架變幅和伸縮臂伸縮等多任務(wù)況造成較大的沖擊時(shí)，算法依然能夠快速收斂到真實(shí)值，即算法需要滿足載重估計(jì)的穩(wěn)定性。

離線試驗(yàn)的結(jié)果如圖10～圖13所示，其中伸縮臂長(zhǎng)度l為基本臂與3倍伸縮臂伸縮長(zhǎng)度Δl之和。離線試驗(yàn)是在MATLAB2019a環(huán)境下進(jìn)行的，計(jì)算機(jī)處理器為英特爾第三代酷睿i5-3320M 2.60 GHz，運(yùn)行內(nèi)存為海力士8GB DDR3L 1600 MHz。

(a)伸縮臂長(zhǎng)度

(a)伸縮臂長(zhǎng)度

(a)伸縮臂長(zhǎng)度

(a)伸縮臂長(zhǎng)度

分析圖10～圖13的臂架變幅和伸縮臂伸縮過(guò)程可以發(fā)現(xiàn)，當(dāng)進(jìn)行變幅和伸縮動(dòng)作時(shí)，會(huì)造成液壓系統(tǒng)壓力振蕩等不穩(wěn)定性情況，在未使用載重估計(jì)算法辨識(shí)遞推而根據(jù)載重計(jì)算公式直接求解時(shí)，載重會(huì)有相當(dāng)大的波動(dòng)，嚴(yán)重偏離了真實(shí)值；而使用載重估計(jì)算法辨識(shí)遞推之后，載重估計(jì)值可以快速收斂至真實(shí)值。辨識(shí)遞推前后的載重質(zhì)量見(jiàn)表2。

表2 辨識(shí)遞推前后的載重質(zhì)量(離線試驗(yàn))

使用最大絕對(duì)百分比誤差emax和平均絕對(duì)百分比誤差emape以及其辨識(shí)遞推過(guò)程所需的計(jì)算處理時(shí)間對(duì)所提出的基于改進(jìn)卡爾曼濾波的載重估計(jì)算法進(jìn)行定性和定量評(píng)價(jià)。emape表示估計(jì)值較真實(shí)值的平均偏離程度，其值越小，說(shuō)明載重估計(jì)模型準(zhǔn)確度越高。辨識(shí)遞推后的載重絕對(duì)百分比誤差及計(jì)算時(shí)間見(jiàn)表3。

表3 辨識(shí)遞推后的載重絕對(duì)百分比誤差及計(jì)算時(shí)間

由表3可以看出，經(jīng)過(guò)載重估計(jì)算法快速準(zhǔn)確辨識(shí)遞推之后，除了第1組454 kg的載重試驗(yàn)外，第2～4組試驗(yàn)的平均絕對(duì)百分比誤差都在3%以內(nèi)；再結(jié)合圖10～圖13來(lái)看，最大絕對(duì)百分比誤差都是在臂架變幅上升的初始階段或變幅角度最大的位置(紅實(shí)圈處)，因?yàn)樵谶@些位置上，伸縮臂處于變幅的極限位置或者叉具觸碰地面等情況，導(dǎo)致整個(gè)臂架受力比較復(fù)雜；對(duì)于454 kg的載重試驗(yàn)，其平均絕對(duì)百分比誤差和最大絕對(duì)百分比誤差都比較大，但其最大絕對(duì)百分比誤差9.833%在要求的范圍內(nèi)；從辨識(shí)遞推時(shí)間來(lái)看，基于改進(jìn)卡爾曼濾波的載重估計(jì)算法的計(jì)算效率比較高。根據(jù)離線試驗(yàn)的分析結(jié)果，初步達(dá)到了試驗(yàn)的目的與研發(fā)的要求。

3.4 在線試驗(yàn)結(jié)果與分析

最終的在線試驗(yàn)結(jié)果如圖14～圖18所示。對(duì)圖14～圖18中伸縮臂叉車帶載重時(shí)臂架變幅和伸縮臂伸縮過(guò)程分析可知：

(1)對(duì)比辨識(shí)遞推前后的載重質(zhì)量，使用基于改進(jìn)卡爾曼濾波的載重估計(jì)算法求解該數(shù)學(xué)模型，估計(jì)結(jié)果的穩(wěn)定性得到了很大改善，即使辨識(shí)遞推前載重會(huì)有相當(dāng)大的波動(dòng)，辨識(shí)遞推后也可以快速收斂至載重估計(jì)值真實(shí)值附近；

(a)伸縮臂長(zhǎng)度

(a)伸縮臂長(zhǎng)度

(2)當(dāng)要叉起一個(gè)置于地面的貨物時(shí)，由于提升前貨叉是處于松弛狀態(tài)，而伸縮臂叉車以較快的速度突然變幅提升載重，這樣的起升過(guò)程會(huì)產(chǎn)生一個(gè)較大的慣性沖擊，從而導(dǎo)致載重估計(jì)值偏離真實(shí)值(紅實(shí)線圈處)。所以為了提高載重估計(jì)的準(zhǔn)確度，在作業(yè)現(xiàn)場(chǎng)，操作員應(yīng)當(dāng)以較低的速度叉起重物，進(jìn)而使臂架逐漸受力及變形后，再以額定速度變幅提升；

(3)當(dāng)臂架變幅角度達(dá)到最大角度71°或者變幅角度為0°時(shí)，整車的穩(wěn)定性能最差，載重估計(jì)值會(huì)產(chǎn)生較大的波動(dòng)(紅虛線圈處)。這是由于液壓系統(tǒng)的泄壓、保壓和漏油等原因造成的。

(a)伸縮臂長(zhǎng)度

(a)伸縮臂長(zhǎng)度

以上5組不同載重的在線試驗(yàn)，其辨識(shí)遞推前后的載重質(zhì)量見(jiàn)表4。辨識(shí)遞推后的載重絕對(duì)百分比誤差見(jiàn)表5。

由表5可以看出，經(jīng)過(guò)載重估計(jì)算法快速準(zhǔn)確辨識(shí)遞推之后，除了第5組454 kg的載重試驗(yàn)外，第6～9組試驗(yàn)的平均絕對(duì)百分比誤差都在3%以內(nèi)；與離線試驗(yàn)相同，最大絕對(duì)百分比誤差也都是伸縮臂處于變幅范圍的極限位置或在變幅提升的初始階段；對(duì)于第5組454 kg的載重試驗(yàn)，其平均絕對(duì)百分比誤差和最大絕對(duì)百分比誤差也比較大，其最大絕對(duì)百分比誤差16.142%，但也在要求的范圍內(nèi)。

(a)伸縮臂長(zhǎng)度

表4 辨識(shí)遞推前后的載重質(zhì)量(在線試驗(yàn))

表5 辨識(shí)遞推前后載重估計(jì)的絕對(duì)百分比誤差

為驗(yàn)證本文所提出的載重估計(jì)算法解決數(shù)據(jù)飽和現(xiàn)象的性能表現(xiàn)，以及更換載重或載重發(fā)生較大幅度變化時(shí)，該算法能否快速收斂到相應(yīng)載重的真實(shí)值，即載重估計(jì)系統(tǒng)達(dá)到穩(wěn)定估計(jì)值的響應(yīng)時(shí)間是否很短，進(jìn)行了更換不同載重的在線試驗(yàn)。伸縮臂叉車載重發(fā)生變化時(shí)的在線試驗(yàn)如圖19所示。

(a)伸縮臂長(zhǎng)度

與圖5相比，由圖19可以看出，每當(dāng)載重發(fā)生變化時(shí)，該系統(tǒng)不僅能夠自適應(yīng)估計(jì)，而且能夠快速準(zhǔn)確地辨識(shí)遞推到相應(yīng)載重的真實(shí)值附近，趨于穩(wěn)定估計(jì)值的響應(yīng)時(shí)間可以在1 s之內(nèi)。

4 結(jié)語(yǔ)

本文在伸縮臂叉車工作裝置的結(jié)構(gòu)組成和工作原理的基礎(chǔ)上，建立了基于動(dòng)力學(xué)的載重估計(jì)數(shù)學(xué)模型，并推導(dǎo)出了載重計(jì)算公式，然后將該公式作為卡爾曼濾波算法的測(cè)量更新方程，將載重估值作為預(yù)測(cè)更新方程的狀態(tài)變量，對(duì)數(shù)學(xué)模型進(jìn)行求解。最后，通過(guò)不同載重的離線試驗(yàn)和在線試驗(yàn)，得出以下結(jié)論：

(1)將載重估計(jì)作為一個(gè)模型辨識(shí)和參數(shù)估計(jì)的問(wèn)題來(lái)處理，即根據(jù)動(dòng)力學(xué)原理和伸縮臂叉車工作裝置的幾何結(jié)構(gòu)關(guān)系，推導(dǎo)出一個(gè)含有未知參數(shù)的數(shù)學(xué)模型，然后用基于卡爾曼濾波算法遞推辨識(shí)載重的估計(jì)值，此種通過(guò)液壓缸壓力值間接估計(jì)載重的方法具有可行性和可靠性。對(duì)于454 kg的輕載荷，其估計(jì)結(jié)果的最大絕對(duì)誤差小于91 kg，而對(duì)于1100 kg、2268 kg、3368 kg和4536 kg的重載荷，其平均絕對(duì)百分比誤差小于3%，而且估計(jì)系統(tǒng)穩(wěn)定性好。該估計(jì)方法模型簡(jiǎn)單、可移植強(qiáng)，可以擴(kuò)展應(yīng)用到吊車、門座起重機(jī)等工程機(jī)械的載重估計(jì)領(lǐng)域，對(duì)工業(yè)領(lǐng)域的自動(dòng)化、智能化具有一定的實(shí)際應(yīng)用意義。

(2)經(jīng)過(guò)在線試驗(yàn)驗(yàn)證，本文所提出的基于改進(jìn)卡爾曼濾波的載重估計(jì)算法能夠解決因載重發(fā)生突變以及大量新測(cè)量數(shù)據(jù)失去而對(duì)載重估值進(jìn)行校正的數(shù)據(jù)飽和問(wèn)題。當(dāng)載重發(fā)生變化時(shí)，該算法能夠自適應(yīng)且快速準(zhǔn)確地辨識(shí)遞推到相應(yīng)載重的真實(shí)值附近，趨于穩(wěn)定估計(jì)值的時(shí)間可以在1 s內(nèi)。

本文針對(duì)伸縮臂叉車工作載荷快速準(zhǔn)確估計(jì)方法進(jìn)行了初步的理論分析和試驗(yàn)驗(yàn)證，但由于研究?jī)?nèi)容涉及的范圍較為廣泛，對(duì)影響該方法的一些其他因素和情況未能進(jìn)行更加詳細(xì)和深入的研究。后續(xù)可以從以下幾個(gè)方面進(jìn)行進(jìn)一步研究：

(1)在建立基于動(dòng)力學(xué)的數(shù)學(xué)模型時(shí)忽略了液壓油溫度、摩擦力和工作裝置磨損度等因素。不同溫度下液壓系統(tǒng)液壓油黏度等特性會(huì)發(fā)生變化，從而改變液壓缸液壓力，但是影響不大，一般可以采用強(qiáng)制預(yù)熱的方法解決；而摩擦力主要產(chǎn)生于工作裝置各個(gè)鉸接點(diǎn)處，特別是臂架與車架的鉸接點(diǎn)，為了減小誤差，可以考慮在工作載荷估計(jì)數(shù)學(xué)模型引入補(bǔ)償系數(shù)。這些因素還會(huì)影響工作載荷估計(jì)數(shù)學(xué)模型中的四個(gè)未知參數(shù)，而本文采取的是離線辨識(shí)，為了避免需重新辨識(shí)參數(shù)而造成的麻煩，還需研究在線辨識(shí)未知參數(shù)的情況。

(2)由離線試驗(yàn)和在線試驗(yàn)的試驗(yàn)結(jié)果可知：當(dāng)進(jìn)行變幅和伸縮動(dòng)作或以較高速度突然變幅提升重物時(shí)，由于慣性沖擊等作用會(huì)造成液壓系統(tǒng)壓力的不穩(wěn)定，導(dǎo)致工作載荷的絕對(duì)百分比誤差會(huì)比較大；在初始階段或變幅角度最大處時(shí)，由于伸縮臂處于變幅的極限位置或者叉具觸碰地面等情況，導(dǎo)致臂架受力比較復(fù)雜，通過(guò)工作載荷估計(jì)算法辨識(shí)遞推得到的工作載荷估計(jì)值也會(huì)有相當(dāng)大的波動(dòng)。為此，可以在伸縮臂上安裝霍爾傳感器，在設(shè)定的變幅角度和伸縮長(zhǎng)度條件下，自動(dòng)采集液壓缸壓力數(shù)據(jù)，選擇數(shù)據(jù)中的某一區(qū)間作為估計(jì)系統(tǒng)的有效數(shù)據(jù)采樣區(qū)間，進(jìn)而進(jìn)一步提高估計(jì)的準(zhǔn)確度。