地面機器人系統(tǒng)通常用于人工介入成本過高、危險過大或者效率過低的任務。在許多情況下,機器人必須能夠自主工作,利用導航系統(tǒng)來監(jiān)視并控制它從一個位置移到另一個位置。管理位置和運動時的精度是實現(xiàn)有用、可靠的自主工作的關鍵。
MEMS(微機電系統(tǒng))陀螺儀可提供反饋檢測機制,對優(yōu)化導航系統(tǒng)性能非常有用。圖1所示的Seekur機器人系統(tǒng)就是一個采用先進MEMS器件來改善導航性能的自主系統(tǒng)。
圖1:Adept MobileRobots (www.mobilerobots.com)開發(fā)的Seekur系統(tǒng)是一個采用先進MEMS傳感器的自主系統(tǒng)
機器人導航概述
機器人的移動通常是從管理機器人總體任務進度的中央處理器發(fā)出位置變化請求開始的。導航系統(tǒng)通過制定行程計劃或軌跡以開始執(zhí)行位置變化請求。
行程計劃需考慮可用路徑、已知障礙位置、機器人能力及任何相關的任務目標。例如,對于醫(yī)院里的標本遞送機器人,遞送時間非常關鍵。行程計劃被饋入控制器,后者生成傳動和方向配置文件以便進行導航控制。這些配置文件可根據(jù)行程計劃執(zhí)行動作和進程。該運動通常由若干檢測系統(tǒng)進行監(jiān)控,各檢測系統(tǒng)均產(chǎn)生反饋信號;反饋控制器將信號組合并轉換成更新后的行程計劃和條件。
開發(fā)導航系統(tǒng)的關鍵步驟始于充分了解每種功能,尤其需要重視其工作目標和限制。各項功能通常都有一些明確界定且易于執(zhí)行的因素,但也會提出一些需要加以處理的具有挑戰(zhàn)性的限制。某些情況下,這可能是一個反復試探的過程,即識別和處理限制的同時又會帶來新的優(yōu)化機遇。
一般導航系統(tǒng)框圖
以Adept MobileRobots Seekur為例,它是一個自主機器人,具有四輪傳動系統(tǒng),每個車輪均有獨立轉向和速度控制能力,可在任何水平方向靈活地移動平臺。它的慣性導航系統(tǒng)(INS)與圖2所示的系統(tǒng)相似。
正向控制
如圖2所示,正向控制是通過發(fā)出機器人本體命令來實現(xiàn)的。這些命令本質上是誤差信號,產(chǎn)生自軌跡規(guī)劃器提供的行程計劃與反饋檢測系統(tǒng)提供的行程進度更新信息之間的差異。
圖2:Seekur導航系統(tǒng)利用GPS、激光檢測和MEMS陀螺儀來獨立控制各個車輪
這些命令被饋入逆向運動學系統(tǒng),后者將機器人本體命令轉換成每個車輪的轉向和速度配置文件。這些配置文件使用阿克曼轉向關系進行計算,整合了輪胎直徑、表面接觸面積、間距和其他重要幾何特性。
利用阿克曼轉向原理和關系,上述機器人平臺可創(chuàng)建以電子方式鏈接的轉向角度配置文件,類似于許多汽車轉向系統(tǒng)中使用的機械齒條-齒輪系統(tǒng)。由于這些關系是以遠程方式整合在一起的,不需要以機械方式鏈接車軸,因而有助于最大程度減小磨擦和輪胎滑移,減少輪胎磨損和能量損耗,實現(xiàn)簡單的機械鏈接無法完成的運動。
反饋檢測和控制
每個車輪均有一個傳動軸,通過變速箱以機械方式耦合至傳動馬達,同時通過另一個變速箱耦合至光學編碼器,即測程反饋系統(tǒng)的輸入端。轉向軸將車軸耦合至另一伺服馬達,該馬達負責確立車輪的轉向角度。轉向軸還將通過變速箱耦合至第二個光學編碼器,也即測程反饋系統(tǒng)的另一個輸入端。
導航系統(tǒng)使用一個擴展卡爾曼濾波器,通過整合多個傳感器的數(shù)據(jù)來估算行程圖上機器人的姿態(tài)。Seekur上的測程數(shù)據(jù)從車輪牽引和轉向編碼器(提供轉換)和MEMS陀螺儀(提供旋轉)獲得。
測程
測程反饋系統(tǒng)利用光學編碼器對傳動和轉向軸旋轉的測量結果來估算機器人的位置、駛向和速度。圖3提供了將傳動軸光學編碼器的旋轉計數(shù)轉換成線性位移(位置)變化的圖形參考和關系。
圖3:測程系統(tǒng)根據(jù)以上所示的關系,利用編碼器讀數(shù)確定線性位移
每個車輪的傳動軸和轉向軸編碼器測量結果在正向運動學處理器中用阿克曼轉向公式進行組合,從而產(chǎn)生駛向、偏轉速率、位置和線速度等測量數(shù)據(jù)。
該測量系統(tǒng)的優(yōu)點在于其檢測功能直接耦合至傳動和轉向控制系統(tǒng),因此可精確得知傳動和轉向控制系統(tǒng)的狀態(tài)。不過,該測量系統(tǒng)在車輛實際速度和方向方面的精度有限,除非有一組實際坐標可參考。主要限制(或誤差源)在于輪胎幾何形狀一致性(圖3中直徑的精度和波動),以及輪胎與地面之間的接觸中斷。輪胎幾何形狀取決于胎冠一致性、空氣壓力、溫度、重量及在正常機器人使用過程中可能發(fā)生變化的所有條件。輪胎滑移則取決于偏轉半徑、速度和表面一致性。
位置檢測
Seekur系統(tǒng)使用多種距離傳感器。對于室內應用,該系統(tǒng)采用270°激光掃描器為其環(huán)境構建映射圖。激光系統(tǒng)通過能量返回模式和信號返回時間測量物體形狀、尺寸及與激光源的距離。
在映射模式中,激光系統(tǒng)通過將工作區(qū)內多個不同位置的掃描結果組合,描述工作區(qū)特性(見圖4)。這樣便產(chǎn)生了物體位置、尺寸和形狀的映射圖,作為運行時掃描的參考。
圖4:激光檢測可以映射周圍環(huán)境,如圖中所示的走廊-門-房間-儲物柜位置關系等
激光掃描器功能結合映射信息使用時,可提供精確的位置信息。該功能如果單獨使用,會存在一定限制,包括掃描時需要停機以及無法處理環(huán)境變化等等。在倉庫環(huán)境中,人員、叉車、托盤搬運車及許多其他物體常常會改變位置,這可能影響到達目的地的速度,以及到達正確目的地的精度。
對于室外應用,Seekur使用全球定位系統(tǒng)(GPS)進行位置測量。全球定位系統(tǒng)通過至少四顆衛(wèi)星的無線電信號飛行時間對地球表面上的位置進行三角測量。
信號可用時,此類系統(tǒng)的精度可達1米以內。不過,這些系統(tǒng)難以滿足視線要求,可能受建筑、樹木、橋梁、隧道及許多其他類型的物體影響。某些情況下,如果室外物體位置和特性已知(如“城市峽谷”等),則在GPS運行中斷時也可使用雷達和聲納來協(xié)助進行位置估算。即便如此,當存在動態(tài)條件時,例如汽車經(jīng)過或正在施工,效果常常會受到影響。
GPS 位置檢測
MEMS角速率檢測
Seekur系統(tǒng)使用的MEMS陀螺儀可直接測量Seekur關于垂直(或偏航)軸的旋轉速率,該軸在Seekur導航參考坐標系內與地球表面垂直。用于計算相對駛向的數(shù)學關系式(式1)是固定周期內(t1至t2)角速率測量結果的簡單積分。
#p#分頁標題#e#
該方法的主要優(yōu)勢之一是連接至機器人機架的陀螺儀可測量車輛的實際運動,而無需依靠齒輪比、齒隙、輪胎幾何形狀或表面接觸完整性。不過,駛向估算需要依靠傳感器精度,而該精度取決于偏置誤差、噪聲、穩(wěn)定性和靈敏度等關鍵參數(shù)。
固定偏置誤差ωBE轉換為駛向漂移速率,如式2所示:
偏置誤差可分為兩種:當前誤差和條件相關誤差。Seekur系統(tǒng)估算的是未運動時的當前偏置誤差。這要求導航電腦能夠識別未執(zhí)行位置變化命令的狀態(tài),同時還要方便進行數(shù)據(jù)收集偏置估算和校正系數(shù)更新。該過程的精度取決于傳感器噪聲以及可用于收集數(shù)據(jù)并構建誤差估算的時間。Allan方差曲線(見圖5)可提供偏置精度與均值時間之間的簡便關系。本例中,Seekur可將20秒內的平均偏置誤差減小至0.01°/s以下,并可通過在約100秒的周期內求均值來優(yōu)化估算結果。
圖5:Allan方差曲線(對應器件為ADIS16265,它是一款與Seekur系統(tǒng)目前所用陀螺儀相似的iSensor MEMS器件)也有助于確定陀螺儀檢測的最佳積分時間
Allan方差關系式還有助于深入了解最佳積分時間(τ=t2–t1)。該曲線上的最低點通常被確定為運行中偏置穩(wěn)定度。通過設置積分時間T,使其等于與所用陀螺儀的Allan方差曲線上最低點相關的積分時間,可優(yōu)化駛向估算結果。
包括偏置溫度系數(shù)在內的條件相關誤差會影響性能,因此可決定需要每隔多久停止一次機器人的運行,以更新其偏置校正。使用預校準的傳感器有助于解決最常見的誤差源,例如溫度和電源變化。
例如,將ADIS16060改為預校準的ADIS16265可能會增加尺寸、價格和功率,但可以將相對于溫度的穩(wěn)定性提高18倍。對于2°C溫度變化,ADIS16060的最大偏置為0.22°/s,而ADIS16265只有0.012°/s。
如以下關系式3所示,靈敏度誤差源與實際駛向變化成正比:
商用MEMS傳感器的額定靈敏度誤差通常在±5%至±20%以上,因此需要進行校準以減小這些誤差。例如ADIS16265和ADIS16135等預校準MEMS陀螺儀的額定誤差小于±1%,在受控環(huán)境中甚至可以達到更高性能。
轉載請注明出處。