祝前峰?陸榮鑑?張建紅?谷雨
摘 要:智能機(jī)器人是機(jī)電一體化方向的重要研究對象,本文研究的醫(yī)療服務(wù)機(jī)器人不僅具有廣闊的應(yīng)用前景,而且對社會發(fā)展有積極的促進(jìn)作用??刂葡到y(tǒng)的設(shè)計(jì)是醫(yī)療服務(wù)機(jī)器人實(shí)現(xiàn)各模塊功能的關(guān)鍵,此次設(shè)計(jì)的醫(yī)療服務(wù)機(jī)器人控制系統(tǒng)以dsPIC33EP256MU810為核心,并分別進(jìn)行軟硬件設(shè)計(jì)。首先,結(jié)合實(shí)際情況,設(shè)計(jì)以dsPIC33EP256MU810為核心的醫(yī)療服務(wù)機(jī)器人控制板,其功能模塊包括電源模塊、電機(jī)驅(qū)動模塊、舵機(jī)模塊、循跡傳感器模塊、電子羅盤模塊、測距傳感器模塊等;其次,完成醫(yī)療服務(wù)機(jī)器人的安裝后,對傳感器的布局進(jìn)行分析與選擇,并對路徑規(guī)劃與循跡算法進(jìn)行數(shù)學(xué)分析和研究;最后,從軟件設(shè)計(jì)的角度分析醫(yī)療服務(wù)機(jī)器人控制系統(tǒng),如開發(fā)環(huán)境、開發(fā)工具、主程序的主要流程、重要模塊的初始化等。
關(guān)鍵詞:醫(yī)療服務(wù)機(jī)器人控制系統(tǒng);硬件設(shè)計(jì);軟件設(shè)計(jì);路徑算法研究
0 引言
中國版“工業(yè)4.0”規(guī)劃《中國制造 2025》指出,中國發(fā)展亟須提升信息化水平,提高與工業(yè)的融合程度,我國制造業(yè)轉(zhuǎn)型升級、創(chuàng)新發(fā)展將迎來重大機(jī)遇,為機(jī)器人技術(shù)發(fā)展提供了更廣闊的舞臺,智能化機(jī)器人的研究將成為我國產(chǎn)業(yè)建設(shè)的重要對象。[1]
我國機(jī)器人研發(fā)與應(yīng)用正處于起步階段,工業(yè)機(jī)器人仍然是在仿制,難以創(chuàng)新,缺乏核心技術(shù)與核心競爭力。雖然我國在機(jī)器人機(jī)械學(xué)的研究領(lǐng)域取得了不少重大研究成果和突破,甚至一些研究成果已經(jīng)達(dá)到或超過國際同等水平,但不得不說我們?nèi)匀徊荒芟到y(tǒng)、全面、科學(xué)地進(jìn)行機(jī)器人整機(jī)設(shè)計(jì),關(guān)鍵零部件如電機(jī)等技術(shù)十分不成熟,所以現(xiàn)在國內(nèi)大部分機(jī)器人仍然需要從國外進(jìn)口。
世界上第一臺醫(yī)療服務(wù)機(jī)器人Helpmate誕生于TRC公司,它于1990年研制成功并對外出售,目前已在世界各地的幾十家醫(yī)院投入使用。Helpmate可以獨(dú)立運(yùn)動,它不需要輔助制導(dǎo)或者提前把路徑規(guī)劃好,當(dāng)我們把循跡程序輸入機(jī)器人之后,Helpmate可以完成很多工作,例如送病歷、報表及信件,取送藥品,運(yùn)送醫(yī)療設(shè)備和器材,完成簡單的換藥工作等。
通過研究機(jī)器人相關(guān)技術(shù),學(xué)習(xí)專業(yè)課程知識,完成一套醫(yī)療服務(wù)機(jī)器人控制系統(tǒng)的設(shè)計(jì)、硬件電路的設(shè)計(jì)以及相關(guān)機(jī)械結(jié)構(gòu)的設(shè)計(jì),旨在應(yīng)用于醫(yī)療服務(wù)行業(yè),承擔(dān)沿規(guī)定路線行進(jìn)、躲避障礙物、問候病人、抓取藥物、快速運(yùn)送藥物的功用。[2]發(fā)展醫(yī)療服務(wù)機(jī)器人,在行業(yè)中實(shí)行人機(jī)并用的模式,以醫(yī)療服務(wù)機(jī)器人部分替代24小時輪班護(hù)士,可以很好地實(shí)現(xiàn)醫(yī)院人員的合理安排,減少醫(yī)護(hù)人員的工作強(qiáng)度與壓力,大大提高醫(yī)護(hù)人員的幸福感與工作效率。
1 整體結(jié)構(gòu)概述
醫(yī)療服務(wù)機(jī)器人主要應(yīng)用于醫(yī)療服務(wù)行業(yè),它所應(yīng)具有的功用包括循跡、避障、定向行駛、抓取物品、運(yùn)輸物件、語音詢問等。為實(shí)現(xiàn)以上功用,設(shè)計(jì)者需要考量其機(jī)械結(jié)構(gòu),如機(jī)械手的具體結(jié)構(gòu)、車身的選擇。機(jī)器人控制系統(tǒng)的設(shè)計(jì),各類檢測器件、傳感元件的選型,尤其是控制板的硬件設(shè)計(jì)和軟件設(shè)計(jì)更是難點(diǎn)也是重點(diǎn)。同時,合理的路徑規(guī)劃是實(shí)現(xiàn)機(jī)器人流暢行進(jìn)的難點(diǎn)與核心所在。綜合以上,為實(shí)現(xiàn)醫(yī)療服務(wù)機(jī)器人的功能,其功能模塊包括測距模塊、循跡模塊、驅(qū)動模塊、電子羅盤方向模塊。采用PWM驅(qū)動來驅(qū)動直流電機(jī),選用紅外和超聲波傳感器來測距,選用三軸帶SPI接口的傳感器電子羅盤。
2 機(jī)械部分方案
機(jī)械手是醫(yī)療服務(wù)機(jī)器人的重要機(jī)械部分,為實(shí)現(xiàn)抓取物件的功能,從自由度的角度來看,6自由度機(jī)械手以及4自由度機(jī)械手是比較常見的兩種機(jī)械手;從坐標(biāo)系的角度來看,圓柱坐標(biāo)系、直角坐標(biāo)系、球坐標(biāo)系均有應(yīng)用。[3]6自由度機(jī)械手的靈活性更強(qiáng),在工作空間內(nèi)可以以多種角度靈活抓取物件,底座上的舵機(jī)對扭矩及功率要求較高,其靈活程度超過了醫(yī)療服務(wù)機(jī)器人的所需。4自由度機(jī)械手的靈活程度滿足醫(yī)療服務(wù)機(jī)器人的需要,醫(yī)療服務(wù)機(jī)器人在高速行進(jìn)時,機(jī)械手可以向后折疊,盡量將自身重心與車體幾何中心重合,減少醫(yī)療服務(wù)機(jī)器人在行駛過程中的顛簸。
機(jī)器人的末端執(zhí)行器是一個安裝在機(jī)器人手臂上或者移動設(shè)備,使機(jī)器人能夠拿起一個對象,且具有傳輸、處理、夾持、放置和釋放目標(biāo)到準(zhǔn)確的離散位置等功用的機(jī)構(gòu)。[4]醫(yī)療服務(wù)機(jī)器人的夾取機(jī)構(gòu)是直接和目標(biāo)物件接觸的機(jī)構(gòu),夾取物件的速度以及穩(wěn)固程度直接決定了機(jī)器人完成任務(wù)情況的好壞,結(jié)構(gòu)簡潔、夾取穩(wěn)定好的夾取機(jī)構(gòu)是本醫(yī)療服務(wù)機(jī)器人的優(yōu)先選擇。
本醫(yī)療服務(wù)機(jī)器人的總體方案從自由度、抓取機(jī)構(gòu)的角度分析了多種機(jī)械手的優(yōu)劣以及適合的應(yīng)用場合,最終選取了適合本醫(yī)療服務(wù)機(jī)器人的4自由度機(jī)械手及齒輪連桿夾取機(jī)構(gòu)。
3 醫(yī)療服務(wù)機(jī)器人硬件設(shè)計(jì)
本次醫(yī)療服務(wù)機(jī)器人硬件設(shè)計(jì)包括主控芯片選型、PLC控制板單元模塊設(shè)計(jì)、驅(qū)動板模塊設(shè)計(jì)和各類檢測傳感元器件選型等。其中,控制板模塊包括電源模塊、電機(jī)驅(qū)動模塊、舵機(jī)驅(qū)動模塊、測距模塊、聲音模塊、編碼器模塊、電子羅盤模塊、循跡傳感器模塊等。醫(yī)療服務(wù)機(jī)器人的整體硬件設(shè)計(jì),分模塊對各硬件部分的設(shè)計(jì)思想、設(shè)計(jì)原理、所應(yīng)用芯片功能進(jìn)行了具體闡述,重點(diǎn)針對驅(qū)動部分,即電機(jī)驅(qū)動與舵機(jī)驅(qū)動的硬件設(shè)計(jì),為減小信號不一致造成的車體一側(cè)轉(zhuǎn)速不一的情況,最終選用兩路PWM控制的對應(yīng)電路設(shè)計(jì),應(yīng)用大電流H橋的原理并設(shè)計(jì)了電機(jī)驅(qū)動板。重點(diǎn)是對循跡傳感器的選型及布局,經(jīng)過分析,選擇安裝了三組8路數(shù)字灰度傳感器,每組灰度傳感器間隔100mm,離地高度約30mm。調(diào)試盡量使三組灰度傳感器的靈敏度保持一致,為循跡算法帶來便利。
4 路徑識別算法總概
醫(yī)療服務(wù)機(jī)器人使用灰度傳感器作為循跡模塊,灰度傳感器對地面路況的判斷主要是通過對灰度以及白度的區(qū)分。當(dāng)對管照到白時,對管輸出電壓高于給定電壓,比較器輸出為高電平,即1;當(dāng)對管照到黑的時候,此時對管輸出的電壓低于給定電壓,比較器輸出為低電平,即0?;谶@個原理,可以提出一種比較常見的路徑算法,通過I/O端口灰度傳感器輸出信號讀入單片機(jī),根據(jù)輸入單片機(jī)端口的高低電平邏輯判斷該灰度傳感器是否處于路徑標(biāo)記線上方,經(jīng)過三組灰度傳感器組的共同判斷,便可判斷此時車身偏離路徑線的程度,從而調(diào)速。[5]
5 醫(yī)療服務(wù)機(jī)器人控制系統(tǒng)軟件設(shè)計(jì)與實(shí)現(xiàn)
MPLAB? IDE軟件程序可以用于開發(fā)Microchip公司生產(chǎn)的單片機(jī)和數(shù)字信號控制器等。由于它提供了一個統(tǒng)一的集成“環(huán)境”來支持嵌入式單片機(jī)的代碼開發(fā),因此被稱為集成開發(fā)環(huán)境(IDE)。[6]從以下幾個角度說明醫(yī)療機(jī)器人控制系統(tǒng)軟件設(shè)計(jì),如開發(fā)環(huán)境、開發(fā)工具、主程序主要流程、幾個重要模塊的初始化,包括電機(jī)驅(qū)動模塊、語音及撥碼盤模塊、循跡模塊、舵機(jī)模塊等,對其中的重要配置參數(shù)。
6 結(jié)語
當(dāng)下,智能機(jī)器人是機(jī)電一體化方向的重要研究對象,本文所研究的醫(yī)療服務(wù)機(jī)器人不僅具有廣闊的應(yīng)用前景,而且對社會發(fā)展有積極的促進(jìn)作用。本醫(yī)療服務(wù)機(jī)器人選用的主芯為Microchip公司的dsPIC33EP256MU810,3.3V供電保證芯片功耗較小,改進(jìn)型哈佛結(jié)構(gòu)使其運(yùn)行速度快、集成度高,[7]醫(yī)療服務(wù)機(jī)器人對運(yùn)動控制的要求基本可以得到滿足,同時高速高性能MCU及CPU為復(fù)雜的控制算法、軌跡控制提供了硬件保證。
參考文獻(xiàn):
[1] 華豪.工業(yè)企業(yè)信息化的理論及實(shí)踐探索[D].南京理工大學(xué),2014.
[2] 魏瑋,吳冠杰.嵌入式單目機(jī)器人視覺檢測及避障系統(tǒng)設(shè)計(jì)[J].計(jì)算機(jī)測量與控制,2014(11):3487-3489.
[3] 鄭雪林.基于視覺伺服的仿人機(jī)器人智能抓取技術(shù)研究[D].東北大學(xué),2013.
[4] Ethem Toklu,F(xiàn)ehmi Erzincanli . Investigation of flow and vacuum lifting forcea non-contact on end effector for robotic handling of non-rigid material[J]. Scientific Researchand Essays,2011(29):6152-6161.
[5] M.Beauvais,C. Kreueher, S.Lakshmanan . Building world models for mobile Platforms using hetergenerous sensors fusion and temporal analysis[J]. In The IEEE Intelligent Transportation System97 Symposium,2005,12(6):230-235.
[6] Thomas Kibalo . Beginners Guide to Programming the PIC24/dsPIC33: Using the Microstick and Microchip C Compiler for PIC24 and[M]. CreateSpace Independent Publishing Plat,2014.
[7] 倪福銀.基于DSP的智能遙控小車設(shè)計(jì)[J].計(jì)算機(jī)技術(shù)與發(fā)展,2012(03):207-209+213.
作者簡介:祝前峰(1996—),男,研究生在讀,主要從事機(jī)電一體化、嵌入式系統(tǒng)方向的研究。
通訊作者:陸榮鑑(1964—),男,研究生,講師,主要從事機(jī)電一體化、工業(yè)控制系統(tǒng)方向的研究。