《電子技術(shù)應(yīng)用》
您所在的位置:首頁 > 通信與網(wǎng)絡(luò) > 設(shè)計應(yīng)用 > 清掃機(jī)器人自主充電系統(tǒng)的設(shè)計
清掃機(jī)器人自主充電系統(tǒng)的設(shè)計
2015年微型機(jī)與應(yīng)用第22期
李 進(jìn)
(無錫科技職業(yè)學(xué)院,江蘇 無錫 214028)
摘要: 在設(shè)計了充電站的硬件電路(包括電源電路,、可由軟件及硬件調(diào)節(jié)充電電流的電池恒流充電電路及定位編碼信號發(fā)射電路)的基礎(chǔ)上,,提出了一種機(jī)器人采用隨機(jī)行走模式在未知環(huán)境下自動找尋充電站的全新自主充電算法,使機(jī)器人具備自主找尋充電站充電的能力,。
Abstract:
Key words :

  摘  要: 在設(shè)計了充電站的硬件電路(包括電源電路,、可由軟件及硬件調(diào)節(jié)充電電流的電池恒流充電電路及定位編碼信號發(fā)射電路)的基礎(chǔ)上,提出了一種機(jī)器人采用隨機(jī)行走模式在未知環(huán)境下自動找尋充電站的全新自主充電算法,,使機(jī)器人具備自主找尋充電站充電的能力,。

  關(guān)鍵詞清掃機(jī)器人恒流源,;自主充電算法,;智能

0 引言

  自主清潔機(jī)器人作為服務(wù)機(jī)器人的一種,能夠使人們從繁重的清潔工作中解脫出來,,具有廣泛的應(yīng)用前景,。目前清潔機(jī)器人已經(jīng)進(jìn)入實際家庭使用,如伊萊克斯公司的“三葉蟲”,、Kent公司設(shè)計出清掃機(jī)器人RoboKent,、國產(chǎn)清掃機(jī)器人KV8。當(dāng)機(jī)器人電量不足時,,能夠自動地返回充電站進(jìn)行充電是現(xiàn)有機(jī)器人的一個實用功能,,根據(jù)家居智能清潔機(jī)器人的自動充電功能需求,與蘇州某公司合作開發(fā)設(shè)計了一款低成本,、能自主充電的適用型家居智能機(jī)器人,,目前已投入生產(chǎn),,效果良好。

1 充電站硬件設(shè)計

  充電站主要負(fù)責(zé)與機(jī)器人的紅外通信,,發(fā)射召回信號,,引導(dǎo)機(jī)器人自動返回充電站進(jìn)行充電。機(jī)器人在電量充足時對充電站發(fā)出的信號不做響應(yīng),,當(dāng)檢測到自身電量不足時,,機(jī)器人通過充電站發(fā)射的紅外召回信號及相應(yīng)算法自動返回充電站充電。

  1.1 充電站結(jié)構(gòu)

  機(jī)器人在電池電量不足時能夠在消耗最少電量情況下以較短路徑自主返回充電站,,是其能夠長期高效率自主工作的重要環(huán)節(jié),。為了保證機(jī)器人自主返回充電,充電站的結(jié)構(gòu)和電氣設(shè)計必須滿足要求,,充電站外形如圖1所示,。

001.jpg

  充電站包括外殼、兩片充電觸點,、電源指示燈,、上對接紅外發(fā)射器和下對接紅外發(fā)射器[1]。在清潔機(jī)器人底部有正負(fù)兩個金屬充電電極,,在充電站上有兩片金屬觸點,,當(dāng)充電電極與金屬片接觸上即可進(jìn)行充電。清掃機(jī)器人前端中間位置裝有兩個紅外接收管,,它們之間的夾角為45°,,清掃機(jī)器人前端頂部也裝有一個紅外接收管,并在其上方安裝了光學(xué)全反射元件,,即廣角接收,,使得清掃機(jī)器人能夠在360°的有效范圍內(nèi)都能接收到來自充電站的信號。

  1.2 充電站工作原理

  充電站的上,、下兩組發(fā)射器均發(fā)出紅外調(diào)制編碼信號,,供機(jī)器人尋找充電站時定位使用。自主返回充電的基本要求就是精確對準(zhǔn),,以便機(jī)器人的充電電極和充電站上的充電觸點可靠連接進(jìn)行充電,。由于紅外發(fā)射管的信號區(qū)域接近于一個扇形,難以實現(xiàn)機(jī)器人和充電站的精確對接,,因此本設(shè)計在紅外發(fā)射管前方添加黑色塑料擋光片,,擋光片之間留一個窄縫,這樣發(fā)射信號區(qū)域幾乎成一條直線,,其有效距離約為4 m,,寬度為0.1~0.3 m。這樣,清掃機(jī)器人尋找充電站的活動區(qū)域便分為兩個部分,,有信號區(qū)和無信號區(qū),。有信號區(qū)是一個狹長的區(qū)域,長度約為4 m,,寬度為0.1~0.3 m,。這個區(qū)域外為無信號區(qū)。信號覆蓋示意圖如圖2所示,。

002.jpg

  1.3 充電站硬件電路設(shè)計

  1.3.1 電池恒流充電電路設(shè)計

  由于機(jī)器人所使用的電池為14.4 V直流鎳氫電池,,采用恒流方式進(jìn)行充電,為此需要設(shè)計充電所需的恒流源電路,,為電池充電時提供穩(wěn)定的充電電流[2-4],。

003.jpg

  恒流源電路如圖3所示。電路采用兩級運放,,第一級運放組成一個電壓跟隨器,,提高整個電源的輸入阻抗,C1,、C2組成π型濾波,驅(qū)除干擾信號,。第二級電路組成電流負(fù)反饋,,提高恒流輸出電流的穩(wěn)定性。

  第一級運放的輸出電壓:U01=UIN,。

  第二級運放引入電流負(fù)反饋,,所以同相端和反相端輸入電流為0,因此同相端U+由R3,、R4兩個電阻對U01分壓得到:IW~)HAH]7AKDM7}LRO7F9D1.png

  運算放大器U2同相端電壓U+等于反相端電壓U-,,因此O3O2MH_W1U1@5D97UJVW(%3.png,R5的電流I5=7)P)E5X[A`XXL2ZYQ)`]9QS.png,,由于U2反相端輸入電流為0,,因此TIP122發(fā)射極電流Ie=I5,又由于Ic≈Ie,,因此恒流源電路的輸出電流為:

  $V_Z)G8RHKT9N[E6P9Z)1SR.png

  由此可見,,電源的輸出電流與UIN成正比,且與R3,、R4,、R5 3個電阻成正比,當(dāng)UIN和電阻的比例系數(shù)保持恒定時,,即可保證該電源的輸出電流是恒定的,。用戶既可通過調(diào)節(jié)選擇電池的充電電流,也可以采用軟件PWM信號對UIN進(jìn)行無級調(diào)節(jié),從而選擇所需的充電電流,。

  1.3.2 電源電路設(shè)計

  電源電路將220 V交流電經(jīng)過變壓,、橋式整流、電容濾波以及穩(wěn)壓4步,,最后得到系統(tǒng)所需的直流電源,,電路如圖4所示。

004.jpg

  由于上述恒流源電路中的運算放大器U1和U2采用+12 V電源供電,,電池所需的直流電壓為24 V,,同時考慮到TIP122以及R5的壓降,因此負(fù)載所需的電壓設(shè)計為36 V(此電壓可根據(jù)具體要求進(jìn)行調(diào)節(jié)),。所以電源電路采用7824進(jìn)行分壓以及擴(kuò)壓得到系統(tǒng)所需的12 V和36 V電壓,。圖4中R1取1 k,R2取0.5 k,,VOUT1=24×(1+0.5)=36 V,,VOUT2=24×0.5=12 V,濾波電容C越大越好,,此處取4 700 μF,,C1和C2取典型值,分別為0.33 μF和0.1 μF,。

005.jpg

  系統(tǒng)控制部分采用直流5 V電源供電,,采用三端穩(wěn)壓芯片78L05,如圖5所示,。其中C6,、C7、C8為濾波電容[5],。

  1.3.3 充電站定位編碼信號發(fā)射電路設(shè)計

  充電站采用發(fā)射紅外信號的方式引導(dǎo)機(jī)器人自動返回充電站,,充電站的上、下兩組發(fā)射器均發(fā)出紅外信號,,為防止充電站發(fā)出的紅外信號受到陽光,、電燈等其他因素的干擾,充電站發(fā)射的紅外信號采用調(diào)制波進(jìn)行編碼,,機(jī)器人在收到紅外信號并解調(diào)后,,如編碼與充電站發(fā)射一致,則執(zhí)行自動充電程序,,否則不做處理,。

006.jpg

  圖6中D1、D2為紅外發(fā)射二極管,,R1,、R2,、R3、R4為限流電阻,,用以保證紅外發(fā)射管工作在允許工作電流內(nèi),,載波信號由單片機(jī)產(chǎn)生,經(jīng)電阻R6與三極管Q1相連,,編碼信號由單片機(jī)產(chǎn)生,,一路經(jīng)電阻R7與三極管Q2相連,另一路經(jīng)電阻R8與三極管Q3相連,,采用24 V作為發(fā)射電壓,。

2 自主充電算法

  清掃機(jī)器人自動返回充電時采用隨機(jī)行走模式,只要充電站正前方的信號區(qū)內(nèi)沒有物體遮擋,,清掃機(jī)器人總會經(jīng)過有信號區(qū),。

  充電算法主要分為以下4步:

  (1)找尋充電站算法

  清掃機(jī)器人采用隨機(jī)行走的方式找尋充電站,,途中若遇到障礙物則執(zhí)行避障算法,。清掃機(jī)器人隨機(jī)行走時,只要上部廣角接收管收到充電站發(fā)出的信號,,則認(rèn)為已找到充電站,,進(jìn)入對接算法程序。

 ?。?)對接算法[6]

  在找到充電站后,,根據(jù)不同情況執(zhí)行對接算法。

  上部廣角接收管收到信號,,機(jī)器繼續(xù)前行0.1 m,右轉(zhuǎn),,若右轉(zhuǎn)過程中前方中間兩個接收管均收到充電站信號,,則認(rèn)為已與充電站對準(zhǔn),機(jī)器直行,,并進(jìn)入精確對接算法,;若右轉(zhuǎn)400°后,前方兩個接收管不滿足同時收到信號的條件,,則認(rèn)為機(jī)器處于信號邊界區(qū)域,,進(jìn)入調(diào)整方向算法;若前方兩個接收管均未收到充電站信號,,則認(rèn)為是誤信號,,則后退一段距離,繼續(xù)直行,,執(zhí)行找尋充電站算法,。

 ?。?)調(diào)整方向算法

  調(diào)整方向算法:前方兩個接收管不滿足同時收到信號的條件,則認(rèn)為機(jī)器處于信號邊界區(qū)域,,此時讓機(jī)器右轉(zhuǎn),,右轉(zhuǎn)過程中,若上部廣角接收管收到信號,,則機(jī)器繼續(xù)前行0.1 m,,再右轉(zhuǎn),若右轉(zhuǎn)過程中前方中間兩個接收管均收到充電站信號,,則認(rèn)為已與充電站對準(zhǔn),,機(jī)器直行,并進(jìn)入精確對接算法,;若右旋轉(zhuǎn)400°后,,前方兩個接收管還不滿足同時收到信號的條件,則認(rèn)為機(jī)器處于信號左邊界,,此時讓機(jī)器后退0.1 m,,左轉(zhuǎn),左轉(zhuǎn)過程中,,若上部廣角接收管收到信號,,則讓機(jī)器直行0.1 m,再左轉(zhuǎn),,若左轉(zhuǎn)過程中前方中間兩個接收管均收到充電站信號,,則認(rèn)為已與充電站對準(zhǔn),機(jī)器直行,,進(jìn)入精確對接算法,;若左轉(zhuǎn)400°后,前方兩個接收管仍不滿足同時收到信號的條件,,則機(jī)器直行,,退出調(diào)整方向算法,進(jìn)入找尋充電站算法,。

 ?。?)精確對接算法

  當(dāng)清掃機(jī)器人中間兩個接收管均收到信號時,則認(rèn)為已與充電站對準(zhǔn),,機(jī)器保持直行,。但實際運行過程中,由于地面情況不同或是電機(jī)轉(zhuǎn)速的微小偏差,,有可能會使機(jī)器在直行過程中發(fā)生偏離,,為此采用精確對接算法進(jìn)行修正。

 ?、偃魧舆^程中中間兩個接收管的狀態(tài)為左接收管接收到信號,,右接收管無信號,,則認(rèn)為機(jī)器向右偏離中心區(qū)域,此時機(jī)器人左轉(zhuǎn),,若中間兩個接收管均收到信號,,則直行,若仍然是左接收管接收到信號,,右接收管無信號,,則機(jī)器后退0.1 m,左轉(zhuǎn),,直至中間兩個接收管均收到信號后,,直行。

 ?、谌魧舆^程中中間兩個接收管的狀態(tài)為右接收管接收到信號,,左接收管無信號,則認(rèn)為機(jī)器向左偏離中心區(qū)域,,此時機(jī)器人右轉(zhuǎn),,若中間兩個接收管均收到信號,則直行,,若仍然是右接收管接收到信號,,左接收管無信號,則機(jī)器后退0.1 m,,左轉(zhuǎn),,直至中間兩個接收管均收到信號后,直行,。

 ?、廴魧舆^程中中間兩個接收管的狀態(tài)為左、右均無信號,,則機(jī)器在原地停留2 s,,若停留時間內(nèi)收到充電站信號,則執(zhí)行相應(yīng)算法,,若2 s后仍無信號,則繼續(xù)直行,,執(zhí)行找尋充電站算法,。

  (5)異常情況處理算法

  清掃機(jī)器人在與充電站對接時,,突遇障礙物,,此時清掃機(jī)器人終止對接算法,執(zhí)行避障算法繞過障礙物后,,繼續(xù)尋找充電站,。

  綜述自主充電算法步驟:首先機(jī)器人根據(jù)上部廣角接收管是否收到信號尋找充電站進(jìn)入信號區(qū)域,,然后做出相應(yīng)調(diào)整使機(jī)器人對準(zhǔn)充電站直行,最后直行過程中根據(jù)中間位置夾角為45°的左和右兩個接收器的信號修正和微調(diào)機(jī)器人的路線,,實現(xiàn)精確對準(zhǔn),,直到碰到充電站,算法結(jié)束,。自主充電算法流程圖如圖7所示,。

007.jpg

3 結(jié)論

  經(jīng)實踐證明,該機(jī)器人完全滿足自動返回充電功能要求,;具有良好的人機(jī)交互功能,,滿足了產(chǎn)品設(shè)計要求,只是在找尋充電器的效率方面有待提高,。

參考文獻(xiàn)

  [1] 季國棟,,王文理.蓄電池剩余容量檢測系統(tǒng)設(shè)計[J].微型機(jī)與應(yīng)用,2015,,34(3):38-40.

  [2] 林丹.一種室內(nèi)清潔機(jī)器人返回路徑規(guī)劃算法[J].重慶科技學(xué)院學(xué)報,,2010,2(1):110-113.

  [3] 沈玉,,韓廷,,武驥,等.一種電動汽車動力電池電流檢測系統(tǒng)的設(shè)計[J].電子技術(shù)應(yīng)用,,2014,,40(7):69-71.

  [4] 梁喜鳳,室內(nèi)地面清潔機(jī)器人路徑規(guī)劃[J].中國計量學(xué)院學(xué)報,,2006,,17(1):64-66.

  [5] 禹建麗,徐亮.室內(nèi)自主清掃機(jī)器人的路徑規(guī)劃[J].中原工學(xué)院學(xué)報,,2010,,21(3):25-30.

  [6] 王三武,劉進(jìn).清掃機(jī)器人移動驅(qū)動機(jī)構(gòu)的研究[J]機(jī)械制造與自動化,,2008,,37(5):89-95.


此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權(quán)禁止轉(zhuǎn)載,。