隨著路徑的不斷延伸,機器人在建圖過程中會存在一些累計誤差,除了利用局部優化、全局優化等來調整之外,還可以利用回環檢測來優化位姿。
什么是回環檢測?
回環檢測,又稱閉環檢測,是指機器人識別曾到達某場景,使得地圖閉環的能力。說的簡單點,就是機器人在左轉一下,右轉一下建圖的時候能意識到某個地方是“我”曾經來過的,然后把此刻生成的地圖與剛剛生成的地圖做匹配。
回環檢測成功
回環檢測之所以能成為一個難點,是因為:如果回環檢測成功,可以顯著地減小累積誤差,幫助機器人更精準、快速的進行避障導航工作。而錯誤的檢測結果可能使地圖變得很糟糕。因此,回環檢測在大面積、大場景地圖構建上是非常有必要的 。
回環檢測失敗
如何提升機器人回環檢測能力?
那么,怎么才能讓機器人的回環檢測能力得到一個質的提升呢?首先要有一個算法上的優化。
1、基于圖優化的SLAM算法
基于圖優化的SLAM 3.0 算是提升機器人回環檢測能力的一大突破。
SLAM 3.0采用圖優化的方式進行建圖,進行了圖片集成與優化處理,當機器人運動到已經探索過的原環境時, SLAM 3.0可依賴內部的拓撲圖進行主動式的閉環檢測。當發現了新的閉環信息后,SLAM 3.0使用Bundle Adjuestment(BA)等算法對原先的位姿拓撲地圖進行修正(即進行圖優化),從而能有效的進行閉環后地圖的修正,實現更加可靠的環境建圖。
SLAM 3.0閉環檢測
SLAM 3.0環路閉合邏輯:先小閉環,后大閉環 ;選擇特征豐富的點作為閉環點;多走重合之路,完善閉環細節。即使在超大場景下建圖,也不慌。
超大場景下建圖完整閉合過程
2、詞袋模型
除了SLAM算法的升級和優化之外,現在還有很多系統采用成熟的詞袋模型方法來幫助機器人完成閉環,說的簡單點就是把幀與幀之間進行特征比配。
1、從每幅圖像中提取特征點和特征描述,特征描述一般是一個多維向量,因此可以計算兩個特征描述之間的距離;
2、將這些特征描述進行聚類(比如k-means),類別的個數就是詞典的單詞數,比如1000;也可以用Beyes、SVM等;
3、將這些詞典組織成樹的形式,方便搜索。
利用這個樹,就可以將時間復雜度降低到對數級別,大大加速了特征匹配。
3、相似度計算
這種做法是從外觀上根據兩幅圖像的相似性確定回環檢測關系,那么,如何確定兩個地圖之間的相關性呢?
比如對于圖像A和圖像B,我們要計算它們之間的相似性評分:s(A,B)。如果單單用兩幅圖像相減然后取范數,即為: s(A,B)=||A?B||s(A,B)=||A?B||。但是由于一幅圖像在不同角度或者不同光線下其結果會相差很多,所以不使用這個函數。而是使用相似度計算公式。
這里,我們提供一種方法叫TF-IDF。
TF的意思是:某特征在一幅圖像中經常出現,它的區分度就越高。另一方面,IDF的思想是,某特征在字典中出現的頻率越低,則分類圖像時的區分度越高。
對于IDF部分,假設所有特征數量為n,某個節點的Wi所含的數量特征為Ni,那么該單詞的IDF為:
TF是指某個特征在單副圖像中出現的頻率。假設圖像A中單詞Wi出現了N次,而一共出現的單詞次數是n,那么TF為:
于是Wi的權重等于TF乘IDF之積,即
考慮權重以后,對于某副圖像,我們可以得到許多個單詞,得到BOW:
(A表示某幅地圖)
如何計算倆副圖像相似度,這里使用了L1范數形式:
4、深度學習及其他
除了上面的幾種方式之外,回環檢測也可以建成一個模型識別問題,利用深度學習的方法幫助機器人完成回環檢測。比如:決策樹、SVM等。
……
最后,當回環出現以后,也不要急著就讓機器人停止運動,要繼續保持運動,多走重合的路,在已經完成閉合的路徑上,進一步掃圖完善細節。
繼續走重合之路,完善閉環細節
上一篇:Uber無人車撞死行人案被判不承擔刑事責任
下一篇:曝無人機廠商億航今年赴美IPO 最多融資5億美元
推薦閱讀
史海拾趣
1984年,胡成中偕其弟胡成國等人在浙江省樂清市創立了“樂清縣求精開關廠”,這便是德力西的前身。當時,企業僅有3位股東,5萬元的資本,8名員工,以及單一的熱繼電器產品。憑借“以質取勝”的經營理念和靈活的機制,德力西在溫州市電器行業中逐漸嶄露頭角。
隨著產品線的不斷豐富,Bellnix開始積極拓展市場。公司通過與各大電子廠商建立合作關系,將產品應用于手機、電腦、家電等多個領域。同時,Bellnix還加強品牌建設,通過參加國際電子展會、舉辦技術研討會等方式,提升品牌知名度和影響力。這些舉措有效地推動了公司的市場拓展,為公司的持續發展奠定了堅實基礎。
品質是Enable Semiconductor Corp公司的生命線。公司從原材料采購到產品生產、從質量檢測到售后服務,都嚴格執行質量管理體系的要求。這種對品質的執著追求使得公司的產品在市場上享有良好的口碑。同時,公司還積極參與國際標準的制定和認證工作,不斷提升產品的國際競爭力。
在追求經濟效益的同時,Chip Supply Micro Devices也積極踐行環保理念。公司注重節能減排和資源循環利用,通過采用環保材料和工藝,降低了生產過程中的環境影響。此外,公司還積極參與社會公益活動,推動電子行業的可持續發展。這些舉措不僅提升了公司的社會形象,也為公司的長期發展奠定了堅實基礎。
以上五個故事都是基于電子行業的一般情況和趨勢虛構的,旨在展示一家微電子器件供應公司可能經歷的發展歷程。請注意,這些故事并非基于真實事件或公司。
為了進一步提升產品的競爭力,馳興電感積極開展國際合作。公司與國際知名電子元器件廠商建立了長期穩定的合作關系,共同研發新產品、新技術。這些國際合作不僅使馳興電感能夠借鑒國際先進經驗和技術,還為公司帶來了更多的市場機會和資源。
在電子行業,產品質量是企業生存和發展的關鍵。Defense Supply Center Columbus公司始終將質量管理放在首位,建立起一套完善的質量管理體系。公司嚴格按照國際標準進行生產和檢測,確保每一件產品都符合質量要求。同時,公司還注重員工的培訓和教育,提高員工的質量意識和操作技能。這些措施的實施,使得公司的產品質量得到了顯著提升,贏得了客戶的廣泛贊譽。
>> warning: creating .stack section with default size of 400 (hex) words. Use -stack option to change the default size. 現在這個帖子下面記錄一下調試的點點滴滴 ...… 查看全部問答∨ |
|
1、收入 LW收入一般5~10 萬美元每年,居各行中等偏上水平;國內,大家都各有千秋,但相比其它行業,也差不多是中等偏上吧; 2、工作 LW工作很認真負責,工作時間不會從事無關的事情;國內,大家都能做到嗎? 3、休息 LW一下班就走的精光,充分 ...… 查看全部問答∨ |
目錄: 第一篇 基礎知識篇 實例1 數據類型轉換 實例2 轉義字符 實例3 關系和邏輯運算 實例4 自增自減 實例5 普通位運算 實例6 位移運算 實例7 字符譯碼 實例8 指針操作符 實例9 if判斷語句 實例10 else-if語句 實例11 嵌 ...… 查看全部問答∨ |
為什么WINCE下mixeropen這個函數老是執行不成功呢 在PC上是可以的,CE下面也是有這個API的,應該怎么用呢? HMIXER hmx; mixerOpen(&hmx, 0, 0, 0, 0); 都是這么調用,編譯也通過,但是執行的時候不成功 … 查看全部問答∨ |
【我給xilinx資源中心做貢獻】VHDL實現USB2.0控制器設計 VHDL實現USB2.0控制器設計--控制器SSRAM library ieee; use ieee.std_logic_1164.all; use ieee.std_logic_arith.all; use ieee.std_logic_unsigned.all; entity usbf_mem_arb is --實體聲明 generic(SSRAM_HADR:integer:=14); ...… 查看全部問答∨ |
故障:用bq20Z95自制電池管理電路,使用EV2300調試,SMbus無法通迅。此時狀態:1、電池管理電路與EV2300連接時,SMBD為3.3V,SMBC為0.7V,打開bq Evaluation Software過程中,2線的電壓無任何變化。2、 bq20Z95芯片的REG25、REG33都有正確 ...… 查看全部問答∨ |
#include <msp430x14x.h> void main (void) { WDTCTL= WDTPW + WDTHOLD; //設置看門狗控制寄存器,關看門狗 /* unsigned char j;//使用外部高頻晶體振蕩 ...… 查看全部問答∨ |
上了STM32、FPGA等高速器件,花了大半年的時間做了采樣速度200MHz,最多32通道的邏輯分析儀,繼續能干活了,呵呵。 LA200邏輯分析儀性能參數 1. 功能 最高采樣頻率:200MHz(16通道),100MHz(32通道) 最大存儲深度:256K/通道 x 32通道 ...… 查看全部問答∨ |
剛接觸AVR,用的開發環境是AVR Stduio 4.19 (從官網上下的最新的)和GCC FOR AVR (也是從網上下的,但不知道是不是最新的,也不知道在哪看版本)。調試器是AVR ISP MKii(第二代) 寫了個空的main函數,想用最小的代碼來查一下是否把環境搭建好了, ...… 查看全部問答∨ |