一種拖車式醫用配送機器人的設計與實現

任工昌 尚亞東 劉朋 胡小龍

摘? 要： 應急防控智能機器人在疾病防控中扮演著重要的角色。針對疫情防控過程中出現的物料配送不足問題，設計了一種醫用配送機器人，采用拖車式結構，將立體循環車廂與機械手結合實現遞送服務。系統采用了裝有ROS系統的MiniPC和STM32單片機，實現了機器人自主定位導航和機械手通過視覺識別完成抓取動作等功能。樣機的實驗結果顯示，系統實現了設計功能，實現了配送過程的全程自動化。

關鍵詞： 立體循環車廂; 機器人; ROS; 機械手

中圖分類號：TP242.6????????? 文獻標識碼：A???? 文章編號：1006-8228（2021）01-41-04

Design and implementation of a trailer-type medical distribution robot

Ren Gongchang， Shang Yadong， Liu Peng， Hu Xiaolong

（College of Mechanical and Electrical Engineering， Shaanxi University of Science and Technology， Xi'an， Shaanxi 710021， China）

Abstract： Intelligent robot for emergency prevention and control plays an important role in disease prevention and control. In order to solve the problem of insufficient material distribution in the process of epidemic prevention and control， a medical distribution robot is designed， which adopts a trailer structure and combines the three-dimensional circulation carriage with the manipulator to realize the delivery service. The system adopts a MiniPc installed with ROS system and STM32 single chip microcomputers to realize the functions of autonomous positioning and navigation of robot， and grasping action of manipulator through visual recognition. The experimental results of the prototype show that the system realizes the designed functions and realizes the full automation in whole material distribution process.

Key words： three-dimensional circulation carriage; robot; ROS; manipulator

0 引言

隨著機器人技術的快速發展，出現了用于各種領域的機器人，在物流配送行業內出現了各種物流配送機器人，配送機器人可以代替人類完成重復、繁重的工作[1]。在抗擊新型冠狀病毒期間，出現了各種醫用配送機器人，以降低醫護人員的交叉感染風險，減少醫護人員與病人接觸，提高管控工作效率，減輕醫護人員的心理壓力。

配送機器人可以在生產過程、運輸過程、配送過程發揮重要作用，配送機器人也可以在醫院、隔離區等多場景開展物資配送工作，出現的各種醫用配送機器人，大多都是一體式[2];機械手與配送機器人二者結合，它能夠在復雜環境中自主定位并遞送產品、貨物等[3]。

本文以拖車式結構為基礎，設計一款立體循環式車廂，ROS系統作為上位機，處理編碼器、激光雷達、深度攝像頭反饋的信息，STM32F103作為下位機接受上位機傳遞的信息，控制電機轉動，最后完成樣機的制作，并在樣機上進行實驗。

1 總體設計方案

配送機器人的設計主要由機械結構和控制系統兩部分組成，采用拖車式結構，對機器人的車廂結構和自動連接裝置進行設計，通過自動連接裝置連接，實現一機多車廂的功能，將立體循環車廂與機械手結合，便于視覺識別、定位和機械手抓取，控制系統采用上位機和下位機的結構，分別對機器人的上位機ROS系統進行設計和下位STM32進行設計，利用深度攝像頭對物品進行識別和定位。

2 醫用配送機器人結構設計

采用拖車式機器人結構，由牽引車頭和拖車兩部分組成，如圖2所示。牽引車頭主要提供動力和自主導航，拖車部分由模塊化的車廂構成，實現不同任務更換不同車廂的功能，其中針對口服藥品、食品的配送設計一款立體循環式車廂，車廂前側安裝一款5自由度機械臂，車廂后側安裝深度攝像頭，牽引車部分和拖車部分通過自動連接裝置連接。

2.1 立體循環車廂設計

針對醫藥用品的配送，設計了一款立體循環式車廂，保證醫藥用品的安全存取，易于攝像頭的識別與定位，便于機械手的抓取，如圖2所示。

立體循環車廂主要包括循環結構、平衡結構，采用鏈條鏈輪循環結構使小車箱循環轉動，平衡結構根據直線段和圓弧段兩部分分別采用滑塊導軌和行星輪結構，保證小車箱始終保持水平狀態。

結合深度攝像頭信息，控制系統可以控制每一個小車箱運動到最高處停止運動，進行存儲;該車廂的存儲和取物品的位置為同一位置，處于循環機構運動的最高處。設計平衡機構保證每個小車廂始終保持水平狀態，且車廂結構緊湊，適用于智能配送機器人，箱門開口朝上方便機械手存取。

2.2 連接裝置設計

自動連接裝置是由連接桿、曲柄滑塊、壓力傳感器組成，如圖3所示。自動連接裝置有自動連接和自動脫落兩種狀態。自動連接狀態，當連接桿一端觸碰到連接槽的壓力傳感器時，控制裝置控制電機轉動，帶動曲柄的轉動，連桿連接滑塊，使滑塊向下運動，擋住連接桿，使拖車車頭和車箱連為一體;脫落狀態，控制裝置控制電機轉動，使滑塊向上運動，連接桿脫落，使拖車的車頭和車箱分離。車箱可以針對不同任務設計多種樣式車廂，通過自動連接裝置可以更換不同樣式的車廂。

3 控制系統

3.1控制系統硬件設計

系統是由上位機和下位機兩部分組成，裝有ROS系統的MIniPC作為上位機處理編碼器、激光雷達、深度攝像頭反饋的信息，與遠程計算機通過無線路由器實現數據互傳，處理后的信息實時的傳給遠程計算機，遠程計算機以這些信息對多臺配送機器人進行調度。STM32F103作為下位機控制單元，由于采用牽引車和拖車的結構，分別用三個STM32F103來控制，第一部分為控制牽引車，位于牽引車頭，第二部分為控制立體循環車廂，位于拖車部分，第三部分機械臂有專用的控制器，其硬件連接如圖4所示。

激光雷達采用RPLIDARA2雷達，該設備與車載PC直接連接，將掃描數據直接發送至上位機處理。

深度攝像頭采用樂視3D體感攝像頭，型號為LeTMCM-302，將獲取的信息直接發送至上位機處理，可以通過算法對目標物進行定位與識別，從而實現機械手自主存取物品的控制。

3.2 控制系統軟件設計

控制系統軟件框架如圖5所示，軟件控制系統主要分為三層，操作系統層、驅動層和硬件層[4-5]。

Ubuntu14.04系統安裝有ROS，版本為Kinetic，作為操作系統層核心，各個功能包有著不同的作用，move_base包可以根據各個傳感器反饋的信息進行路徑規劃，使機器人移動到指定位置，amcl包主要是根據已有的地圖進行自主定位與導航，Cartographer包實現建圖功能，rviz為ROS提供了一種可視化工具等。

驅動層有的是硬件驅動，有的是軟件驅動，各個驅動包安裝在上位機，如樂視3D體感攝像頭的驅動包ros_astra_camera安裝在上位機中。

3.3 下位機軟件設計

下位機的主要作用是通過訂閱話題的通信方式，接收上位機傳來的運動信息，并通過增量式PID控制算法實現電機速度的無級調節，并向上位機反饋當前運動數據和傳感器的信息。

STM32F103作為下位機控制單元，由于采用牽引車和拖車的結構，分別用三個STM32F103來控制，如圖6所示，分別為牽引車驅動模塊、立體循環車廂轉動模塊、機械臂模塊。第一部分為控制牽引車，位于牽引車頭，通過電機驅動模塊實現對二個差速驅動輪的實時控制，其中，電機帶有二進制光電編碼器，可將運動數據反饋至控制單元中，實現對驅動輪的閉環控制;第二部分為控制立體循環車廂，位于拖車部分，控制立體循環式車廂的轉動及廂門的開合，其中，驅動立體循環機構的電機帶有二進制光電編碼器，由于每個小車廂的均勻分布，通過PWM控制使小車廂到達最高處，設置有傳感器可以使循環機構恢復初始狀態，箱門框架處設置有光電傳感器，通過光電傳感器對箱門進行限位;第三部分機械臂有專用的控制器;第一部分與上位機MiniPC之間采用串口通信實現數據互傳，第二、三部分與上位機MiniPC之間采用藍牙連接實現數據互傳。

3.4 上位機軟件設計

采用分布式處理框架的ROS系統作為上位機，主要兩個模塊是定位導航和機械臂控制，提供許多開源的功能包，幫助我們迅速完成軟件系統搭建。上位機軟件設計如圖7所示在定位導航模塊，利用Cartographer功能包實現建圖功能[6]，在建好地圖的情況下，ROS導航主要需要使用到兩個功能包，一個是move_base，另一個是amcl。move_base功能包可以根據各個傳感器反饋的信息進行路徑規劃，使機器人移動到指定位置，路徑規劃通過 move_base 功能包實現，具體可分為全局路徑規劃和局部路徑規劃，全局路徑規劃采用迪杰斯特拉算法，局部路徑規劃采用動態窗口方法 DWA（Dynamic Window Ap-proaches）計算最優避障路徑及機器人的實時速度和角速度[7]，amcl功能包主要是根據已有的地圖進行自主定位與導航，它采用了自適應蒙特卡羅定位算法[8]。

機械臂控制使用MoveIt。它屬于ROS系統的一部分，用于控制多關節機械臂;提供了一系列成熟的插件和工具，可以實現機械臂控制的快速配置;封裝了大量API，方便在MoveIt模塊上進行二次開發[9、10]。主要包括碰撞檢測、運動學求解、運動路徑規劃、操作控制等功能[11.12]。通過Solidworks三維建模轉為URDF模型，用Move It對URDF模型進行配置，配置流程如圖8，配置完成后，創建和修改一些文件，通過話題通信方式控制真實的機械臂。

4 實驗及分析

根據設計的醫用配送機器人機械結構，采用鋁型材、亞克力板等材料，制作的樣機如圖9所示。

如圖10是機器人在直線走廊建圖，紅色線條表示局部路徑規劃，說明該機器人能夠順利的躲避障礙物，實現自主導航功能;圖11是機械手自動抓取過程實物展示圖。控制立體循環車廂的轉動及箱門的開合，通過樂視3D體感攝像頭的識別與定位， MoveIt控制機械手實現自動抓取功能。

5 結束語

本文設計了拖車式醫用配送機器人的車廂和自動連接裝置的機械結構，對立體循環車廂的控制系統進行設計，最后制作出醫用配送機器人的樣機，對該樣機在室內走廊中進行了建圖、導航及避障的實驗，以及機械手的抓取實驗，結果顯示，機器人達到室內配送的要求，能夠實現全程自動化。下一步研究視覺識別，通過視覺識別，完成物品的分類。

參考文獻（References）：

[1] 任工昌，吳夢珂，朱愛斌等.帶單節拖車的機器人控制系統的設計與實現[J].電子技術應用，2018.44（11）：41-44

[2] 任工昌，胡小龍，劉朋，吳夢珂.基于ROS的冷鏈配送機器人設計[J].包裝工程，2020.41（3）：194-199

[3] 張輝，王耀南，易俊飛，鐘杭，劉理，繆志強，江一鳴.面向重大疫情應急防控的智能機器人系統研究[J].中國科學：信息科學，2020.50（7）：1069-1090

[4] 張鵬，高放，雙豐.基于ROS的全向移動機器人控制系統的設計與實現[J].組合機床與自動化加工技術，2018.7：89-92，96

[5] 胡春旭，熊梟，任慰等.基于嵌入式系統的室內移動機器人定位與導航[J].華中科技大學學報（ 自然科學版），2013.41（S1）：254-257

[6] 梁明杰，閔華清，羅榮華.基于圖優化的同時定位與地圖創建綜述[J].機器人，2013.35（4）：500-512

[7] 張軍，韋鵬，王古超.基于ROS的全向移動機器人定位導航系統研究[J].組合機床與自動化加工技術，2020.6：119-122

[8] 李建坡，時明，鐘鑫鑫.自適應蒙特卡羅無線傳感器網絡移動節點定位算法[J].吉林大學學報（工學版）， 2014.44（4）：1191-1196

[9] 郝奇.基于ROS的室內自主移動抓取機器人平臺設計與研究[D].安徽工業大學，2019.

[10] 徐建明，吳蜀魏，吳小文，張文安，俞立.基于ROS和IgHEtherCAT主站的SCARA機器人控制系統[J].高技術通訊，2019.29（9）：876-885

[11] 張占賓，李小堅.帶移動底盤的機械臂控制系統設計[J].工業控制計算機，2018.31（9）：90-91

[12] 王海玲.基于ROS視覺定位的機器人智能抓取系統研究[D].天津理工大學，2019.

收稿日期：2020-09-11

基金項目：西安市未央區科技計劃項目（201914）

作者簡介：任工昌（1962-），男，陜西西安人，博士，陜西科技大學教授、博導，主要研究方向：產品創新理論。

通訊作者：尚亞東（1995-），男，陜西漢中人，碩士，主要研究方向：圖像識別。