[發明專利]一種基于濾波的雙反光板激光定位與導航方法

有效

• 申請號: 201710571102.2
• 申請日: 2017-07-13
• 公開（公告）號: CN107356931B
• 公開（公告）日: 2019-10-18
• 發明（設計）人: 林志赟;邢浩;金智
• 申請（專利權）人: 浙江科鈦機器人股份有限公司
• 主分類號: G01S17/48
• 分類號: G01S17/48;G01S17/50;G01S7/481;G01S7/48
• 代理公司: 杭州求是專利事務所有限公司 33200
• 代理人: 劉靜;邱啟旺

本發明公開了一種基于濾波的雙反光板激光定位與導航方法，與傳統技術中的幾何三角定位不同，本發明深入挖掘并充分利用了反射光的復數域信息，打破了傳統意義上三塊反光板的技術瓶頸，其運行條件為同時檢測到兩塊反光板的數據即可，大大提高了激光導航技術的適用性；通過濾波算法過濾掉測量誤差引起的計算誤差，極大地提高定位與導航精度；最后，雖然本發明最低要求為檢測到兩塊反光板，但實際應用時可能會同時檢測到多個反光板，通過設計數據融合處理，能夠最大化利用反光板的信息，從而進一步提高精度。

技術領域

本發明屬于智能倉儲物流領域，具體涉及一種基于濾波的雙反光板激光定位與導航方法。

背景技術

基于激光傳感器的定位與導航技術是工業AGV、智能機器人等領域的關鍵性技術，相比傳統有軌導航方式，該技術具有定位精度高、靈活多變等優點，適用于復雜、高動態的工業場景中。國內外現有基于反光板的激光定位技術，均采用了幾何三角定位原理，每時每刻必須要求同時檢測到三塊反光板才可實現定位。這一數量要求實際上在復雜工業場景中很難滿足，極大地制約了激光定位與導航技術的實用性。

發明內容

為了解決上述問題，本發明提供一種新型激光定位與導航方法，通過提取和利用激光測距信息中的復數域信息，將三塊反光板的最低要求降低為兩塊，有效解決了反光板最低數量的技術瓶頸，大大提高了激光導航技術的適用性。

本發明的目的是通過以下技術方案來實現的：一種基于濾波的雙反光板激光定位與導航方法，該方法包括：

(1)在工業環境中布置反光板，預設反光板世界坐標，生成反光板坐標列表；

(2)安裝在移動平臺上的激光傳感器向周圍呈輻射狀發射激光，并接收反射激光；

(3)篩選來源于反光板的有效光束：通過檢測反射激光強度I并與預設強度閾值σ相比較，判定激光照射物是反光板還是普通環境物體；

(4)確定當前時刻照射到的反光板數量及其相對激光傳感器的相對坐標：根據反射光束角度的連續性，判斷是否為同一塊反光板，或者，根據反射光束角度和距離的連續性，判斷是否為同一塊反光板；根據屬于同一反光板的反射光束得到該反光板相對于激光傳感器的相對坐標，并存入反光板列表；

(5)初始化反光板列表，得到至少兩個反光板的世界坐標：人工確定初始位置對應的反光板列表中至少兩個反光板的世界坐標；或者，激光傳感器在初始位置獲取至少三個反光板返回的角度和距離，計算兩兩反光板之間的距離，與根據反光板坐標列表生成的反光板距離信息相匹配，得到至少兩個反光板的世界坐標；

(6)在動態過程中計算期望反光板列表：根據上一時刻對當前時刻激光傳感器位置和角度的預測，估計激光傳感器與所有反光板之間的相對距離和角度，并存入期望反光板列表；

(7)在動態過程中反光板列表的匹配：計算當前時刻反光板列表與期望反光板列表中同一個反光板對應的距離之差和角度之差，當距離之差和角度之差均滿足預設閾值時，匹配成功；

(8)基于雙反光板數據的激光傳感器位姿計算：利用激光傳感器測量數據的復頻域信息，在匹配成功的反光板中任選兩塊：第l個和第k個，并計算：

z_k＝X_k+i*Y_k

z_l＝X_l+i*Y_l