一種基于視覺圖像和激光雷達的水下機器人導航避障方法

基本信息

申請?zhí)?/td> CN202011122378.0 申請日 -
公開（公告）號 CN112180943B 公開（公告）日 2022-07-01
申請公布號 CN112180943B 申請公布日 2022-07-01
分類號 G05D1/02（2020.01）I 分類 控制；調節(jié);
發(fā)明人 張強;劉洋;胡宴才;張燕;許世波;張樹豪;郭高陽 申請（專利權）人 山東交通學院
代理機構 - 代理人 -
地址 250023山東省濟南市天橋區(qū)交校路5號
法律狀態(tài) -

摘要

摘要 本發(fā)明公開了一種基于視覺圖像和激光雷達的水下機器人導航避障方法，其通過在水下工作區(qū)域使用激光雷達數據創(chuàng)建3D柵格地圖；向水下機器人的導航模塊發(fā)送導航目標點；導航模塊根據目標點與當前位置，規(guī)劃由當前位置到目標點的行走路徑；導航模塊根據視覺圖像和激光雷達數據，計算水下機器人運動過程中與障礙物的相對速度，從而根據速度沖突檢測方法實時計算水下機器人下一時刻的最優(yōu)運動速度；根據最優(yōu)運動速度控制水下機器人移動，重復前述步驟，直到水下機器人到達目標點。本發(fā)明通過使用激光雷達和視覺圖像數據，考慮相對運動速度因素設定安全速度邊界，降低水下機器人與障礙物發(fā)生運動沖突的概率，提高水下機器人運動的安全性與流暢性。