基于體感控制的智能工程車

周玉林 張雅達 趙秋陽 范翔宇

摘 要：針對市面上智能機器人行動不靈活，價格高昂的現狀，文中設計了一款基于體感控制的智能工程車。該智能工程車由運動底盤、攝像設備、多軸機械手臂和姿態手套組成。利用手勢姿態控制，消除了多按鍵復雜操作的弊端;底盤采用麥克納姆輪在有限空間內可以實現最大程度的運動;攝像設備可為操作人員實時傳輸地形圖像并連接VR眼鏡，具有更好的視覺效果;利用多軸機械手臂排除不利因素。該工程車的使用大大提高了人員施工的安全性，具有廣闊的應用前景。

關鍵詞：智能工程車;麥克納姆輪;攝像設備;多軸機械手臂

1 項目產品

目前，許多國家都在積極進行智能工程車的研究和開發，并已將其應用于多個領域。文中設計了一種基于體感控制的智能工程車，此智能工程車主要由運動底盤、攝像設備、多軸機械手臂和姿態手套組成。工程車利用手勢姿態控制，消除了多按鍵復雜操作的弊端，使其在復雜的環境中可以實現更加靈活的作業;底盤采用的特殊輪子結構—麥克納姆輪在有限空間內可以實現最大程度的運動;工程車上裝載的攝像設備可為操作人員實時傳輸回地形圖像，并連接VR眼鏡，具有更好的視覺效果;利用多軸機械手臂排除不利因素。此工程車的應用可以大大提高危險作業人員的安全性，有力保障他們的人身安全。

2 項目介紹

2.1 創意背景

隨著電子技術、計算機技術和制造技術的快速發展，一些消費類產品逐漸呈現出智能化發展趨勢，如今高科技含量的電子類產品儼然成了發展主流，越來越受人們的喜愛。顯然傳統的系統控制觀念無法完全滿足人們的需求，因此將智能控制系統與傳統控制系統完美結合在科學研究、智能救援等方面具有極高的現實意義。

2.2 技術創意

體感控制工程車底盤安裝的麥克納姆輪使工程車的轉彎半徑大大減小，能夠全向移動，增加靈活度，在狹窄環境中自由行駛。工程車采用人手姿態控制，省去了遙控多按鍵控制的繁瑣步驟，并且降低了遙控設備的攜帶不便性，遙控只作為備用操作選擇，使操作更加便捷。工程車上的多軸機械臂能夠穩定移動，對目標進行快速處理。

2.3 可行性

工程車采用STM32F4系列芯片，使用陀螺儀矯正工程車姿態，配合麥克納姆輪實現全向移動。STM32F4作為處理器，接收傳感器傳回的數據之后能夠通過算法控制工程車四個麥克納姆輪的速度。

陀螺儀是一種用來傳感與維持方向的裝置，基于角動量守恒理論實現功能。陀螺儀由一個位于軸心且可旋轉的轉子構成。陀螺儀一旦開始旋轉，由于轉子的角動量，陀螺儀表現出抗拒方向改變的趨向，判斷工程車的行駛方向，配合單片機隨時矯正工程車的運行軌跡。

麥克納姆輪是一種全方位移動方式，基于一個有許多位于機輪周邊的輪軸的中心輪原理，這些成角度的周邊輪軸把一部分機輪轉向力轉化到一個機輪法向力上，依靠各自機輪的方向和速度使這些力最終合成在任何要求的方向上產生一個合力矢量來保證平臺在最終的合力矢量方向上自由移動，而不改變機輪自身的方向。基于麥克納姆輪技術的全方位運動設備可以實現前行、橫移、斜行、旋轉及其組合等運動方式。

PID是一種基于反饋的自動控制技術，測量的關鍵是被控變量的實際值和期望值的比較，用該偏差來糾正系統響應，由比例單元P，積分單元I和微分單元D組成，PID能夠使系統的輸出值趨向于理想狀態，確保對工程車的控制更加穩定。

2.4 研究內容

體感智能工程車基于STM32F4芯片設計，工程車由底盤模塊、機械手臂、攝像設備和姿態手套組成。

底盤選用麥克納姆輪和伺服電機，通過全向移動算法，可充分發揮麥克納姆輪的性能，大大縮小工程車的轉彎半徑，實現全向移動，使小車在更復雜的環境中也能行走自如。

工程車的底盤和機械臂通過九軸傳感器與柔性電阻共同配合來實現體感操作，當手掌握拳時柔性電阻的阻值最小，這時螺陀儀將控制底盤運動;當手掌放松微開時柔性電阻的阻值變大，這時陀螺儀將控制機械臂的姿態變化。

將陀螺儀和柔性電阻集成于手套上，稱之為姿態手套。用戶通過自制的姿態手套利用nRF905無線通信協議實現遠程操控。

在復雜的環境中可以利用攝像設備實時傳輸圖像，利用機械臂實現清障維護等作業。

2.5 目的意義

姿態遙控相比傳統的遙控操作簡便、靈活。數據顯示，很多勘測作業人員就是在進行作業時發生了意外危險而導致受傷或者死亡。基于體感的智能勘測工程車不僅操作方便，更大大保障了勘測人員的安全。

3 硬件組成

3.1 工程車底盤

工程車底盤實物。

3.2 機械手臂

車載的多軸機械手臂通過平行四邊形連桿和雙搖桿機構可以將電機安裝在基座上，控制機械手臂運動，實現活動范圍的最大化，并保持整體穩定。用戶通過自制的姿態遙控利用nRF905無線通信協議實現遠程操控與簡單的清障維護等操作。

3.3 麥克納姆輪

麥克納姆輪緣上斜向分布著許多小滾子，故輪子可以橫向滑移。小滾子的母線很特殊，當輪子繞著固定的輪心軸轉動時，各個小滾子的包絡線為圓柱面，所以該輪能夠連續向前滾動。麥克納姆輪結構緊湊，運動靈活，是一種應用廣范的全方位輪。使用4個該新型輪子進行組合，可以更靈活方便的實現全方位移動功能。

基于麥克納姆輪技術的全方位運動設備可以實現前行、橫移、斜行、旋轉及其組合等運動方式。在此基礎上研制的全方位叉車及全方位運輸平臺非常適合轉運空間有限、作業通道狹窄的艦船環境，在提高艦船保障效率、增加艦船空間利用率以及降低人力成本方面具有明顯的效果。

3.4 伺服電機

伺服電機（Servo Motor）是指在伺服系統中控制機械元件運轉的發動機，是一種補助馬達間接變速裝置。

使用伺服電機控制速度，位置精度高，可將電壓信號轉化為轉矩和轉速以驅動控制對象。伺服電機轉子轉速受輸入信號控制，能快速反應，在自動控制系統中用作執行元件，且具有機電時間常數小、線性度高、始動電壓等特性，可把收到的電信號轉換成電動機軸上的角位移或角速度輸出。電機分為直流和交流伺服電動機兩大類，其主要特點是：當信號電壓為零時無自轉現象，轉速隨著轉矩的增加而勻速下降。

4 市場分析

基于體感控制的智能工程車也稱為無人車輛，是一個集環境感知、規劃決策和多等級輔助駕駛等功能于一體的綜合系統。智能車輛的主要特點是在復雜的道路情況下，能自動操縱車輛進行障礙清除等作業。系統將多重傳感器與控制器進行了良好結合，該工程車的研究、開發和應用涉及傳感技術、電氣技術、電氣控制技術、智能控制等。該類小車的研究除了進行勘測作業之外，還可應用于科學研究，并且具有潛在的軍用價值。

目前市場上已經有掃地、澆花、防盜巡查等運用此類技術的智能小車，但是缺少一個為勘測人員進行工作，減少他們傷亡率的智能機器人，并且大部分機器人都是用復雜的遙控按鍵控制極為不便，遙控在此只作為備用操作方式，本項目由此誕生。

開發的姿態遙控相比傳統的遙控操作簡便、靈活。當工程車作為勘測機器人時，代替人類實地勘察、搬運、轉移可疑物，減少不必要的人員傷亡，最大限度保護人員安全。

市場上遙控操作的智能車型機器人遙控按鍵多，操作復雜。國內現有的類似機器人運動不靈活且成本高，而該智能工程車解決了這些問題，具有良好的發展前景。