[發明專利]一種基于數據篩選的雙反光板激光定位與導航方法

有效

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

1.一種基于數據篩選的雙反光板激光定位與導航方法，其特征在于，該方法包括：

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

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

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

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

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

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

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

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

z_k＝X_k+i*Y_k

z_l＝X_l+i*Y_l

其中，下標l和k分別代表第l和第k個反光板；α和ρ分別代表在激光傳感器相對自身的極坐標系下，反光板的角度和距離；X和Y分別為反光板在X和Y軸的分量；z為反光板在世界坐標系下的復數坐標；z_k，l為根據第l和第k個反光板計算得到的激光傳感器世界坐標，θ_k是根據第k塊反光板的數據計算得到的激光傳感器在世界坐標系下的角度。

2.根據權利要求1所述的基于數據篩選的雙反光板激光定位與導航方法，其特征在于，所述步驟(8)之后，還包括多塊優化的步驟：如果激光傳感器檢測到三個及以上的反光板數據，可以根據多組數據中任意兩組計算得到的位姿進行數據融合，得到最終的移動平臺及激光傳感器在世界坐標系下的位置及角度。