張泓,王凌云,曾小峰,申龍章,(通訊作者)
(1.南華大學(xué)電氣工程學(xué)院,湖南衡陽,421000;2.南華大學(xué)機(jī)械工程學(xué)院,湖南衡陽,421000)
跟隨智能化發(fā)展的步伐,醫(yī)用機(jī)器人開始興起,并逐漸成為機(jī)器人行業(yè)的新發(fā)展方向,醫(yī)用機(jī)器人的面世對醫(yī)療衛(wèi)生領(lǐng)域產(chǎn)生了深遠(yuǎn)的影響。近年來,人口老齡化形勢加劇,但得益于醫(yī)療保障體系的不斷完善,醫(yī)療行業(yè)迸發(fā)出前所未有的活力,醫(yī)用機(jī)器人自然成為了該行業(yè)的香餑餑。根據(jù)供求關(guān)系理論可知,醫(yī)用機(jī)器人具有廣闊的市場前景。
醫(yī)用機(jī)器人的類型頗多,可應(yīng)用于配送、臨床醫(yī)療、護(hù)理、醫(yī)用教學(xué)、康復(fù)、消毒等方面,其豐富的用途帶給了醫(yī)療衛(wèi)生領(lǐng)域難以想象的改變[1-2],但“九層之臺,起于累土”,多功能的實(shí)現(xiàn)是從基礎(chǔ)控制系統(tǒng)開始的。因此,研究針對醫(yī)用機(jī)器人的自行走及導(dǎo)航定位控制顯得尤為重要。
對于醫(yī)用機(jī)器人行走智能化的研究,需充分考慮醫(yī)院的環(huán)境條件和基本要求。醫(yī)院大多處于平坦路面,存在大量病人行走,要求醫(yī)用機(jī)器人體積不能大,且能響應(yīng)迅速、全向避障;醫(yī)務(wù)人員工作繁忙,需要醫(yī)用機(jī)器人智能化程度高,能自主完成任務(wù);醫(yī)院容錯率幾乎為零,對醫(yī)用機(jī)器人的嚴(yán)謹(jǐn)性要求非常高。根據(jù)以上要求,本文以消毒機(jī)器人為例進(jìn)行研究,由此可舉一反三。
傳統(tǒng)的消毒方式主要靠人工消毒,隨意性強(qiáng)、效率不高、效果不佳,存在消毒者自身感染風(fēng)險。
隨著科技發(fā)展,消毒機(jī)器人憑著多種優(yōu)點(diǎn)開始嶄露頭角,但僅限于小范圍發(fā)展。直到新型冠狀病毒肺炎(COVID-19)席卷全球,消毒機(jī)器人正式從機(jī)器人行業(yè)中脫穎而出,充當(dāng)了公共衛(wèi)生安全守護(hù)者的形象,逐漸成為抗疫不可或缺的一員。
針對醫(yī)院而言,醫(yī)用消毒機(jī)器人既可減少醫(yī)護(hù)人員職業(yè)暴露風(fēng)險,又可避免感染傳播。其不分晝夜,可隨時消毒清潔,相比人工而言效率更高。在抗疫前線,消毒機(jī)器人的使用更是大大的減少了防護(hù)物資的消耗。從長遠(yuǎn)來看,醫(yī)用消毒機(jī)器人提高了效率,減少了人工成本,使醫(yī)院有更多的時間與資源投入到醫(yī)療事業(yè)。
縱觀行業(yè)內(nèi)醫(yī)用消毒機(jī)器人產(chǎn)品現(xiàn)狀,無論是國內(nèi)還是國際上,大多都擁有著集成各種模塊的自主行走、定位導(dǎo)航控制系統(tǒng),功能強(qiáng)大,在實(shí)際應(yīng)用中各有特色和優(yōu)勢。
上海擎朗智能科技有限公司發(fā)布的消毒機(jī)器人M2,如圖1(a)所示,其擁有全自主定位導(dǎo)航,能智能避障、自主乘坐電梯,提供跨樓層消毒防疫服務(wù)。
圖1 消毒機(jī)器人
成都神識高科技有限公司發(fā)布的防疫消毒機(jī)器人,如圖1(b)所示,這款產(chǎn)品擁有履帶底盤,地形適應(yīng)性高,可自主導(dǎo)航進(jìn)行消毒作業(yè)。
創(chuàng)澤智能機(jī)器人集團(tuán)股份有限公司發(fā)布的霧化機(jī)器人YCZ-2020,圖1(c)所示。這款產(chǎn)品搭載攝像頭、超聲波雷達(dá)等設(shè)備,具有自主行走、自主移動式多點(diǎn)消毒等功能。以及紫外線等離子消毒機(jī)器人CZ-RobotDF-DZ,圖1(d)所示。這款機(jī)器人能夠根據(jù)設(shè)定的路線自主移動,滿足在復(fù)雜室內(nèi)環(huán)境下自動、定時、精準(zhǔn)的消毒需求。
丹麥機(jī)器人公司BlueOcean Robotics制造的一款UVD機(jī)器人也可實(shí)現(xiàn)病房自主移動,強(qiáng)力消毒。
對于現(xiàn)有醫(yī)用消毒機(jī)器人而言,基本是按特定路線行駛,通過各種導(dǎo)航定位方法進(jìn)行消毒作業(yè),配合攝像頭和雷達(dá)等設(shè)備實(shí)現(xiàn)避障。基于以上背景,研究一種行走智能化控制系統(tǒng)設(shè)計,該控制系統(tǒng)涉及無線寬帶(WiFi)定位技術(shù)、超聲波雷達(dá)技術(shù)和軌跡跟蹤技術(shù),可全自主導(dǎo)航定位,瞬時反應(yīng),全向避障,外加溫度傳感器,對室溫進(jìn)行及時反饋。
為實(shí)現(xiàn)消毒機(jī)器人的行走智能化,需要消毒機(jī)器人具有一定精度的導(dǎo)航定位能力,然后按指定路線到達(dá)指定消毒區(qū)域,若行進(jìn)路線存在障礙物,則檢測繞過障礙物,到達(dá)后,消毒機(jī)器人開始消毒,流程圖如圖2所示。其主要靠以下幾個模塊來實(shí)現(xiàn)。
圖2 行走智能化系統(tǒng)流程圖
行走機(jī)構(gòu)作為自行走機(jī)器人的硬件部分,在控制系統(tǒng)中起著執(zhí)行作用。行走機(jī)構(gòu)根據(jù)其結(jié)構(gòu)可分為車輪式、履帶式、步行式等。
車輪式行走機(jī)構(gòu)應(yīng)用最為廣泛,因其結(jié)構(gòu)簡單、功率消耗小、移動時較穩(wěn)定,但缺點(diǎn)是遇到復(fù)雜環(huán)境適應(yīng)性不強(qiáng)。面對存在的不足,可通過結(jié)構(gòu)設(shè)計加強(qiáng)其性能,如行星輪式行走機(jī)構(gòu),提高了通過性能,使其越障能力得到加強(qiáng)[3]。
履帶式行走機(jī)構(gòu)的機(jī)器人不易打滑,可行走在泥土路面,具有通過性好、適應(yīng)性好等優(yōu)點(diǎn),但轉(zhuǎn)向不便、行走緩慢,存在功率消耗大的問題。可以結(jié)合前兩種機(jī)構(gòu)的特點(diǎn)以提高其性能,如輪履式機(jī)構(gòu),在不同環(huán)境可切換輪履模式,使其適應(yīng)性相較于單獨(dú)的車輪式和履帶式更強(qiáng)[4]。
步行式機(jī)構(gòu)有兩足、三足、四足、八足等形式,類似于動物行走。采用步行機(jī)構(gòu)的步行機(jī)器人,能夠在不規(guī)則地形運(yùn)動,其穩(wěn)定性好,但控制上難度很大。
步行式機(jī)構(gòu)因其控制難度大,不予采用;履帶式機(jī)構(gòu)雖適應(yīng)性好,但行動緩慢,存在噪聲,不適合醫(yī)院安靜的環(huán)境;故系統(tǒng)的行走機(jī)構(gòu)采用三個輪子的車輪式機(jī)構(gòu),電機(jī)驅(qū)動器控制輪轂電機(jī)車輪并與萬向輪配合,自動行走、轉(zhuǎn)向。
本醫(yī)用消毒機(jī)器人包括移動平臺和半開式箱體結(jié)構(gòu),移動平臺包括內(nèi)部骨架和內(nèi)設(shè)裝置,其內(nèi)部骨架分為底板、中間板和頂板。所述底板下方設(shè)置有底盤機(jī)構(gòu)、電池以及電機(jī)驅(qū)動器。所述底板之上設(shè)置有工控主板和開關(guān)裝置;所述中間板上設(shè)置有超聲波雷達(dá)組件、溫度傳感器和攝像頭;箱體位于移動平臺頂板上,其內(nèi)部裝有無線定位WiFi設(shè)備與消毒設(shè)備。
現(xiàn)如今最常用的定位技術(shù)是GPS定位,但由于GPS定位信號在醫(yī)院內(nèi)部易受到障礙物遮擋,所以該行走智能化系統(tǒng)配備無線寬帶(WiFi)定位。這種定位方法滿足醫(yī)用消毒機(jī)器人定位導(dǎo)航的要求,且成本低廉。
系統(tǒng)采用基于位置指紋的算法作為WiFi定位的選擇。位置指紋法顧名思義就是對空間位置劃分坐標(biāo),貼上標(biāo)簽,其獨(dú)有的位置特征被用作位置指紋,并組建指紋庫。在得到這些特征后,通過算法得到較為精準(zhǔn)的位置[5]。
基于位置指紋的定位通常分為兩種類型。一種是基于概率性的算法,通過條件概率建立模型,通過算法推算信號特征屬于指紋庫中某個分布的可能性。該算法定位精度高,但實(shí)現(xiàn)起來較復(fù)雜。
另一種是確定型算法,將信號特征與存在指紋庫中的統(tǒng)計值相比較。指紋庫里找到與RSS(接收信號強(qiáng)度值)觀測值的歐氏距離最近的指紋,將其所對應(yīng)的位置坐標(biāo)作為待測目標(biāo)的位置。該算法精度一般,但簡便易用。
消毒機(jī)器人自行走及導(dǎo)航定位系統(tǒng)無須定位精度過高,只需要能夠迅速定位,所以采用確定型算法。此定位方法同時與雷達(dá)、攝像頭配合,可有效定位導(dǎo)航,實(shí)現(xiàn)迅速避障。
軌跡跟蹤控制是行走智能化系統(tǒng)的重要組成部分。因?yàn)闄C(jī)器人的軌跡跟蹤屬于一種耦合的非線性系統(tǒng),不滿足Brockett鎮(zhèn)定的必要條件,因此控制方法應(yīng)采用自適應(yīng)控制、滑??刂啤⒒蛘咚鼈兊慕M合控制?,F(xiàn)有的模型控制中大多采用滑模控制,因其響應(yīng)迅速,瞬態(tài)性能良好大,但其也存在抖振等不利影響。
參照現(xiàn)有的多種模型軌跡跟蹤控制:一種是通過含積分項的sigmoid滑模切換函數(shù),構(gòu)建由等效控制和切換控制的自適應(yīng)滑??刂破?,具有較好的控制精度[6];一種是基于線性矩陣不等式的魯棒模型預(yù)測軌跡跟蹤控制器,加入基于期望軌跡曲率的前饋控制,有效提高了跟蹤穩(wěn)定性,增強(qiáng)了系統(tǒng)魯棒性[7];一種是基于數(shù)據(jù)驅(qū)動的高階迭代學(xué)習(xí)控制算法,利用之前迭代的輸入信息設(shè)計高階學(xué)習(xí)律,提高了控制性能,提高了控制模型的魯棒性[8];一種是基于切換增益調(diào)節(jié)的神經(jīng)滑??刂疲行У販p輕了抖振,減少了跟蹤誤差,但神經(jīng)算法相對復(fù)雜[9];還有一種基于變增益趨近律的位置速度級聯(lián)滑??刂品椒ǎ没?刂频目焖傩院蛷?qiáng)魯棒性來提升系統(tǒng)的控制性能[10]。
作為醫(yī)用消毒機(jī)器人,需要精度合適,魯棒性強(qiáng),算法簡便的控制方法。綜合比較,本文采用級聯(lián)滑??刂破?,基于有限時間控制理論設(shè)計一種控制律,以提高跟蹤精度。
本文通過對消毒機(jī)器人行走智能化的研究,以小見大地展現(xiàn)了醫(yī)用機(jī)器人自行走及導(dǎo)航定位的控制要求。醫(yī)用機(jī)器人對定位導(dǎo)航精度,避障的及時響應(yīng)度和機(jī)構(gòu)的合理度都有較高要求??刹捎没赪iFi定位,結(jié)合攝像頭和超聲波雷達(dá)的行走智能化控制系統(tǒng),并利用級聯(lián)滑??刂铺岣吒櫨群涂刂葡到y(tǒng)的可靠性。這款醫(yī)用消毒機(jī)器人能通過軌跡跟蹤實(shí)現(xiàn)按規(guī)劃路線行駛的目的,且能實(shí)現(xiàn)迅速反應(yīng),全向避障,可通過溫度傳感器檢測室溫。后續(xù)可增加其他功能模塊,以實(shí)現(xiàn)醫(yī)用消毒機(jī)器人的多用途。