余紫娟 白志晨 王佳慧 蘇波

摘 ?要：基于目標(biāo)點在球坐標(biāo)系中的三個數(shù)據(jù)，即目標(biāo)點到坐標(biāo)原點連線的直線距離及其與另兩條設(shè)定坐標(biāo)軸的兩個夾角，可以得到目標(biāo)在空間中的位置信息。文章通過使用相位式激光測距模塊獲取目標(biāo)點到坐標(biāo)原點的距離，使用舵機(jī)云臺控制激光在水平和豎直兩個方向旋轉(zhuǎn)，并將旋轉(zhuǎn)角度值作為基礎(chǔ)數(shù)據(jù)返回，從而得到物體的位置信息。

關(guān)鍵詞：空間定位;相位式激光測距;舵機(jī)控制

中圖分類號：P226.2 文獻(xiàn)標(biāo)志碼：A ? ? ? ? 文章編號：2095-2945（2020）32-0075-03

Abstract： Based on the three data of the target point in the spherical coordinate system， including the straight line distance from the target point to the coordinate origin， and its two angles with the other two set coordinate axes， the position information of the target in space can be calculated. This paper describes how to use the phase laser ranging module to calculate the distance from the target point to the coordinate origin， use the servo head to control the laser to rotate in both horizontal and vertical directions， and return the rotation angle value as the basic data to calculate the position information of the object.

Keywords： space positioning; phase laser ranging; steering gear control

1 概述

三維立體空間中，物體有其特定的位置信息，獲取物體的位置信息后，便可以對物體與物體之間的位置關(guān)系進(jìn)行進(jìn)一步剖析。任何會隨著距離改變的物理量，如聲的傳播、光的強(qiáng)度和場的效應(yīng)等，均可逆向的應(yīng)用于距離的測量中，通過初始量的變化規(guī)律，從而得出自變量的值。本文通過研究調(diào)制光相位隨時間的變化來測出距離，獲取球坐標(biāo)下兩個角度值，最終得到物體的在空間中的位置。

2 實驗原理

2.1 坐標(biāo)系的建立

在空間內(nèi)給定坐標(biāo)原點，并在原點所在水平面內(nèi)給定x軸正方向。以豎直向上方向為z軸正半軸，y軸垂直于xOz平面，形成右手坐標(biāo)系，如圖1所示。

通過測量由坐標(biāo)原點到目標(biāo)點的空間直線距離r，以及原點到目標(biāo)點連線OP與xOz平面的夾角？琢、OP與xOy平面的夾角？茁，求出P在以O(shè)為原點的球坐標(biāo)系下的坐標(biāo)（？琢，？茁，r）。在假設(shè)空氣折射率為1的情況下，根據(jù)幾何關(guān)系及定律可推導(dǎo)出公式（1）：

2.2 數(shù)據(jù)處理

控制旋轉(zhuǎn)方向的舵機(jī)云臺，其兩條旋轉(zhuǎn)軸通常不在一個平面上，即水平轉(zhuǎn)軸與豎直轉(zhuǎn)軸在空間上不相交，導(dǎo)致組裝條件受到限制，激光測距模塊無法安裝在原點處。因此，在計算目標(biāo)空間位置時進(jìn)行了三角轉(zhuǎn)換，如圖2所示：

坐標(biāo)系的原點位于測量裝置的豎直旋轉(zhuǎn)軸上，z軸與裝置的豎直旋轉(zhuǎn)軸重合。水平轉(zhuǎn)軸位于xOy平面上，平行于y軸，與x軸的交點到原點的距離為a，R為水平轉(zhuǎn)軸到目標(biāo)點的距離。激光測距模塊位于該連線上，激光源到目標(biāo)的距離（即測距結(jié)果）為d，芯片端頭的激光發(fā)射點到水平轉(zhuǎn)軸中心點的距離為L，？茲為水平旋轉(zhuǎn)軸旋轉(zhuǎn)過的角度， ？茁為坐標(biāo)原點到目標(biāo)點的連線與xOy平面所夾成的角度，r為坐標(biāo)原點到目標(biāo)點的距離，a為水平轉(zhuǎn)軸與x軸的交點到坐標(biāo)原點的偏移量。

3 實驗過程

3.1 實驗儀器及系統(tǒng)構(gòu)建

實驗所用儀器裝置：Arduino MEGA 2560單片機(jī)、舵機(jī)云臺、摩天L1激光測距模塊、HC-05藍(lán)牙模塊、6V直流電源、USB 5V供電電源、USB數(shù)據(jù)線、杜邦線若干、安卓手機(jī)、三腳架、水平儀、3D打印技術(shù)制得的轉(zhuǎn)接板[1]。

實驗裝置數(shù)據(jù)測量部分由舵機(jī)云臺和激光測距模塊組合而成，運算模塊采用Arduino MEGA 2560單片機(jī)，通過HC-05藍(lán)牙模塊連接至安卓手機(jī)進(jìn)行姿態(tài)的控制和數(shù)據(jù)的讀取。

3.2 系統(tǒng)運行方式

測量操作流程圖如圖4所示，將儀器通過轉(zhuǎn)接板固定在三腳架上，將裝置調(diào)整到水平位置，使用水平儀進(jìn)行二次校準(zhǔn)。由安卓手機(jī)通過藍(lán)牙向Arduino單片機(jī)發(fā)送指令，控制舵機(jī)運轉(zhuǎn)，使激光測距模塊繞水平、豎直兩個旋轉(zhuǎn)軸轉(zhuǎn)動，直至瞄準(zhǔn)目標(biāo)。瞄準(zhǔn)后，通過手機(jī)控制激光測距模塊，測出激光源到目標(biāo)的距離和角度。數(shù)據(jù)全部測量完成后，單片機(jī)可按照上文中設(shè)定的算法，計算出目標(biāo)點在直角坐標(biāo)系中的坐標(biāo)值，其單位為毫米。

實驗裝置使用的激光測距模塊為相位式光電測距模塊，它將發(fā)射光調(diào)制成正弦波的形式，通過測量正弦光波在待測距離上往返傳播的相位移來計算時間。原理示意圖如圖5所示。

實驗裝置使用的數(shù)字舵機(jī)，芯片通過杜邦線傳遞脈沖控制舵機(jī)旋轉(zhuǎn)的角度，即脈沖調(diào)制，通過改變脈沖的長短可以控制舵機(jī)轉(zhuǎn)過的角度。脈沖寬度與對應(yīng)的舵機(jī)轉(zhuǎn)過的角度關(guān)系如圖6所示，通過手機(jī)程序可隨時更改舵機(jī)的脈沖，以達(dá)到轉(zhuǎn)動舵機(jī)的目的。本裝置使用的舵機(jī)，接收到1.52毫秒的脈沖會轉(zhuǎn)動到中間位置（90°）。單片機(jī)控制系統(tǒng)發(fā)出特定指令，可使舵機(jī)移動到某一指定位置，并保持在該位置上[6-8]。

4 數(shù)據(jù)測量與分析

4.1 實驗步驟

依3.1中所述，將裝置固定在三角架上，利用水平儀調(diào)整裝置水平[9-10]，打開手機(jī)藍(lán)牙模塊APP，與裝置的藍(lán)牙進(jìn)行配對，設(shè)置微調(diào)鍵停止鍵測量鍵等功能鍵。確認(rèn)所要測量的目標(biāo)點，通過手機(jī)藍(lán)牙模塊APP操控舵機(jī)，直至激光點打在被測物體上，此時通過手機(jī)進(jìn)行數(shù)據(jù)讀取。

4.2 測量結(jié)果

實驗中，以舵機(jī)本身為原點建立坐標(biāo)系，選取兩個象限的目標(biāo)進(jìn)行數(shù)據(jù)測量，每個象限選取三個位置不同的目標(biāo)，記錄如表1和表2所示。

4.3 結(jié)果分析

實驗所用激光測距模塊精度為1mm，角度的測量精度為1°。測量結(jié)果的相對誤差在0.10%-7.43%左右。

誤差主要由以下因素引起：兩舵機(jī)轉(zhuǎn)軸在空間中不垂直（舵機(jī)配置問題）;放置舵機(jī)的水平面（或三角架）不水平（或者有晃動）;測光測距模塊的裝配時與舵機(jī)不在一條直線上;由于舵機(jī)控制精度的問題（控制度數(shù)小于一度時靈敏度不夠），當(dāng)目標(biāo)距離比較遠(yuǎn)時，水平和豎直方向改變1°激光點移動距離較大，所測點是分立的，定位面積較小的目標(biāo)點略有困難;測距選擇的激光其傳播受到空氣介質(zhì)的影響，且激光無法測量反射面所在平面，且打出的光斑有一定半徑。

5 結(jié)論

本實驗通過使用Arduino單片機(jī)控制舵機(jī)、激光測距模塊的運轉(zhuǎn)，并利用三角關(guān)系消除實驗裝置組裝因素限制造成的影響，即旋轉(zhuǎn)軸在空間上不重合、激光器與坐標(biāo)原點不重合。通過測量待測目標(biāo)位于球坐標(biāo)系內(nèi)的空間坐標(biāo)，然后經(jīng)數(shù)學(xué)運算將其轉(zhuǎn)換為直角坐標(biāo)系內(nèi)的空間坐標(biāo)。該裝置可以簡便地實現(xiàn)對目標(biāo)的空間定位，具有體積小、運行速度快、精度較高的特點。通過將裝置置于三腳架上，可使其適應(yīng)不平整地形，實現(xiàn)全地形測量。在創(chuàng)新方面，該裝置利用激光可實現(xiàn)非接觸式測量以規(guī)避危險環(huán)境;易于使用，便于推廣;裝置較小，便于攜帶;操作簡單，易于上手;適用范圍廣，可適應(yīng)復(fù)雜地形。

參考文獻(xiàn)：

[1]劉曉曉.教學(xué)演示3D打印機(jī)的研制[J].智庫時代，2019（42）：164-174.

[2]劉邈，楊學(xué)友，劉常杰.正交混頻相位式激光測距方法與系統(tǒng)實現(xiàn)[J].中國激光，2012，039（002）：153-158.

[3]李小萍.差頻相位法光速測量系統(tǒng)誤差及精度分析[J].淮海工學(xué)院學(xué)報（自然科學(xué)版），2011，20（003）：19-22.

[4]屈八一，周渭，李珊珊，等.高精度的測距系統(tǒng)中的測相技術(shù)研究[J].電路與系統(tǒng)學(xué)報，2012，17（004）：31-35.

[5]肖彬.激光測距方法探討[J].地理空間信息，2010，08（04）：162-164.

[6]肖前進(jìn)，賈宏光，章家保，等.電動舵機(jī)伺服系統(tǒng)非線性辨識及補(bǔ)償[J].光學(xué)精密工程，2013，21（08）：2038-2047.

[7]周英路，王志亮，朱松青，等.基于PCA9685的多路舵機(jī)控制器設(shè)計[J].南京工程學(xué)院學(xué)報（自然科學(xué)版），2017，15（004）：26-31.

[8]劉少軍，王瑜瑜.基于Android手機(jī)藍(lán)牙控制的智能小車設(shè)計與實現(xiàn)[J].電子測量技術(shù)，2016，39（9）：114-117.

[9]余文卿.水平儀零位的調(diào)整[J].計量技術(shù)，1986（05）：37-38.

[10]吳春林.水平儀墊板及水平儀的改進(jìn)[J].航空工藝技術(shù)，1978（11）：35-36.