怎么實(shí)現(xiàn)環(huán)境建立以及進(jìn)行建圖測(cè)試

怎么實(shí)現(xiàn)環(huán)境建立以及進(jìn)行建圖測(cè)試，針對(duì)這個(gè)問題，這篇文章詳細(xì)介紹了相對(duì)應(yīng)的分析和解答，希望可以幫助更多想解決這個(gè)問題的小伙伴找到更簡(jiǎn)單易行的方法。

目前機(jī)器人使用中需要進(jìn)行SLAM建圖，因?yàn)橐苿?dòng)機(jī)器人想要實(shí)現(xiàn)自主行走，核心在于實(shí)現(xiàn)自主定位導(dǎo)航，在自主定位導(dǎo)航技術(shù)中會(huì)涉及到定位、建圖、路徑規(guī)劃等問題，而地圖構(gòu)建的好壞將直接影響機(jī)器人的行走路徑。機(jī)器人想要到達(dá)某個(gè)目的地，需要和人類繪制地圖一樣，描述環(huán)境、認(rèn)識(shí)環(huán)境的過程主要就是依靠地圖。

    而目前建圖方式有激光雷達(dá)、視覺建圖、還有深度學(xué)習(xí)等。今天介紹的cartographer就屬于激光slam。主流的激光SLAM算法有hector、gmapping、karto、cartographer等。

下面簡(jiǎn)單的介紹幾種SLAM算法：

  1.  hector是一種結(jié)合了魯棒性較好的掃描匹方法2D_SLAM方法和使用慣性傳感系統(tǒng)的導(dǎo)航技術(shù)。傳感器的要求較高，高更新頻率小測(cè)量噪聲的激光掃描儀，不需要里程計(jì)。使空中無人機(jī)與地面小車在不平坦區(qū)域運(yùn)行存在運(yùn)用的可能性。作者利用現(xiàn)代激光雷達(dá)的高更新率和低距離測(cè)量噪聲，通過掃描匹配實(shí)時(shí)地對(duì)機(jī)器人運(yùn)動(dòng)進(jìn)行估計(jì)。所以當(dāng)只有低更新率的激光傳感器時(shí)，即便測(cè)距估計(jì)很精確，對(duì)該系統(tǒng)都會(huì)出現(xiàn)一定的問題。

    hector基于優(yōu)化的算法（解最小二乘問題），優(yōu)缺點(diǎn)：不需要里程計(jì)，但對(duì)于雷達(dá)幀率要求很高40Hz，估計(jì)6自由度位姿，可以適應(yīng)空中或者地面不平坦的情況。初值的選擇對(duì)結(jié)果影響很大，所以要求雷達(dá)幀率較高。 

  2.  gmapping是一種基于粒子濾波的激光SLAM算法，它已經(jīng)集成在ROS中，是移動(dòng)機(jī)器人中使用最多的SLAM算法。基于粒子濾波的算法用許多加權(quán)粒子表示路徑的后驗(yàn)概率，每個(gè)粒子都給出一個(gè)重要性因子。但是，它們通常需要大量的粒子才能獲得比較好的的結(jié)果，從而增加該算法的的計(jì)算復(fù)雜性。此外，與PF重采樣過程相關(guān)的粒子退化耗盡問題也降低了算法的準(zhǔn)確性。

    缺點(diǎn)：嚴(yán)重依賴?yán)锍逃?jì)，無法適應(yīng)無人機(jī)及地面不平坦的區(qū)域，無回環(huán)（激光SLAM很難做回環(huán)檢測(cè)），大的場(chǎng)景，粒子較多的情況下，特別消耗資源。

  3.  karto是基于圖優(yōu)化的SLAM算法，用高度優(yōu)化和非迭代cholesky矩陣進(jìn)行稀疏系統(tǒng)解耦作為解。圖優(yōu)化方法利用圖的均值表示地圖，每個(gè)節(jié)點(diǎn)表示機(jī)器人軌跡的一個(gè)位置點(diǎn)和傳感器測(cè)量數(shù)據(jù)集，箭頭的指向的連接表示連續(xù)機(jī)器人位置點(diǎn)的運(yùn)動(dòng)，每個(gè)新節(jié)點(diǎn)加入，地圖就會(huì)依據(jù)空間中的節(jié)點(diǎn)箭頭的約束進(jìn)行計(jì)算更新。路標(biāo)landmark越多,內(nèi)存需求越大,然而圖優(yōu)化方式相比其他方法在大環(huán)境下制圖優(yōu)勢(shì)更大。

     karto采取的是spa(karto_slam)或g2o(nav2d),  karto的前端與后端采取的是單線程進(jìn)行。

    4.LagoSLAM 是線性近似圖優(yōu)化,不需要初始假設(shè)?；镜膱D優(yōu)化slam的方法就是利用最小化非線性非凸代價(jià)函數(shù).每次迭代, 解決局部凸近似的初始問題來更新圖配置,過程迭代一定次數(shù)直到局部最小代價(jià)函數(shù)達(dá)到. (假設(shè)起始點(diǎn)經(jīng)過多次迭代使得局部代價(jià)函數(shù)最小). 。假設(shè)圖中每個(gè)節(jié)點(diǎn)的相對(duì)位置和方向都是獨(dú)立的，作者求解了一個(gè)等價(jià)于非凸代價(jià)函數(shù)的方程組。為此，提出了一套基于圖論的程序，通過線性定位和線性位置估計(jì)，得到非線性系統(tǒng)的一階近似。

   5. cartographer是google開發(fā)的實(shí)時(shí)室內(nèi)SLAM項(xiàng)目，cartographer采用基于google自家開發(fā)的ceres非線性優(yōu)化的方法，cartographer的亮點(diǎn)在于代碼規(guī)范與工程化，非常適合于商業(yè)應(yīng)用和再開發(fā)。并且cartographer基于submap子圖構(gòu)建全局地圖的思想，能有效的避免建圖過程中環(huán)境中移動(dòng)物體的干擾。并且cartographer支持多傳感器數(shù)據(jù)（odometry、IMU、LaserScan等）建圖，支持2D_SLAM和3D_SLAM建圖。

    能天然的輸出協(xié)方差矩陣，后端優(yōu)化的輸入項(xiàng)。成本較低的雷達(dá)也能跑出不錯(cuò)的效果。cartographer是google推出的一套基于圖優(yōu)化的SLAM算法。

    cartographer算法并沒有給人驚艷的感覺，但該算法的主要目標(biāo)是實(shí)現(xiàn)低計(jì)算資源消耗，達(dá)到實(shí)時(shí)SLAM的目的，所以很適合嵌入式端的使用。

這篇文章是介紹cartographer在linuxPC環(huán)境（Ubuntu16）下進(jìn)行源碼下載進(jìn)行demo測(cè)試的教程，本文的前提條件是你的電腦里已經(jīng)安裝了ROS以下版本的任意一個(gè)：Noetic、Kinetic、Melodic。

   

算法分析

   

    該算法主要分為兩個(gè)部分，第一個(gè)部分稱為L(zhǎng)ocal SLAM, 該部分通過一幀幀的Laser Scan建立并維護(hù)一系列的Submap，而所謂的submap就是一系列的Grid Map。當(dāng)再有新的Laser Scan中會(huì)通過Ceres Scan Matching的方法將其插入到子圖中的最佳位置。但是submap會(huì)產(chǎn)生誤差累積的問題，因此，算法的第二個(gè)部分，稱為Global SLAM的部分，就是通過Loop Closure來進(jìn)行閉環(huán)檢測(cè)，來消除累積誤差：當(dāng)一個(gè)submap構(gòu)建完成，也就是不會(huì)再有新的laser scan插入到該submap時(shí)，算法會(huì)將該submap加入到閉環(huán)檢測(cè)中。閉環(huán)檢測(cè)的本質(zhì)也是一個(gè)優(yōu)化問題，該優(yōu)化問題被表達(dá)成了一個(gè)pixel-accurate match的形式，解決優(yōu)化問題的方法是Branch-and-Bound Approach.

作者：良知猶存

轉(zhuǎn)載授權(quán)以及圍觀：歡迎添加微信公眾號(hào)：羽林君

   

安裝介紹

   

    cartographer的安裝主要包括三個(gè)部分：cartographer、cartographer-ros、ceres-solver。其中cartographer 是計(jì)算的部分，cartographer-ros是算法在ROS中通訊交互數(shù)據(jù)的部分，ceres-solver谷歌開發(fā)的一款用于非線性優(yōu)化的庫，在谷歌的開源激光雷達(dá)slam項(xiàng)目cartographer中被大量使用。

    安裝的方法有兩種，一種是官網(wǎng)的集成式下載配置，一種是把cartographer需要的依賴部分分別安裝配置。

    兩種方式區(qū)別就在于，第一種雖然方便，但是由于網(wǎng)絡(luò)問題（你懂的）所以Google的相關(guān)文件下載會(huì)失敗，所以就出現(xiàn)了，把依賴單獨(dú)下載編譯，最后下載cartographer進(jìn)行編譯。

官網(wǎng)方式：

1. 安裝 wstool下載工具、rosdep和ninja編譯工具（ninja是一個(gè)新型的編譯小工具，用來替換復(fù)雜的make，從而實(shí)現(xiàn)快速編譯）

sudo apt-get update
sudo apt-get install -y python-wstool python-rosdep ninja-build

2. 建立一個(gè)wstool下載+ROS基本編譯的二合一環(huán)境

mkdir catkin_wscd catkin_wswstool init srcwstool merge -t src https://raw.githubusercontent.com/googlecartographer/cartographer_ros/master/cartographer_ros.rosinstall

這是 wstool 命令生成 .rosinstall 的文件里面的內(nèi)容，可以看到設(shè)置了cartographer、cartographer-ros下載鏈接。

wstool update -t src

靜靜等待下載，速度就取決你對(duì)于Google的認(rèn)知。

3.安裝proto3.

    Protocol Buffers(簡(jiǎn)稱Protobuf) ，是Google出品的序列化框架，與開發(fā)語言無關(guān)，和平臺(tái)無關(guān)，具有良好的可擴(kuò)展性。Protobuf和所有的序列化框架一樣，都可以用于數(shù)據(jù)存儲(chǔ)、通訊協(xié)議。

src/cartographer/scripts/install_proto3.sh

此外其實(shí)除了Protobuf我們還可以配置其他依賴，這些腳本都在這個(gè)目錄，如果編譯過程中遇到依賴問題就可以去利用腳本去下載。

4.rosdep init在安裝ROS時(shí)候就安裝過了，不過這個(gè)經(jīng)常會(huì)出現(xiàn)問題，我之前寫過一篇ROS安裝的文件，大家有興趣可以去看看

對(duì)于這個(gè)問題，有兩種解決思路：訪問DNS解析環(huán)節(jié)解決或者直接切換軟件源。

DNS解析環(huán)節(jié)解決：

切換linux軟件源：

sudo rosdep initrosdep updaterosdep install --from-paths src --ignore-src --rosdistro=${ROS_DISTRO} -y

5.最后一步編譯

catkin_make_isolated --install --use-ninjasource install_isolated/setup.bash

    但是好多時(shí)候因?yàn)橄螺d問題，就會(huì)出現(xiàn)這樣那樣的問題，所以就出現(xiàn)了下面的方法，把包單獨(dú)下載，然后再進(jìn)行編譯安裝。

注！：在我編譯cartographer過程中，和文章所寫這種一氣呵成的感覺恰恰相反，我編譯了好多次才編譯成功的，而且中間出現(xiàn)各種編譯問題，基本都是版本問題。所以請(qǐng)大家注意下載各個(gè)分包的版本，切記，切記，切記~

你看我probuf版本下載記錄就知道了。

分包編譯方式：

cartographer分成6個(gè)部分，分別是eigen3.2.9,ceres1.13.0,protobuf大于3.0.0,cartographer,cartogpher_ros，abseil。分開進(jìn)行編譯：

1.eigen

    Eigen是高級(jí) C ++ 模板標(biāo)頭庫，用于線性代數(shù)，矩陣和矢量運(yùn)算，幾何變換，數(shù)值求解器和相關(guān)算法。自3.1.1版以來，Eigen是根據(jù)Mozilla Public License 2.0許可的開源軟件。早期版本是根據(jù)GNU較寬松通用公共許可證授權(quán)的。

注意警告：cartographer對(duì)eigen，ceres，protobuf有嚴(yán)格的版本限制，版本必須嚴(yán)格?。。?/p>

#選擇版本3.2.9git clone  https://gitlab.com/libeigen/eigen.gitmkdir buildcd buildcmake ..sudo make install

安裝完成

2.ceres

Ceres solver 是谷歌開發(fā)的一款用于非線性優(yōu)化的庫，在谷歌的開源激光雷達(dá)slam項(xiàng)目cartographer中被大量使用。

注意：ceres版本必須是1.13.0,其它版本與eigen3.2.9不匹配

#選擇版本1.13.0git clone https://github.com/ceres-solver/ceres-solver.gitmkdir buildcd buildcmake ..make -j8sudo make install

編譯過程中如果出現(xiàn)這個(gè)編譯問題：

Failed to find glog

-- Failed to find installed glog CMake configuration, searching for glog build directories exported with CMake.

-- Failed to find an installed/exported CMake configuration for glog, will perform search for installed glog components.

-- Failed to find glog - Could not find glog include directory, set GLOG_INCLUDE_DIR to directory containing glog/logging.h

這個(gè)原因是缺失glog庫(glog 是一個(gè) C++ 日志庫，它提供 C++ 流式風(fēng)格的 API。在安裝 glog 之前需要先安裝 gflags，這樣 glog 就可以使用 gflags 去解析命令行參數(shù))，我們可以用apt-get install安裝，也可以下載源碼進(jìn)行編譯安裝.

apt-get install安裝:

sudo apt-get install libgoogle-glog-dev

下載源碼進(jìn)行編譯安裝:

git clone https://github.com/google/glog.gitcd glogmkdir buildcmake ..makesudo make install

再重新進(jìn)行cere編譯安裝，又通過一關(guān)

3. protobuf

Protocol Buffers(簡(jiǎn)稱Protobuf) ，是Google出品的序列化框架，與開發(fā)語言無關(guān)，和平臺(tái)無關(guān)，具有良好的可擴(kuò)展性。Protobuf和所有的序列化框架一樣，都可以用于數(shù)據(jù)存儲(chǔ)、通訊協(xié)議。

注意：protobuf安裝方式特殊，腳本安裝

選擇版本3.0.0git clone https://github.com/protocolbuffers/protobuf.git./autogen.sh

這次也會(huì)遇到error問題，

第一個(gè)error    48: autoreconf: not found

是在不同版本的 tslib 下執(zhí)行 autogen.sh 產(chǎn)生。它們產(chǎn)生的原因一樣,是因?yàn)闆]有安裝automake 工具,  用下面的命令安裝好就可以了。

sudo apt-get install autoconf automake libtool

第二個(gè)error可能是下載問題，這邊會(huì)提示你下載失敗，你可以選擇注釋掉，或者使用我提供的第二種編譯方法：

#如遇見Error，prot：443,注釋autogen.sh腳本34行./configuremake -j8sudo make installsudo ldconfig#測(cè)試一下protobufprotoc --version#不出意外將會(huì)顯示libprotoc 3.0.0

第二種編譯方法：

    上文說到，我們?cè)赾artographer/scripts目錄下可以找到cartographer依賴文件的下載的腳本，這些的腳本里面還有編譯的選項(xiàng)，這時(shí)候我們就可以看下install_proto3.sh 這個(gè)文件，里面可以看到如下內(nèi)容：

mkdir buildcd buildcmake -G Ninja \  -DCMAKE_POSITION_INDEPENDENT_CODE=ON \  -DCMAKE_BUILD_TYPE=Release \  -Dprotobuf_BUILD_TESTS=OFF \  ../cmakeninjasudo ninja install

我們直接復(fù)制直接編譯即可。

4.abseil

abseil 是 google 開源的 C++通用庫，其目標(biāo)是作為標(biāo)準(zhǔn)庫的補(bǔ)充。abseil 不但提供了標(biāo)準(zhǔn)庫沒有但很常用的功能，也對(duì)標(biāo)準(zhǔn)庫的一些功能進(jìn)行了增強(qiáng)設(shè)計(jì)，使用 abseil 庫能使程序性能和開發(fā)效率都取得不錯(cuò)的提升。

cartographer對(duì)abseil沒有版本要求，但是一定要有。

git clone https://github.com/abseil/abseil-cpp.gitmkdir buildcd buildcmake .. -DCMAKE_CXX_STANDARD=11make -j8sudo make install

不過在后續(xù)編譯abseil，大家可能會(huì)遇到這個(gè)問題

CMake Error at CMakeLists.txt:49 (find_package):

  By not providing "FindAbseil.cmake" in CMAKE_MODULE_PATH this project has

  asked CMake to find a package configuration file provided by "Abseil", but

  CMake did not find one.

  Could not find a package configuration file provided by "Abseil" with any

  of the following names:

    AbseilConfig.cmake

    abseil-config.cmake

  Add the installation prefix of "Abseil" to CMAKE_PREFIX_PATH or set

  "Abseil_DIR" to a directory containing one of the above files.  If "Abseil"

  provides a separate development package or SDK, be sure it has been

  installed.

不過沒事，是因?yàn)镃MakeLists.txt在進(jìn)行搜尋absil中，定義的名稱和你編譯abseil名稱不同，CMakeLists.txt是大寫的，而實(shí)際你編譯安裝后的包名稱為小寫。

修改如上所示：Abseil 修改為 absl 

5.carographer

注意：carographer和cartographer _ros版本必須對(duì)應(yīng)

mkdir cartographercd cartographer & mkdir srccd src
git clone https://github.com/cartographer-project/cartographer.gitgit clone https://github.com/cartographer-project/cartographer_ros.git
catkin_make_isolated   /*也可以用*/  catkin_make_isolated --install --use-ninja

編譯成功：

   

建圖開發(fā)

   

現(xiàn)在安裝了Cartographer和Cartographer的ROS集成，官方也提供了一些數(shù)據(jù)集，Deutsches Museum(德意志博物館)，這樣我就可以很方便測(cè)試Cartographer生成地圖和其他的功能了。

下載示例包（例如德意志博物館的2D和3D背包系列）到一個(gè)已知的位置

示例位于~/Downloads，并使用roslaunch來調(diào)出演示：

# Download the 2D backpack example bag.wget -P ~/Downloads https://storage.googleapis.com/cartographer-public-data/bags/backpack_2d/cartographer_paper_deutsches_museum.bag
# Launch the 2D backpack demo.roslaunch cartographer_ros demo_backpack_2d.launch bag_filename:=${HOME}/Downloads/cartographer_paper_deutsches_museum.bag# Download the 3D backpack example bag.wget -P ~/Downloads https://storage.googleapis.com/cartographer-public-data/bags/backpack_3d/with_intensities/b3-2016-04-05-14-14-00.bag# Launch the 3D backpack demo.roslaunch cartographer_ros demo_backpack_3d.launch bag_filename:=${HOME}/Downloads/b3-2016-04-05-14-14-00.bag

    又會(huì)是下載的問題，這些文件又大，下載速度又慢還經(jīng)常失敗，我也是廢了九牛二虎之力下載下來的。

為了方便大家測(cè)試，大家可以公眾號(hào)后臺(tái)私我，或者添加我微信號(hào)，我把我下載好的文件發(fā)給大家。

截圖有限，之前操作都忘記截圖了，導(dǎo)致現(xiàn)在就只有一個(gè)了，大家湊合看了哈。

生成.pdstream地圖（等待直到cartographer_offline_node完成），

roslaunch cartographer_ros offline_backpack_2d.launch bag_filenames:=${HOME}/Downloads/cartographer_paper_deutsches_museum.bag

然后運(yùn)行純定位:

roslaunch cartographer_ros demo_backpack_2d_localization.launch  load_state_filename:=${HOME}/Download/cartographer_paper_deutsches_museum.bag.pbstream   bag_filename:=${HOME}/Downloads/cartographer_paper_deutsches_museum.bag

關(guān)于怎么實(shí)現(xiàn)環(huán)境建立以及進(jìn)行建圖測(cè)試問題的解答就分享到這里了，希望以上內(nèi)容可以對(duì)大家有一定的幫助，如果你還有很多疑惑沒有解開，可以關(guān)注億速云行業(yè)資訊頻道了解更多相關(guān)知識(shí)。