楊 軍,張 敏,陳一心,任禮成,王飛宏,丁志遠
(南京工程學院機械工程學院,南京 211167)
移動機器人的行走機構主要有輪式行走機構,履帶式行走機構和腿式行走機構,其中輪式行走機構運動速度快,靈敏度高,控制較為簡單;履帶式結構具有良好的自復位和越障能力,腿式機器人能夠很好地越障的同時具有一定的抗沖擊力能力。但由于移動機器人的工作環境趨于復雜化,復合式機器人因時而生,在勘探、救援等領域得到了廣泛的應用。如西安科技大學設計結合變胞機構理論,自主設計研究出一種新型輪履復合機器人,利用構型—平面四連桿機構、曲柄滑塊機構完成輪式、履帶式行走方式的轉換。長安大學基于液壓系統所設計的輪履復合機器人可適用于大型工程機械。以色列埃爾比特系統公司的可重構履帶機器人[1],通過將整個履帶收縮到輪的內部完成輪履切換,但不能完成翻轉運動功能。
本文創新性地設計出一種旋轉式輪履復合式機器人,實現輪式行走和履帶式行走共用同一套驅動裝置,通過將輪和履帶的模塊化設計,以旋轉的方式達到增強機器人越障能力的目的。為今后機器人復合式底盤設計與研究提供一定的理論和技術支持。
旋轉式輪履復合機器人屬于輪履變形式的輪履復合式底盤設計。機器人采用2020鋁型材搭建底盤框架,在滿足機器人各項性能的基礎上,達到減少機器人自重的目的;選用PMMA做為固定履帶和輪的旋轉臂材料,同時兼顧硬度和穩定性。利用蝸輪蝸桿電機的自鎖性;做為旋轉臂的旋轉動力源和鎖死裝置。機器人采用全輪驅動的驅動方式,從而實現機器人的移動和轉向的快速性。
輪履復合式機器人需要兼顧輪式快速行走能力和輪帶式越障能力,旋轉臂的結構使得輪式和履帶式共用同一驅動裝置,選用型號為XC38PG38的有刷行星齒輪減速電機作為機器人行走的動力源,同時驅動電機、履帶和輪上的齒輪選擇模數和齒數相同的齒輪,使得電機到履帶軸和輪軸的傳動比相同。因輪的直徑遠大于履帶驅動輪的直徑,在保證履帶式行走具有充足動力的同時,輪式行走的速度得到保證。
根據設計要求,利用三維建模軟件Solid Works作為工具,設計出機器人的機械結構,在此基礎上建立零件圖并進行機器人的整體裝配。旋轉式輪履復合機器人三維模型如圖1所示。
機器人整體利用鋁型材搭建的框架,在綜合考慮旋轉臂的旋轉空間范圍和需安裝的車載傳感器如攝像頭的視覺范圍等條件下確定機器人的長度,根據電機的大小、旋轉軸和驅動軸的性能確定機器人的寬度,同時機器人內部預留足夠空間安裝機器人的電氣控制部分設備。
圖1 旋轉式輪履復合式機器人三維圖
在相同的工況條件下,輪式行走的受力面積小于履帶式行走時的受力面積,因此對輪式行走時的機器人底盤進行力學性能分析[2]。機器人底盤此時的受力情況較為復雜,因此對模型結構理想化,將底盤的支撐力簡化為固定支撐,因此形成應該懸臂梁結構模型[3]。將機器人重力載荷理想化為一組集中載荷F1,蝸輪蝸桿電機的力矩為M1,根據力的平移定理將重力合成為一個力矩M2和一個力F,因此整個機器人底盤受到的力為電機轉矩和M2的合力矩M和一個力F。對其進行彈塑性彎曲校核,驗證是否會產生不可恢復的塑性變形。根據極端受力情況F=20 000 N,彎矩最大處位于懸臂梁固定端,最大值Mmax=2.5 kN·m。
在Solid Works的插件Solid Works Simuation中進行機器人底盤材料定義、添加約束和負載,在網格化模型后,得出機器人底盤的應力、位移和應變云圖,如圖2所示。進行機器人底盤的彈塑性彎曲校核,角碼的連接件在生成運算算例時將Toolbox緊固件轉換為螺栓接頭,在底盤的一端添加固定幾何體,在固定端添加轉矩,在另一端添加外力F,基于曲率的風格為整個模型生成網格,運行此算例,得到機器人的應力云圖、位移云圖和應變云如圖2、3、4所示。顯然機器人底盤未發生大尺度塑性變形,機器人底盤的應變和應變在允許范圍內,因此底盤力學性能滿足設計要求。
圖2 機器人底盤應力云圖
圖3 機器人底盤位移云圖
圖4 機器人應變云圖
機器人在進行旋轉變形時,渦輪蝸桿旋轉電機提供動力,以齒輪嚙合傳動的方式帶動旋轉臂進行輪履切換。旋轉變形所選用的電機型號為4058GW31ZY蝸輪蝸桿減速電機(額定轉矩為35 kg·cm);機器人在進旋轉變形時,旋轉主軸受到較大的力矩;因此需要對主軸進行力學校核。主軸采用6061T6實心鋁棒加工而成,因為機器人旋轉主軸的對稱性,取主軸的一半進行校核,在Solid Works Simuation中主軸的一端添加固定約束,是在另一端添加扭矩,在基于曲率的風格下為整個模型生成網格后,運行算例,得到機器人的應力云圖、位移云圖和應變云如圖5、6、7所示;旋轉主軸的力學性能滿足機器人性能要求。
圖5 機器人旋轉軸應力云圖
圖6 機器人旋轉軸位移云圖
圖7 機器人旋轉軸應變云圖
機器人在履帶式行走狀態下,其越障能力和裝載能力更好,更加適應在非理想條件下的行走。因齒輪嚙合的要求,旋轉式輪履復合式機器人采用全向驅動[4]的方式實現機器人的行走,且每個驅動電機的運動速度相同,如圖8(a)所示,為正常狀態下的履帶行走,圖8(b)機器人前輪接近障礙物[3],通過機器人的車載紅外傳感器確定障礙物離機器人的距離,從而機器人進入越障準備狀態,圖8(c)機器人前輪旋轉臂由前輪的蝸輪蝸桿電機控制旋轉軸逆時針旋轉一定的角度,進行越障。圖8(d)機器人前輪越過障礙物,此時,前后輪蝸輪蝸桿旋轉電機鎖死,后輪驅動電機提高動力,使得機器人行走;直至后輪接觸到障礙物,后輪進入越障準備狀態,如圖8(e)所示,前輪旋轉臂恢復到齒輪嚙合狀態,后輪的蝸輪蝸桿旋轉電機控制后輪順時針旋轉一定角度,進行后輪的越障。最終,如圖8(f)所示,機器人完成整個越障[5]過程,進行正常行走。
圖8 旋轉式輪履復合式機器人越障過程原理簡圖
輪履機器人常作業于戶外等道路情況較復雜的地面,而常用的激光雷達/慣性組合導航,GPS/慣性組合導航等導航系統可能無法提供最優的道路規劃信息,因此機器人采用基于全局視角的導航方式。利用無人機搭載高位雙目攝像頭對機器人周圍環境信息進行采集,經過圖像預處理和傾斜角校正后,進行特征值深度數據計算和機器人特征匹配,匹配成功后確定關鍵幀圖像。通過將關鍵幀中高度數據與激光雷達數據進行數據融合,將道路信息立體化,實現三維空間的路徑規劃[6]。具體控制系統總體控制流程如圖9所示。
圖9 系統總體控制流程圖
3.2.1 Harris角點提取
在高位視角的圖像中,為了實現導航系統的高效性,選擇了角點作為深度數據的判斷條件,既保留了環境的特征信息,又可以有效的減少了信息數據量。進行Harris角點提取前需要利用二階Butterworth低通濾波器進行圖像的銳化,再利用Canny算子進行圖像邊緣檢測,減小道路信息中的多余信息量。如圖10所示為采集到單目的灰度圖像和對應提取Harris角點后的特征點圖像(Canny邊緣提取為黑色,特征值角點為紅色)。
圖10 圖像預處理圖
3.2.2 關鍵幀提取
由于無人機采集高位視角圖像時具有一定的抖動性,需要先對采集的視頻圖像進行消抖處理[7],在該系統中利用特征值匹配來進行圖像消抖,特征匹配公式如下。
式中:Pˉi為數據庫中機器人自身的特征值;Pi為圖像中對比的特征值;i表示像素點的個數,當整體特征值越相似DEV的值越接近于1,當特征匹配值大于等于閾值時,確定當前幀為關鍵幀,并進行深度數據計算。
利用SGBM匹配算法對高位雙目攝像頭采集的雙目圖像進行深度信息恢復,通過代價計算、動態規劃和后處理實現機器人作業環境的空間信息計算,SAD代價公式如下。
式中:x,y為圖像坐標系中的位置;L,R分別對應的是左目圖像坐標系和右目圖像坐標系,以左目圖像的匹配點為中心,在右目圖像中逐步計算特征點的差值,來確定圖像的深度信息;將最深點設為1將深度數據轉化為對應的高度數據,將高度數據與車載激光測距儀測量數據進行融合,實現環境信息的立體化。
如圖11所示,是雙目攝像頭的視差計算圖(可參考圖10灰度圖像),圖像中顏色越淺的地方,空間距離越近。
圖11 視差計算圖
由于攝像頭采集高位圖像存在一定的傾斜角,所以利用車載ENC03陀螺儀和MMA7361加速度計進行車身水平姿態的測算,通過對比車身特征值傾斜度對特征值高度數據進行一定的校正。
常用的路徑規劃的算法有Dijkstr算法[8],Floyd算法[9]。但是Dijkstra算法存在復雜度高的缺陷,而Floyd算法則多用于多源最短路徑規劃,所以該系統選擇了基于A*算法的路徑規劃。A*算法公式如下。
式中: H(n)為到目標點的啟發式估計代價;G(n)表示到任意結點的實際代價,當到目標節點的估計代價小于實際代價時就可以求得最優解。
通過計算道路信息中各個結點間的顛簸度,當道路顛簸度大于設定值或小于無法越障的閾值,且轉換效率大于預計繞障效率時,選擇履帶形態進行直接越障,其他情況選擇輪式形態進行繞道越障的方式。通過結合A*算法的數條路徑規劃來選擇實際復雜道路的機器人導航[10]。
環境信息的立體化,可以感知復雜環境下的情況,針對顛簸路面和平整地面可以分別選用履帶式和輪式機器人分別進行行駛,實現更高效率的機器人行駛,實現了機器人在復雜環境中的最優導航,確保機器人在復雜條件下的行走能力。
如圖12所示,是通過高位攝像頭采集的圖像數據,進行視差計算得到的道路信息(參考圖9灰度圖),利用MATLAB軟件實現的道路3D環境建模。該模型的場景與真實環境的信息相似程度較高,可以準確地識別出道路上較大區域障礙物的位置和基本的大小,實現了基本環境信息的識別。
圖12 3D環境建模圖
實際導航系統中,利用圖處理極大減少圖片中不必要的環境信息,減少了系統計算量,在一定程度上提高了輪履復合機器人對復雜環境的響應速度和能力。在完成了對環境的建模后,通過微處理器實現對機器人各個模塊的控制,實現在較為復雜環境下的自動路徑規劃和形態切換。
本文提出一種旋轉式輪履復合式機器人,通過驗證其不同行走情況下的驅動能力、在輪式行走下的底盤力學性能和旋轉變形時的旋轉軸性能。最后,提出一種基于高位雙目攝像頭的機器人導航系統,完成對機器人的路線規劃。