基于激光測距的機(jī)械手臂防碰撞自動控制技術(shù)研究

曲宏楊

（寶雞鈦業(yè)股份有限公司實驗中心，陜西 寶雞 721014）

基于激光測距的機(jī)械手臂防碰撞自動控制系統(tǒng)主要是利用激光來進(jìn)行機(jī)械手臂與障礙物之間的距離的簡單測算，并與界定的防碰撞的臨界值進(jìn)行比較，根據(jù)比較的結(jié)果對機(jī)械手臂下達(dá)不同的指令，從而實現(xiàn)對機(jī)械手臂的自動控制。該系統(tǒng)能夠高度規(guī)避機(jī)械手臂發(fā)生碰撞事故的概率，實現(xiàn)自動控制和人機(jī)交互功能，是保障加工作業(yè)安全進(jìn)行、提高機(jī)械手臂工作效率的有力保障。本文主要對采用了脈沖式激光測距方法的機(jī)械手臂防碰撞自動控制系統(tǒng)進(jìn)行探究。

1 激光測距概述

1.1 激光測距的原理

激光測距其實是一種利用激光器作為光源發(fā)射光波進(jìn)行測距的手段，具有精準(zhǔn)度高、抗干擾能力強、運轉(zhuǎn)能力強和操作簡便的優(yōu)點，其主要測算方法有三角法、干涉法、脈沖法和相位法，其中以脈沖法和相位法最為常用。激光測距的操作原理是通過利用激光脈沖和激光束從發(fā)出到被反射后的時間差來進(jìn)行測距儀器與被測物體之間的間隔距離。激光測距的計算公式如下：

式中，D代表的是測距儀（設(shè)為A）與被測物體（設(shè)為B）之間的距離；c代表的是激光脈沖或者激光束在空氣中的傳播速度；t代表的是激光從測距儀（設(shè)為A）到被測物體（設(shè)為B），再被測物體（設(shè)為B）反射回測距儀所用的時間。

該公式的實際含義就是，當(dāng)進(jìn)行激光測距時，由測距器發(fā)出激光接觸到被測物體，然后，再把被測物體反彈到測距器，激光傳輸?shù)那昂髸r間被儀器記錄了下來，而激光傳播速度和前后時間的乘積的一半，就是測距器和被測物體之間的時間間隔距離。通常，激光測距儀的精確度能夠達(dá)到1mm，可以適應(yīng)所有要求實現(xiàn)精確測量的行業(yè)的需要。需要注意的是，脈沖型激光測量用這種方式測量出的距離的準(zhǔn)確度通常在正負(fù)10cm左右，并且，測距儀通常還存在1寸以內(nèi)的測量盲區(qū)。

通過對上述公式的實際含義進(jìn)行分析，可以得出激光傳播的時間t是A與B之間的實際間隔距離的決定性因素，通過測算時間的方法以及測算時間的數(shù)值不同，可以將激光測距儀分成脈沖型和相位型兩個類別。

1.2 激光測距的手段

1.2.1 三角法激光測距

激光位移傳感器的測量手段稱為三角法激光測距。在激光測距儀的精度得到確定的前提條件下，試驗和分析得出同一測距儀在處于測定范圍內(nèi)的不同的測算距離的測算精度相同，因此，三角法激光測距的測算精度與范圍相關(guān)，三角法激光測算的精度隨著測量范圍的逐漸增大而逐漸降低。

三角法激光測距的操作原理是通過采取激光三角法和回波分析法對需要測算的物體所在地點以及與測距儀之間相隔的位移進(jìn)行距離測算。半導(dǎo)體激光器（序號1）發(fā)射可以被看見的紅色激光經(jīng)過透鏡（序號2）聚焦在被測物體（序號6）的外表面上，再由外表面對激光進(jìn)行物理反射，反射光經(jīng)過透鏡（序號3）被其收集并且投射到線性CCD相機(jī)（序號4）上，由于線性CCD相機(jī)（序號4）可以在不同的角度測得光點，因此，測算的間隔距離不同，數(shù)字信號處理器（序號5）根據(jù)相機(jī)的測算角度并運用科學(xué)的三角函數(shù)數(shù)學(xué)關(guān)系結(jié)合線性CCD相機(jī)（序號4）上的光點的地點以及激光器與攝像機(jī)之間的間隔進(jìn)行測距儀與被測物體之間的距離的測算。

該距離測算方法常用于成本相對較低的激光測距方案中，例如，三角法激光測距方法常用在搭建鋼軌以及測評產(chǎn)品厚度、平整度和尺寸等各種屬性方面的數(shù)據(jù)。

1.2.2 脈沖法激光測距

脈沖法激光測距是通過向脈沖式激光器傳達(dá)明確的脈沖信號，使得脈沖式激光器瞬間發(fā)射出大量的大功率激光光束，同時，對這期間激光光束在脈沖式激光器與被測物體之間的來回運作時間進(jìn)行數(shù)據(jù)測量，根據(jù)公式測算出脈沖式激光器與被測物體之間的距離的一種激光測距方法。該激光測距方法的精度主要受到脈沖式的上升沿、激光回收通道的帶寬、探測器的信噪比以及時間間隔的精度等因素的影響。脈沖法激光測距方法常用于對地形的測繪、對戰(zhàn)術(shù)前向的測距、對導(dǎo)彈軌道的跟蹤以及對衛(wèi)星、地月進(jìn)行的測距工作等，有著非常好的發(fā)展前景。

通過分析和研究可以得出，脈沖法激光測距的操作原理是通過脈沖信號對激光器下達(dá)指令，使激光器瞬間發(fā)出的帶有脈沖信號的激光經(jīng)過待測算間隔L并被測目標(biāo)反射出帶有回波信號的激光，然后被激光器接收，同時，計時電路對激光發(fā)射和激光接收的前后時間進(jìn)行計時統(tǒng)計得到時間t，然后運用激光測距的公式進(jìn)行測距儀和被測物體之間的距離間隔的測算。

1.2.3 相位式激光測距

相位式激光測距是通過射頻波段的頻率對激光光束進(jìn)行調(diào)制，發(fā)射不同頻率波長的激光光束到被測物體上并被測物體反射回激光器，測量對比不同頻率波長的激光在傳播過程中產(chǎn)生的相位延遲，從而測算出激光器與被測物體之間的間隔距離的一種激光測距方法，該測算方法是一種具有高精度的間接測算手段。需要注意的是，測量的相位延遲是測量調(diào)制在激光上的信號的相位。

當(dāng)發(fā)射光接觸到墻面時，獲得的反射光的光波實際上是發(fā)射光的光波的鏡像，因此，所獲的相位差的數(shù)值大小與光速無關(guān)，只與發(fā)射光的發(fā)射時間以及發(fā)射光與被測物體的接觸時間有關(guān)。將調(diào)制的激光的光波波長利用相位延遲來完成轉(zhuǎn)換并通過相位差進(jìn)行激光器與被測物體之間的間隔距離的測算。

1.2.4 干涉法激光測距

干涉法激光測距是以光的干涉原理為基礎(chǔ)，通過對激光進(jìn)行干涉，使激光光束產(chǎn)生明暗相間的干涉條紋，利用光電轉(zhuǎn)換元件接收并轉(zhuǎn)換成電信號，通過對其進(jìn)行記數(shù)器計數(shù)實現(xiàn)對間隔距離進(jìn)行測算的一種激光測距技術(shù)。

干涉法激光測距的具體操作流程是激光器發(fā)射的激光經(jīng)過分光鏡分成兩束激光光束，分別經(jīng)過反射鏡M1和可移動反射鏡M2形成參考光束和透射光束，兩束光束在反射過程中匯合并將其干涉信號疊加在一起，由光電記數(shù)器進(jìn)行回收統(tǒng)計，通過運用式（2）進(jìn)行距離的測算。

L=Nλ/2 （2）

式中，用激光光波的波長（λ）的一半來表示兩束激光的路徑差，用N表示光電顯微鏡發(fā)射的記數(shù)，用L表示激光器與被測物體之間的間隔距離。

1.3 激光測距的注意事項

一般情況下，激光測距的測算數(shù)據(jù)為了保證精確度，防止漫反射對測算數(shù)據(jù)的強干擾性，需要選擇全反射棱鏡進(jìn)行配合，當(dāng)然，也可以用薄塑料板作為反射面來規(guī)避嚴(yán)重的漫反射現(xiàn)象發(fā)生。為了能夠獲得足夠強度的激光反射，從而獲得精確的測算數(shù)據(jù)，需要采取短距離的垂直光墻反射式測距。

2 機(jī)械手臂防碰撞自動控制系統(tǒng)概述

機(jī)械手臂防撞擊自動控制系統(tǒng)是一個安裝在機(jī)械臂操作平臺的主動防御裝置。該管理系統(tǒng)的主要功能是在機(jī)械臂和車輛之間出現(xiàn)交叉撞擊情況之前，完成對該機(jī)械臂的停止或移動控制，并發(fā)布警示。

機(jī)械手臂防碰撞自動控制系統(tǒng)主要由機(jī)械手臂工作環(huán)境監(jiān)測、防碰撞運算以及機(jī)械手臂控制3個基礎(chǔ)模塊組成。起重機(jī)械手臂工作環(huán)境監(jiān)測模塊和防碰撞運算模塊主要是對機(jī)械手臂的上機(jī)位進(jìn)行控制，當(dāng)機(jī)械手臂進(jìn)行正常操作作業(yè)時，由機(jī)械手臂工作環(huán)境監(jiān)測模塊在后臺對機(jī)械手臂的工作信息進(jìn)行實時監(jiān)測，當(dāng)發(fā)現(xiàn)附近有存在一定碰撞概率的其他機(jī)械手臂、各種機(jī)械設(shè)備、人員或墻面時，將這些信息和信號傳遞給防碰撞運算模塊，由該模塊結(jié)合機(jī)械手臂的手臂高度和運轉(zhuǎn)速度進(jìn)行機(jī)械手臂與障礙物體之間的距離測算，并與防碰撞臨界距離進(jìn)行比較，如果發(fā)現(xiàn)該距離未觸碰臨界值，系統(tǒng)則不下達(dá)任何指令，一旦發(fā)現(xiàn)觸碰甚至超出防碰撞臨界值，則立即向機(jī)械手臂控制模塊傳達(dá)控制指令來實現(xiàn)防碰撞控制；機(jī)械手臂控制模塊主要是對機(jī)械手臂的下機(jī)位進(jìn)行控制，也就是執(zhí)行上機(jī)位發(fā)布的控制指令，包括對機(jī)械手臂的開度、轉(zhuǎn)向角度以及位移速度等參數(shù)進(jìn)行調(diào)節(jié)，以此規(guī)避和降低發(fā)生碰撞事故的風(fēng)險。

3 激光測距在機(jī)械手臂防碰撞自動控制中的應(yīng)用

3.1 脈沖式激光測距在防碰撞自動控制系統(tǒng)中的應(yīng)用

由于機(jī)械手臂的工作環(huán)境往往較為復(fù)雜，因此防碰撞的臨界值通常較小，這時就需要對機(jī)械手臂與障礙物體之間的間隔距離進(jìn)行高度精準(zhǔn)的測量，而激光測距主要通過激光進(jìn)行測距，具有極強的方向性和相干性，能夠快速精準(zhǔn)地進(jìn)行激光的傳播，在激光傳播過程中不易發(fā)生過多的能量損耗，通過激光在障礙物體上的反射形成的反射光的信息進(jìn)行距離測算，能夠有效地節(jié)省測距的時間。激光測距與其他測距方法相比具有很強的優(yōu)勢。

隨著近年來我國科技的發(fā)展，我國機(jī)械廠商的芯片和光路元件的集成性能與質(zhì)量也有了快速穩(wěn)定的提升，于是，脈沖式的激光測距方法在激光測距方法發(fā)展中逐漸突出，其具有的精度優(yōu)勢也越來越明顯，深受機(jī)械廠商的關(guān)注。

脈沖式激光測距的工作流程是控制芯片通過一定周期的脈沖信號的傳遞來對驅(qū)動電路進(jìn)行控制，從而使脈沖激光器進(jìn)行初始化并瞬間發(fā)出有大功率的脈沖式激光光束，使電路中產(chǎn)生一定的電壓，同時，參考時鐘開始進(jìn)行初始化操作，在激光光束經(jīng)過透鏡與干涉波片形成不受背景和環(huán)境光干擾的純凈反射激光，反射回機(jī)械手臂上，機(jī)械手臂接收反射回的激光光束并將其進(jìn)行光電轉(zhuǎn)換，將反射光信息轉(zhuǎn)換成電信號并進(jìn)行整流放大，由門電路對其中的有效信息進(jìn)行選擇，并送達(dá)參考時鐘進(jìn)行時間計數(shù)，經(jīng)過一系列的測算工作，最終將距離測距結(jié)果顯示出來。在整個工作過程中，激光器、光電轉(zhuǎn)換電路、整流電路、門電路、顯示器、時鐘、驅(qū)動電路等硬件發(fā)揮了至關(guān)重要的作用，使得整個脈沖式激光測距工作能夠順利進(jìn)行。

在理想條件下，激光光束在進(jìn)行能量傳播時，能量損耗幾乎為0，這時障礙物體與機(jī)械手臂之間的距離如式（3）：

式中，f0表示參考時鐘晶振頻率，N表示參考時鐘收到的激光光束中的脈沖數(shù)量（與原始激光光束的脈沖數(shù)量相等），c表示激光傳播速度，L1表示障礙物體與機(jī)械手臂之間的距離間隔。

但是，由于機(jī)械制造廠的空氣中含有大量的粉塵和顆粒，因此，提供給機(jī)械手臂的工作環(huán)境通常是非理想狀態(tài)，這使得激光光束在進(jìn)行能量傳播時存在部分能量衰減。此時，只能用下面的公式進(jìn)行距離測算：

式中，t1表示脈沖激光器發(fā)射出激光光束的時間，t2表示光電轉(zhuǎn)換電路接收反射光束的時間。機(jī)械手臂防碰撞自動控制系統(tǒng)通過最終的測量結(jié)果與防碰撞臨界值進(jìn)行比較，發(fā)布控制指令。

3.2 機(jī)械手臂防碰撞自動控制系統(tǒng)中參考時鐘的優(yōu)化

在進(jìn)行非理想狀態(tài)下的脈沖式激光測距時，參考時鐘的作用至關(guān)重要，其計數(shù)過程直接關(guān)系距離測量的精度，如果參考時鐘在進(jìn)行初始化時，激光光束已經(jīng)傳播了一段距離，導(dǎo)致參考時鐘無法直接獲取t1，而參考時鐘初始化時間與機(jī)械手臂防碰撞自動控制系統(tǒng)的資源利用率有關(guān)，也不能用計數(shù)數(shù)據(jù)與初始化時間的加減關(guān)系獲取t1。因此，需要對參考時鐘進(jìn)行優(yōu)化，要對參考時鐘計數(shù)誤差有準(zhǔn)確的認(rèn)識。

Ta表示脈沖式激光光束的收發(fā)端與上升沿之間的時間差，Tb表示脈沖式激光光束的收發(fā)端與下降沿之間的時間差，在假設(shè)脈沖計數(shù)數(shù)量為M，脈沖周期的平均時間差為Ts時，脈沖式激光測距在機(jī)械手臂防碰撞自動控制系統(tǒng)中的計數(shù)誤差T0可以表示為：

在激光測距過程中排除參考時鐘的計數(shù)誤差，可以得到在非理想狀態(tài)下的相對準(zhǔn)確的脈沖式激光傳播時間t的計算公式，并代替測算公式中的(t2－t1)，即：

用此優(yōu)化方法可以實現(xiàn)基于脈沖式激光測距的機(jī)械手臂防碰撞自動控制系統(tǒng)的優(yōu)化。

4 結(jié)語

本文主要對激光測距的概念、原理和類型進(jìn)行了詳細(xì)的闡述和分析，然后對最適合機(jī)械手臂防碰撞自動控制系統(tǒng)進(jìn)行測距工作的脈沖式激光測距方法的工作原理和其在整個防碰撞自動控制系統(tǒng)中的應(yīng)用進(jìn)行了研究和分析，證實了脈沖式激光測距方法的可行性。