挖掘機(jī)自動(dòng)測(cè)深儀的研制

1、    挖掘機(jī)自動(dòng)測(cè)深儀的研制        潘松峰 時(shí)間:2009年02月06日     字 體: 大 中 小        關(guān)鍵詞:<"cblue" " target='_blank'>A/D<"cblue" " target='_blank'&

2、gt;自動(dòng)測(cè)量<"cblue" " target='_blank'>接地平面<"cblue" " target='_blank'>接口電路<"cblue" " target='_blank'>數(shù)學(xué)模型            ? 摘? 要: 根據(jù)挖掘機(jī)的結(jié)構(gòu)特點(diǎn),建立了挖掘深度測(cè)量的<"cb

3、lue" " title="數(shù)學(xué)模型">數(shù)學(xué)模型,論述了挖掘機(jī)自動(dòng)測(cè)深儀的硬件/軟件結(jié)構(gòu)、工作原理、性能指標(biāo)及可靠性等。?關(guān)鍵詞: <"cblue" " title="自動(dòng)測(cè)量">自動(dòng)測(cè)量? 儀器? 儀表? 微機(jī)? 挖掘機(jī)? 挖掘機(jī)是重要的工程機(jī)械,其作業(yè)環(huán)境比較復(fù)雜,有時(shí)屬于惡劣環(huán)境。如遇危險(xiǎn)場(chǎng)合或進(jìn)行水下挖掘時(shí),挖掘的深度難以測(cè)量,直接影響了挖掘的質(zhì)量和效率。為了改變這一狀況,我們開發(fā)研制了一種適合挖掘機(jī)工作環(huán)境的高穩(wěn)定性和高可靠性的自動(dòng)測(cè)深儀。它能夠自動(dòng)測(cè)量并顯示挖掘深度,可設(shè)定挖

4、掘界限,挖掘時(shí)遇限報(bào)警,以指導(dǎo)操作人員有效地工作。? 無論是輪式挖掘機(jī)還是履帶式挖掘機(jī),其工作裝置主要由動(dòng)臂、斗桿、鏟斗等部件組成,各部件以轉(zhuǎn)動(dòng)關(guān)節(jié)鉸接在一起,每個(gè)關(guān)節(jié)具有一個(gè)自由度,并由相應(yīng)的動(dòng)力部件(油缸)驅(qū)動(dòng)。挖掘的深度與各組件的相對(duì)空間位置有關(guān)。根據(jù)挖掘機(jī)工作裝置的結(jié)構(gòu)特點(diǎn)建立相應(yīng)的深度測(cè)量模型,這是自動(dòng)測(cè)量的基礎(chǔ)。?1 建立數(shù)學(xué)模型? 按以下規(guī)則建立直角坐標(biāo)系:? 基坐標(biāo)系O0X0Y0Z0與挖掘機(jī)下車架固聯(lián),坐標(biāo)原點(diǎn)O0在動(dòng)臂與下車架鉸點(diǎn)處,X0軸為下車架正前方,Z0軸垂直于<"cblue" " title="接地平面">

5、接地平面,Y0軸按右手規(guī)則確定。? 第i個(gè)坐標(biāo)系OiXiYiZi與第i個(gè)關(guān)節(jié)固聯(lián),坐標(biāo)原點(diǎn)在第i+1個(gè)關(guān)節(jié)的鉸點(diǎn)中心,并遵循以下三個(gè)條件:? Zi軸與第i+1個(gè)關(guān)節(jié)的運(yùn)動(dòng)軸方向一致; ? Xi軸垂直于Zi-1軸,? Yi軸由右手規(guī)則確定。? 兩坐標(biāo)系的聯(lián)系可由四個(gè)參數(shù)來確定,四個(gè)參數(shù)定義如下:? i:關(guān)于Zi-1軸,按右手規(guī)則,從Xi-1到Xi的轉(zhuǎn)角;? di:從第i-1個(gè)坐標(biāo)系Oi-1Xi-1Yi-1Zi-1的原點(diǎn)Oi-1沿著Zi-1軸到Xi軸與Xi-1軸相交點(diǎn)的距離;? ai:從Zi-1軸與Xi軸的交點(diǎn),沿Xi軸到第i個(gè)坐標(biāo)系坐標(biāo)原點(diǎn)的偏移距離;? i:關(guān)于Xi軸,按右手規(guī)則從Zi-1軸到

6、Zi軸的轉(zhuǎn)角。? 四個(gè)參數(shù)中,連桿參數(shù)(ai,i)由連桿的結(jié)構(gòu)決定,是常數(shù);關(guān)節(jié)參數(shù)(i,di)決定相鄰連桿的相對(duì)位置。由于在挖掘機(jī)中均為轉(zhuǎn)動(dòng)關(guān)節(jié),因此,di是常數(shù),i是變量。由上述定義可以看出,經(jīng)過以下四步,可以使坐標(biāo)系OiXiYiZi與Oi-1Xi-1Yi-1Zi-1重合:? 繞Zi-1軸旋轉(zhuǎn)i角,使Xi-1軸與Xi軸平行;? 沿Zi-1軸平移距離di,使Xi-1軸與Xi軸位于同一直線上;? 沿Xi軸平移距離ai,使兩坐標(biāo)系原點(diǎn)重合;? 繞Xi軸旋轉(zhuǎn)i角,使兩坐標(biāo)系重合。? 這樣,兩坐標(biāo)系之間的聯(lián)系可由一個(gè)4×4齊次變換矩陣來表示:?式中,Si=sini,Ci=cosi,Si=s

7、ini,Ci=cosi,Rot表示回轉(zhuǎn)因子,Trans表示平移因子,表示第i個(gè)坐標(biāo)系相對(duì)于第i-1個(gè)坐標(biāo)系的齊次變換矩陣。? 按上述規(guī)則建立的挖掘機(jī)工作裝置直角坐標(biāo)系如圖1所示。履帶或輪胎接地平面為M0,點(diǎn)A為動(dòng)臂與上車架鉸點(diǎn),點(diǎn)B為動(dòng)臂與斗桿的鉸點(diǎn),點(diǎn)C為斗桿與鏟斗的鉸點(diǎn),點(diǎn)D為斗尖,鉸點(diǎn)A與平面M0的距離為L0。? 坐標(biāo)系O0X0Y0Z0的原點(diǎn)O0在A點(diǎn),O1X1Y1Z1的原點(diǎn)O1也在A點(diǎn),O2X2Y2Z2的原點(diǎn)O2在B點(diǎn),O3X3Y3Z3的原點(diǎn)O3在C點(diǎn),O4X4Y4Z4的原點(diǎn)O4在D點(diǎn)。根據(jù)坐標(biāo)系建立規(guī)則可得各坐標(biāo)系參數(shù)如表1所示。? 由式(1)可得:? 可進(jìn)一步求出第i個(gè)坐標(biāo)系相對(duì)于

8、基坐標(biāo)系的齊次變換矩陣:? 矩陣為挖掘機(jī)鏟斗末端相對(duì)于基坐標(biāo)系的齊次變換矩陣。態(tài),且? 將式(2)、(3)、(4)、(5)代入式(7),可得:? pz=-L3S234-L2S23-L1S2? (8)?其中,S234=sin(2+3+4),S23=sin(2+3),S2=sin2? pz即為鏟斗末端在基坐標(biāo)系中Z0軸上的坐標(biāo)量。深度測(cè)量以挖掘機(jī)輪胎或履帶接地平面M0為參考平面,若動(dòng)臂和上車架鉸點(diǎn)與接地平面之間的距離為L0,可得挖掘深度測(cè)量數(shù)學(xué)模型為:? H0=L0+pz=L0-L3S234-L2S23-L1S2? (9)? 從式(9)可看出,除了挖掘機(jī)結(jié)構(gòu)參數(shù)L0、L1、L2、L3等常數(shù)以外,挖

9、掘深度只與3個(gè)角度有關(guān)。?2 硬件設(shè)計(jì)? 挖掘機(jī)自動(dòng)測(cè)深儀的硬件結(jié)構(gòu)如圖2所示,由以下幾個(gè)部分組成:轉(zhuǎn)角傳感器、<"cblue" " title="A/D">A/D轉(zhuǎn)換接口、MCS51主機(jī)板、數(shù)碼顯示接口、鍵盤接口、電源等。? 轉(zhuǎn)角傳感器:用于測(cè)量動(dòng)臂與車體(2)、斗桿與動(dòng)臂(3)、鏟斗與斗桿(4)等之間的夾角,輸出標(biāo)準(zhǔn)電流信號(hào),輸送到A/D轉(zhuǎn)換接口。? A/D轉(zhuǎn)換接口:由I/V變換電路、高精度參考電源、A/D轉(zhuǎn)換電路及其相應(yīng)<"cblue" " title="接口電路">

10、;接口電路組成。功能是將電流信號(hào)轉(zhuǎn)變成電壓,并由A/D轉(zhuǎn)換電路轉(zhuǎn)換成數(shù)字量,經(jīng)接口電路輸入到主機(jī)板。? MCS51主機(jī)板:是硬件系統(tǒng)的核心,主要由單片機(jī)AT89C52、E2PROM存儲(chǔ)器2864A、日歷時(shí)鐘12887及I/O接口電路組成。軟件固化在單片機(jī)AT89C52中,是系統(tǒng)運(yùn)行的控制中心。? 數(shù)碼顯示接口:由數(shù)碼管和驅(qū)動(dòng)電路組成。在工作模式時(shí),顯示深度測(cè)量值;在校驗(yàn)?zāi)Ｊ綍r(shí),顯示各轉(zhuǎn)角傳感器測(cè)量值;在輸入模式時(shí),顯示各組件結(jié)構(gòu)尺寸值;在日歷模式時(shí),顯示/修改日期或時(shí)間。? 鍵盤接口:定制的薄膜鍵盤,由數(shù)字鍵盤(09)和功能鍵盤(包括模式轉(zhuǎn)換鍵、確認(rèn)鍵、返回鍵等)組成,用于模式轉(zhuǎn)換操作及其參數(shù)

11、輸入等。? 電源:供電電源直接使用挖掘機(jī)蓄電池組,穩(wěn)壓電源采用開關(guān)型DC/DC電源。?3 軟件設(shè)計(jì)? 設(shè)計(jì)自動(dòng)測(cè)深儀軟件時(shí),為達(dá)到通用性、靈活性和實(shí)用性,設(shè)置了四種模式:工作模式、校驗(yàn)?zāi)Ｊ?、輸入模式和日歷模式,軟件流程如圖3所示。? 工作模式是挖掘深度自動(dòng)測(cè)量模式,包括轉(zhuǎn)角數(shù)據(jù)采集、數(shù)字濾波、標(biāo)度變換、深度計(jì)算、越限報(bào)警及深度顯示等;校驗(yàn)?zāi)Ｊ接糜诎惭b調(diào)試時(shí)各轉(zhuǎn)角傳感器零點(diǎn)與滿量程的校準(zhǔn);輸入模式因挖掘機(jī)型號(hào)不同、部件尺寸不同,用于輸入或修改組件結(jié)構(gòu)尺寸值;日歷模式用于輸入或修改日歷與時(shí)間。? 軟件由MCS51匯編語言編寫,按自下而上、模塊化設(shè)計(jì)思想開發(fā)了如下模塊:初始化、數(shù)據(jù)采集、數(shù)字濾波、標(biāo)度變換、深度計(jì)算、越限判斷、顯示、鍵盤管理、主程序等。為了提高精度,采用三字節(jié)浮點(diǎn)數(shù)運(yùn)算。? 挖掘機(jī)自動(dòng)測(cè)深儀的研制成功,解決了挖掘深度自動(dòng)測(cè)量難的問題,尤其在復(fù)雜作業(yè)場(chǎng)合,如水下、危險(xiǎn)環(huán)境等,更體現(xiàn)出了其優(yōu)越性能。在挖掘深度不大于1m時(shí),其絕對(duì)誤差不大于0.05m;挖掘深度大于1m時(shí),其相對(duì)誤差不大于1%。? 自動(dòng)測(cè)深儀在設(shè)計(jì)時(shí),采取了抗電磁干擾、抗振動(dòng)、防水、耐高低溫等措施,大大提高了儀器的穩(wěn)定性和可靠性以及環(huán)境適應(yīng)性。