[發明專利]一種管道檢修機器人控制系統

有效

• 申請號: 201610140462.2
• 申請日: 2016-03-11
• 公開（公告）號: CN105666481B
• 公開（公告）日: 2017-12-05
• 發明（設計）人: 肖雅;劉心文;吳貴新;徐輝
• 申請（專利權）人: 福建省汽車工業集團云度新能源汽車股份有限公司
• 主分類號: B25J9/08
• 分類號: B25J9/08;B25J9/16;B25J18/00;B62D57/024
• 代理公司: 福州市景弘專利代理事務所(普通合伙)35219
• 代理人: 黃以琳,林祥翔

技術領域

本發明涉及機器人控制領域，特別是涉及一種管道檢修機器人控制系統。

背景技術

隨著國際工業生產技術的不斷發展與進步，機器人已越來越多的被應用于工業生產過程中，其中一類機器人就是管外機器人。管外機器人是用于檢查管道是否有故障或是否存在安全隱患。現有工業用管道的特點是管徑多變，轉向復雜，具有三通、四通等管接頭設計，法蘭、閥門或檢測儀表在管道各處布置，且管道由各類吊裝或地面支持架支撐。運行在此類管道外的檢測或維修的機器人首先要具備隨管道前進或轉向的功能，也要具備翻越各類管道外障礙物的功能，同時，為了提高管道檢測與維修的效率，管外機器人還應該具有一定速度的運動能力。

中國發明專利申請公布號為CN 104972460 A，公開了一種多關節全向式管外機器人，該機器人包括用于承載檢測設備的承載梁、多關節前夾持機構、多關節后夾持機構、前翻轉關節、后翻轉關節、夾持開合機構、軸向驅動機構和周向驅動機構。該機器人在理論上可實現全向輪式運動和翻轉越障運動，全向輪式運動包括軸向移動、周向移動和360螺旋運動。

上述機器人是在光滑的管道上運行工作，并且管道的外徑、分布以及光滑程度差異大，上述機器人在管道外運動時易出現驅動輪打滑、夾持機構夾持不穩、翻轉越障不到位等現象，不僅影響機器人工作效率和檢測精度，且易出現機器人摔毀現象。

發明內容

為解決上述技術問題，本發明提供一種管道檢修機器人控制系統，用于提高多關節全向式管外機器人的運動穩定性。

本發明是這樣實現的：

一種管道檢修機器人控制系統，所述機器人包括設備承載梁、前夾持機構、后夾持機構和夾持開合機構，前夾持機構通過前翻轉關節鉸接于設備承載梁的一端，后夾持機構通過后翻轉關節鉸接于設備承載梁的另一端，所述前夾持機構或后夾持機構上設置有軸向驅動機構，設備承載梁上設置有周向驅動機構，所述夾持開合機構通過蝸輪傳動結構和鋼絲繩驅動前夾持機構和后夾持機構的各關節；

所述控制系統包括夾持力控制單元、整機運動狀態控制單元、驅動舵機控制單元、無線傳輸單元、組網單元和跌落控制單元；

所述夾持力控制單元包括安裝于夾持開合機構的蝸桿軸上的力傳感器，夾持力控制單元用于通過所述力傳感器檢測前夾持機構和后夾持機構的驅動鋼絲繩的張緊程度，并與預設的最大夾持力以及預先標定的標準力值比較，判斷機器人夾持機構的夾持力是否足夠，以及對夾持開合機構輸出進行調整，使前夾持機構和后夾持機構的夾持力在設定范圍內；

所述整機運動狀態控制單元包括9軸姿態傳感器，整機運動狀態控制單元用于輸出驅動控制信號，使機器人完成翻轉、軸向運行、周向運行、螺旋運行，以及通過所述9軸姿態傳感器采集機器人的運動狀態信息，并與機器人當前運動狀態對應的標準狀態信息比較，判斷機器人當前運動是否正常，當機器人運動異常時，控制機器人進行運動自適應調整；

跌落控制單元包括電磁吸盤、重力傳感器和緩沖氣囊，跌落控制單元通過重力傳感器檢測機器人是否發生跌落，并在發生跌落時控制電磁吸盤上電以及控制向緩沖氣囊充氣。

進一步的，整機運動狀態控制單元通過所述9軸姿態傳感器采集到的運動狀態信息包括：軸向運動速度、周向運動速度、螺旋運動速度與方向、翻轉方位和翻轉速度。

進一步的，整機運動狀態控制單元控制機器人進行軸向運動時的運動自適應調整包括：

整機運動狀態控制單元獲取機器人的當前運動速度，并根據9軸姿態傳感器采集的信息判斷機器人的當前空間姿態；

通過夾持力控制單元獲取前夾持機構與后夾持機構的當前夾持力度；

對比機器人的當前運動速度與預設的機器人軸向標準運動速度，以及對比當前夾持力度與預設的軸向運動的標準夾持力度；

若當前運動速度低于軸向標準運動速度，且當前夾持力度與標準夾持力度在預設的誤差范圍內，則增大前夾持機構與后夾持機構的夾持力度；

若當前運動速度高于軸向標準運動速度，且當前夾持力度與標準夾持力度在預設的誤差范圍內，則減小前夾持機構與后夾持機構的夾持力度。

進一步的，整機運動狀態控制單元控制機器人進行翻轉時的運動自適應調整包括：

增大前夾持機構或后夾持機構的夾持力度；

整機運動狀態控制單元采集機器人的當前翻轉速度和軸向運動速度；

比較當前翻轉速度與預設的標準翻轉速度；

若當前翻轉速度大于標準翻轉速度或軸向運動速度不為零，則再次增大前夾持機構或后夾持機構的夾持力度。