引言

在之前的一篇文章中有提到購入了一臺myAGV，以樹莓派4B為控制核心的移動機器人。上篇文章中向大家介紹了myAGV如何實現(xiàn)建圖、導航以及靜態(tài)避障，但我們深知，這只是機器人自主導航能力的基礎。在實際應用場景中，機器人需要面對復雜的動態(tài)環(huán)境，如人流、障礙物等，如何實現(xiàn)可靠的動態(tài)避障，是我們不斷探索和挑戰(zhàn)的問題。在本文中，我們將分享我們在探索動態(tài)避障方面的實踐和經(jīng)驗，希望能夠為其他創(chuàng)客開發(fā)者和機器人愛好者提供一些參考和啟發(fā)。

如果想知道上篇介紹了些什么，點擊這個連接

產(chǎn)品

在此之前，還是在介紹一下myAGV，我使用的這款機器人。

myAGV是一款大象機器人公司出品的移動機器人，由樹莓派4B為控制核心，內(nèi)置Ubuntu18系統(tǒng),ROS編譯環(huán)境；360°激光雷達，內(nèi)置高清攝像頭。它采用了競賽級別的麥克納姆車輪和帶有金屬框架的全包裹設計。

動態(tài)避障

動態(tài)避障是指在移動機器人或自動駕駛汽車等智能移動設備在行進過程中，通過實時感知周圍環(huán)境的變化，采取相應的措施以避免與障礙物發(fā)生碰撞的技術。動態(tài)避障需要實時感知環(huán)境的變化，如監(jiān)測障礙物的位置、大小、形狀、運動狀態(tài)等，然后通過對這些信息的處理和分析，生成相應的行動指令，使機器人或汽車能夠避免與障礙物發(fā)生碰撞并繼續(xù)前進。

下面分享了一個視頻，內(nèi)容關于無人飛機進行快速動態(tài)避障的記錄。

突然起來的障礙物，需要立即避開它，避免造成無人機的損傷。今天我們要實現(xiàn)的是myAGV在自動導航的時候也能夠及時的躲避障礙物。

大象機器人提供的動態(tài)避障算法是基于TEB和DWA算法。

TEB算法

TEB（Timed-Elastic-Band)是一種用于軌跡優(yōu)化的算法，可用于機器人的動態(tài)避障和路徑規(guī)劃。主要對全局路徑規(guī)劃器生成的初始全局軌跡進行后續(xù)修正，從而優(yōu)化機器人的運動軌跡，屬于局部路徑規(guī)劃。在軌跡優(yōu)化過程中，該算法擁有多種優(yōu)化目標，包括但不限于：整體路徑長度、軌跡運行時間、與障礙物的距離、通過中間路徑點以及機器人動力學、運動學以及幾何約束的符合性。

起始點和目標點狀態(tài)都有全局規(guī)劃器制定，中間插入N個控制橡皮筋形狀的控制點。這個路徑是可以變形的，變形的條件就是所有約束條件，當作橡皮筋的外力，例如距離障礙物的距離，移動機器人的最大速度，最大角速度，最大轉(zhuǎn)彎半徑等。依靠這些約束條件來保證移動機器人的安全和穩(wěn)定。

TEB算法具體實現(xiàn)的過程如下：

1. 根據(jù)機器人當前位置和目標位置，生成一條初始路徑。

2. 將路徑表示為一系列時間段上的線段，稱為軌跡片段。每個軌跡片段表示機器人在一個時間段內(nèi)沿著一條直線運動的軌跡。

3. 對每個軌跡片段進行優(yōu)化，以滿足機器人的運動約束和避障需求。優(yōu)化目標是使軌跡片段的長度和運動時間最小，同時避免與障礙物發(fā)生碰撞。

4. 將優(yōu)化后的軌跡片段拼接在一起，形成機器人的最終運動軌跡。如果機器人遇到障礙物，可以重新生成軌跡片段，并進行優(yōu)化。

TEB算法的優(yōu)點是可以在運動中實時避開障礙物，并可以處理機器人的動態(tài)運動。同時，TEB算法可以結(jié)合其他的避障算法，例如基于模型預測控制的算法，提高避障效果。

DWA算法

DWA（DynamicWindowApproach）是一種用于機器人動態(tài)避障的算法。該算法旨在在機器人的運動范圍內(nèi)搜索最優(yōu)的運動軌跡，以避開障礙物。DWA算法通過將機器人的運動軌跡表示為一組(v,w)速度和角速度的組合，然后對這些組合進行搜索和評估，找到最優(yōu)的運動軌跡。

DWA算法的具體實現(xiàn)過程如下：

1. 根據(jù)機器人當前位置和目標位置，生成一組速度和角速度的候選集合，稱為速度窗口。

2. 對速度窗口中的每個速度和角速度組合，計算機器人在接下來的一段時間內(nèi)所能到達的位置，即運動軌跡。

3. 對每個運動軌跡進行評估，以確定是否與障礙物發(fā)生碰撞。評估的方法包括計算軌跡上的代價函數(shù)，例如與障礙物的距離和速度等。

4. 根據(jù)評估結(jié)果，選擇代價函數(shù)最小的運動軌跡，并將該軌跡作為機器人的運動指令。

這個視頻能夠輔助了解DWA算法。

TEB-DWA算法

TEB在實現(xiàn)動態(tài)避障方面具有一定的優(yōu)勢。然而，TEB算法也存在一些局限性，其中包括：

●對初始路徑依賴性強：TEB算法的性能很大程度上依賴于初始路徑的質(zhì)量。如果初始路徑存在較大的偏差或錯誤，TEB算法很可能會陷入無法解決的困境。

●對環(huán)境模型的依賴性強：TEB算法需要準確的環(huán)境模型，包括障礙物的位置和形狀等信息。如果環(huán)境模型存在偏差或誤差，TEB算法可能會出現(xiàn)路徑規(guī)劃錯誤的情況。

●對計算資源的要求高：TEB算法需要進行大量的計算和優(yōu)化，時間復雜度較高，對計算資源的要求也較高。

DWA算法也具有能對軌跡進行搜索和評估，選出最優(yōu)路徑解，但也有一定的局限性：

●無法處理高速運動的障礙物：DWA算法是基于機器人的運動模型和環(huán)境感知，通過搜索和評估速度和角速度的組合，找到最優(yōu)的運動軌跡，以避開障礙物。然而，在高速運動的障礙物出現(xiàn)時，DWA算法可能無法及時感知和處理，從而導致機器人的碰撞和安全問題。

●對環(huán)境模型的要求較高：DWA算法需要機器人具有較好的環(huán)境感知能力，以獲取環(huán)境中障礙物的位置、形狀和大小等信息。如果環(huán)境模型不準確或者不完整，DWA算法可能無法正確地評估運動軌跡的代價函數(shù)，從而導致機器人的錯誤運動和避障失敗。

●無法處理不確定的環(huán)境：DWA算法是基于靜態(tài)環(huán)境的假設，即環(huán)境中的障礙物位置不會發(fā)生變化。然而，在一些不確定的環(huán)境中，例如動態(tài)障礙物頻繁出現(xiàn)的場景，DWA算法可能無法有效地避開障礙物，從而導致機器人的碰撞和安全問題。

●難以處理多機器人協(xié)同避障：DWA算法通常是針對單個機器人的避障問題進行設計的，難以處理多機器人協(xié)同避障的問題。在多機器人協(xié)同避障時，需要考慮機器人之間的相互作用和協(xié)調(diào)，從而進行更加復雜和高級的避障算法設計。

為了解決TEB和DWA算法的局限性，實現(xiàn)更加精細和高效的動態(tài)避障和路徑規(guī)劃，有人提出了TEB-DWA算法，TEB-DWA算法的核心思想是通過將TEB算法和DWA算法的優(yōu)點結(jié)合起來，設計出一種更加精細和高效的動態(tài)避障算法。具體來說，TEB-DWA算法采用TEB算法的彈性帶方法，實現(xiàn)路徑規(guī)劃和優(yōu)化，同時采用DWA算法的速度窗口方法，實現(xiàn)速度和角速度的搜索和評估，從而實現(xiàn)機器人的動態(tài)避障和路徑規(guī)劃。

teb-dwa算法的實現(xiàn)過程是啥

TEB-DWA算法的實現(xiàn)過程主要分為以下幾個步驟：

1. 機器人運動模型的建立：根據(jù)機器人的運動約束和動力學模型，建立機器人的運動模型，用于計算機器人的運動軌跡和速度約束。

2. 環(huán)境感知和障礙物檢測：通過機器人的傳感器獲取環(huán)境中障礙物的位置、形狀和大小等信息，進行障礙物檢測和分類，以確定機器人的運動路徑和避障策略。

3. 彈性帶路徑規(guī)劃：根據(jù)機器人的起點和終點，利用彈性帶方法生成機器人的運動路徑，并考慮機器人的運動約束和避障需求，以實現(xiàn)路徑規(guī)劃和優(yōu)化。

4. 速度窗口搜索和評估：根據(jù)機器人的運動模型和環(huán)境感知信息，利用DWA算法搜索機器人的最優(yōu)速度和角速度組合，并評估每個速度和角速度組合的代價函數(shù)，以確定機器人的運動軌跡和避障策略。

5. 運動控制和執(zhí)行：根據(jù)計算得到的最優(yōu)速度和角速度組合，利用控制算法實現(xiàn)機器人的運動控制和執(zhí)行，以實現(xiàn)機器人的動態(tài)避障和路徑跟蹤。

實際操作

在ROS中，可以使用MoveBase包來實現(xiàn)TEB-DWA算法。MoveBase是ROS中常用的路徑規(guī)劃和導航包，提供了多種路徑規(guī)劃算法和導航功能，包括TEB-DWA算法。下面是使用ROS中TEB-DWA算法的步驟：

1. 安裝MoveBase包：在ROS中安裝MoveBase包，可以使用以下命令：“sudoapt-getinstallros--move-base”

2. 配置MoveBase參數(shù)：在使用TEB-DWA算法之前，需要配置MoveBase的參數(shù)。可以使用move_base.launch文件來配置參數(shù)，例如設置機器人的起點和終點、地圖信息、運動約束和避障參數(shù)等?？梢愿鶕?jù)具體的應用場景和任務需求，進行參數(shù)的調(diào)整和優(yōu)化。

3. 運行MoveBase節(jié)點：在配置好參數(shù)之后，可以使用以下命令來啟動MoveBase節(jié)點：”roslaunchmove_basemove_base.launch“

4. 發(fā)布目標點：在運行MoveBase節(jié)點之后，可以使用move_base/goal話題來發(fā)布機器人的目標點。例如使用rostopicpub命令來發(fā)布目標點：

5. 監(jiān)聽機器人狀態(tài)和反饋：在機器人開始運動之后，可以使用/move_base/status話題來監(jiān)聽機器人的狀態(tài)和反饋信息。例如使用rostopicecho命令來監(jiān)聽狀態(tài)和反饋信息：

建圖

我們快速的建圖，進行避障的實驗。

打開終端運行命令,啟動雷達

cdmyagv_rossource./devel/setup.bashroslaunchmyagv_odometrymyagv_active.launch

然后運行gmapping算法建圖

roslaunchmyagv_navigationmyagv_slam_laser.launch

動態(tài)避障

我們使用默認的配置，看看效果如何。

這似乎看起來實現(xiàn)了動態(tài)避障，但是似乎看起來有些許的愚蠢，在發(fā)現(xiàn)障礙物的時候還繞了一圈掃描環(huán)境。

調(diào)整了一下規(guī)劃的頻率（plannedfrequency）重新進行了一次測試。

這樣看起來效果就好多了。

總結(jié)

對myAGV也使用了有一段的時間了，首先我是十分喜歡它的外觀的，很酷炫，沒有結(jié)構件在外面展露出來，內(nèi)部包裹的很好，發(fā)生了碰撞也會有一定的保護作用。其次是它配套的資料都非常地詳細，能夠提供一個快速上手地模板使用，對于剛接觸一款全新未知的產(chǎn)品很有幫助。

使用下來的整體感受還是不錯的，連接顯示器就能夠使用，基于樹莓派也有很多的社區(qū)能夠提供幫助，有許多優(yōu)秀的案例。此外也有一些需要提升的地方，在進行建圖的時候，有時候并不是那么的準確，可能是因為外殼的原因？遮擋住了雷達的范圍。也希望使用時間上能夠更長。

審核編輯 黃宇