[發明專利]一種應用于核工業的自動檢修機器人

無效

• 申請號: 201210529247.3
• 申請日: 2012-12-10
• 公開（公告）號: CN103862455A
• 公開（公告）日: 2014-06-18
• 發明（設計）人: 汪小君
• 申請（專利權）人: 哈爾濱網騰科技開發有限公司
• 主分類號: B25J5/00
• 分類號: B25J5/00;B25J9/16;B25J19/00
• 代理公司: 暫無信息
• 代理人: 暫無信息

技術領域

本發明涉及一種自動檢修機器人，具體說是一種應用于核工業中的自動檢修機器人。

背景技術

核電站有很多檢修和維護過程都帶有放射性，操作人員的工作環境比較惡劣。核電站檢修機器人是應用在輻射環境下，能夠在大范圍內自主移動并做檢查和維護的特種機器。

發明內容

本發明是提供一種自動尋找目標，并能自主導航定位的高度自動化，智能化的核工業領域內的機器人。

本發明的目的是這樣實現的：

它主要包括嵌入式MINI2440開發板（1）,LCD顯示(2)上位機與下位機的通訊系統（3），激光測距儀(4),單片機子系統(5)，驅動電路(6)，PID控制器(7)，機器人執行機構(8)，碼盤測距定位機構(9).

它的工作原理是這樣子的：

首先通過激光測距儀(4)對工作區域進行掃描。

將收集到的數據通過上位機與下位機的通訊系統（3）傳送給嵌入式???????????????????????????????????????????I?????MINI2440開發板（1）進行模式識別和處理.

并將處理后的命令發給單片機子系統(5)。

通過碼盤測距定位機構(9)進行定位和導航到目標區。

它的動作過程是這樣的：

本文采用激光測距儀進行目標物體的探測。依靠光電碼盤計算脈沖數來推算機器人相對于起始位置的位移；且由于機器人做有轉彎半徑轉彎時兩輪產生差動，為位移計算帶來困難，因此機器人在運動過程中只能原地旋轉而不能進行有轉彎半徑轉向，以此來提高定位精度。碼盤脈沖數與行進距離關系式為：

距離（m）=?脈沖數?/?16500?*?0.67??????????????（4.1）

其中，16500為主動輪轉一圈光電編碼器產生的脈沖數，0.67為主動輪的周長，單位為米。

機器人在工作空間中以一定方式巡游，直至發現并定位所有目標物，作業結束。

本發明的有益效果是：

嵌入式檢修機器人對于核電站等高危場所的自動化作業有著重要的意義。在核電站核心區工作的人員很有可能受到核輻射的侵害，它的出現正可以代替人類，通過自主控制或遠程遙控，深入這些區域，完成相應作業。本論文的預期標的是使用嵌入式系統控制機器人，實現機器人自主運動；通過采集激光測距儀信息，識別出目標并執行相應作業。

附圖說明

圖1是實際工作空間示意圖

圖2是說明坐標變換

圖3為系統結構框圖

具體實施方式

結合圖1和圖2，工作空間中有若干目標，目標的數量為3個，圓柱體，半徑約15cm。為簡化問題，設工作空間中沒有障礙物。X軸和Y軸定義如圖所示。機器人位于起點處，其運動過程中位置的確定都是以起點為基準的相對位移。圖2是說明激光測距儀采集到的都是距離信息，創建局部環境地圖需要將極坐標轉換為平面直角坐標具體方法為：

x=cos(40+0.5×n)×d

y=sin(40+0.5×n)×d

根據采集到的數據，可以判斷出圖中圈內的距離值都是來自工作空間中的同一物體用激光測距儀測一半徑約為15cm的圓柱體，得到一組數據。將距離值轉換為坐標后，使用VC++6.0編寫界面顯示。為使圖像更加清晰，顯示時用線將坐標點連接起來，可以看出圖像中心有一段近似為圓弧。使用三角函數的方式計算出目標半徑，進而識別出目標。

結合圖3，通過上位機與激光測距儀之間的通信協議用于設置激光測距儀的工作模式、采集激光測距儀環境目標測量數據，通過激光測距儀采集到的數據，判斷出掃描到的工作空間中有幾個物體，將艏向對準最近的物體，前進。當行進到安全距離時，計算出掃描到的物體的掃描開角，通過掃描開角和設定的安全距離可以計算出被掃描到的物體的半徑，與已知的目標信息進行比較，以確定是否為目標。機器人通過光電編碼器記錄位移來確定在工作空間中的坐標，為了提高定位精度，機器人在運動中只做勻速直線運動，每次的轉向都是原地旋轉90°。