本實(shí)用新型涉及清掃機(jī)器人領(lǐng)域，特別涉及一種太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)。

背景技術(shù)：

在化石燃料日趨減少的情況下，作為一種新興的可再生能源的太陽能已成為人類使用能源的重要組成部分，近十年來，太陽能應(yīng)用技術(shù)在世界各國(guó)都得到迅猛發(fā)展。太陽能面板是指利用半導(dǎo)體材料在光照條件下發(fā)生的光生伏特效應(yīng)(photovoltaic)將太陽能直接轉(zhuǎn)換為電能的器件。有太陽光的地方就能發(fā)電，因此太陽能面板適用于從大型發(fā)電站到小型便攜式充電器等多種場(chǎng)合，近年來得到飛速發(fā)展。

太陽能面板的工作環(huán)境只能是戶外，影響其工作的最大問題并不是風(fēng)雨雷電，而是常年累積的灰塵。太陽能面板上附著有灰塵或其它附著物，會(huì)影響面板板的透光率，阻礙光電效率，從而會(huì)嚴(yán)重影響面板直接獲取陽光的效率，降低面板的能量吸收和轉(zhuǎn)換效率，降低發(fā)電效率?，F(xiàn)有技術(shù)的太陽能面板在使用中只能依靠人工定期完成清理工作，由于太陽能面板面積較大、大型電站同時(shí)使用的面板較多，而灰塵會(huì)反復(fù)累積，需要反復(fù)清洗；因此人力成本很高、清理效率低、清理效果較差。在很多場(chǎng)合，為了提高空間利用率，太陽能面板都是利用支架設(shè)置在高處，這就給清理工作帶來更大的難度和風(fēng)險(xiǎn)。很多太陽能面板的用戶為了降低清理成本只能選擇不清理，這樣只能被迫承擔(dān)灰塵導(dǎo)致的電能損耗。這樣，就需要有一個(gè)新的自動(dòng)清理設(shè)備，對(duì)太陽能面板進(jìn)行自動(dòng)清理。

現(xiàn)有技術(shù)的清掃機(jī)器人一般都只能應(yīng)用于水平地面上，不能適用于太陽能面板這樣的斜坡平面。如果將現(xiàn)有的清掃機(jī)器人直接用在太陽能面板上，會(huì)導(dǎo)致以下問題。

（1）清掃機(jī)器人動(dòng)力不足、不能自由行進(jìn)、清掃效果差；由于太陽能面板的傾斜角度一般在10度~40度之間，現(xiàn)有清掃機(jī)器人在斜坡平面上不能自由行進(jìn)，即使能勉強(qiáng)行進(jìn)，很快就會(huì)將電量耗盡。

（2）清掃機(jī)器人會(huì)從太陽能面板上滑落；由于太陽能面板比較光滑，現(xiàn)有清掃機(jī)器人重量和車輪摩擦系數(shù)都比較小，摩擦力也比較小，行進(jìn)困難，很容易滑落。

（3）清掃機(jī)器人不能按照規(guī)定路線行駛，行進(jìn)中覆蓋面積小，會(huì)從太陽能面板邊緣處落下；現(xiàn)有清掃機(jī)器人一般是設(shè)置為遇到障礙物自動(dòng)轉(zhuǎn)向，由于太陽能面板上沒有任何障礙物，自動(dòng)行駛的清掃機(jī)器人只能在單一路徑上行進(jìn)，其行進(jìn)過程中的覆蓋面積小，必然會(huì)從太陽能面板邊緣處落下。即使預(yù)先規(guī)劃好路徑，現(xiàn)有的清掃機(jī)器人在行進(jìn)中容易受到重力及面板附著物的影響，也會(huì)很容易偏離路徑，很難保證直線行駛；而且清掃機(jī)器人自身無法察覺，不能走遍整個(gè)面板，會(huì)留下大量清掃不到的空間。

（4）清掃機(jī)器人充電困難；由于太陽能面板高度比較高、面積較大，一旦將清掃機(jī)器人送上去之后，將其取下會(huì)比較困難，現(xiàn)有技術(shù)需要人工將清掃機(jī)器人搬離現(xiàn)場(chǎng)或人工取出電池，繼而對(duì)其進(jìn)行充電，從而不能長(zhǎng)時(shí)間持續(xù)進(jìn)行現(xiàn)場(chǎng)作業(yè)，而且由于很多太陽能面板都是用支架設(shè)置在高處，因此其充電操作非常麻煩，浪費(fèi)大量人力。

（5）清掃機(jī)器人工作狀態(tài)監(jiān)控困難，由于太陽能面板可能會(huì)設(shè)置在高處，地面上的工作人員無法對(duì)其工作過程做到全程監(jiān)控，即使清掃機(jī)器人發(fā)生故障，停止運(yùn)行或者路線走偏，工作人員也無法及時(shí)得知。

技術(shù)實(shí)現(xiàn)要素：

本實(shí)用新型的目的在于，提供一種太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)，以解決現(xiàn)有清掃機(jī)器人存在的控制困難、動(dòng)力不足、不能自由行進(jìn)、易滑落等技術(shù)問題。

為解決上述問題，本實(shí)用新型提供一種太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)，包括一車體、一左前輪、一右前輪、一左驅(qū)動(dòng)電機(jī)以及一右驅(qū)動(dòng)電機(jī)。所述車體在至少一太陽能面板上行駛或駐留；所述左前輪安裝在所述車體底面前部的左側(cè)，包括一左前輪轂及一左前輪軸，所述左前輪軸設(shè)置于所述左前輪轂中心處；所述右前輪安裝在所述車體面前部的右側(cè)，包括一右前輪轂及一右前輪軸，所述右前輪軸設(shè)置于所述右前輪轂中心處；所述左驅(qū)動(dòng)電機(jī)安裝在所述車體底部，包括一左驅(qū)動(dòng)轉(zhuǎn)軸，連接至所述左前輪軸，用以控制所述左前輪的轉(zhuǎn)速和旋轉(zhuǎn)方向；所述右驅(qū)動(dòng)電機(jī)安裝在所述車體底部，包括一右驅(qū)動(dòng)轉(zhuǎn)軸，連接至所述右前輪軸，用以控制所述右前輪的轉(zhuǎn)速和旋轉(zhuǎn)方向。

進(jìn)一步地，所述太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)還包括一控制系統(tǒng)，分別連接至所述左驅(qū)動(dòng)電機(jī)、所述右驅(qū)動(dòng)電機(jī)，所述控制系統(tǒng)向所述左驅(qū)動(dòng)電機(jī)、所述右驅(qū)動(dòng)電機(jī)發(fā)送至少一控制指令，控制所述左驅(qū)動(dòng)電機(jī)、所述右驅(qū)動(dòng)電機(jī)的轉(zhuǎn)速和旋轉(zhuǎn)方向，進(jìn)而調(diào)整所述左前輪、所述右前輪的轉(zhuǎn)速和旋轉(zhuǎn)方向。

進(jìn)一步地，所述太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)還包括一左后輪、一右后輪以及兩個(gè)履帶；所述左后輪安裝在所述車體底面前部的左側(cè)，包括一左后輪轂及一左后輪軸，所述左后輪轂與所述左前輪轂設(shè)于同一直線上，所述左后輪軸設(shè)置于所述左后輪轂中心處；所述右后輪安裝在所述車體底面前部的右側(cè)，包括一右后輪轂及一右后輪軸，所述右后輪轂與所述右前輪轂設(shè)于同一直線上，所述右后輪軸設(shè)置于所述右后輪轂中心處；所述右后輪軸連接至所述左后輪軸；兩個(gè)履帶皆為一柔性鏈環(huán)，其中一履帶包覆在所述左前輪轂、所述左后輪轂的環(huán)形側(cè)壁外部；另一履帶包覆在所述右前輪轂、所述右后輪轂的環(huán)形側(cè)壁外部。

進(jìn)一步地，所述太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)還包括至少一輪轂輪齒、至少一履帶內(nèi)齒、至少一防滑塊或者至少一防滑花紋；所述輪轂輪齒均勻設(shè)置在所述左前輪轂、所述左后輪轂、所述右前輪轂、所述右后輪轂的環(huán)形側(cè)壁外部表面；所述履帶內(nèi)齒均勻設(shè)置在所述履帶的內(nèi)側(cè)壁表面，所述履帶內(nèi)齒與所述輪轂輪齒嚙合；所述防滑塊，突出于兩個(gè)履帶的外側(cè)壁；所述防滑花紋下凹于兩個(gè)履帶的外側(cè)壁。

進(jìn)一步地，所述太陽能面板清掃機(jī)器人動(dòng)力系統(tǒng)還包括至少一履帶張緊裝置；包括一上傳動(dòng)帶、一下傳動(dòng)帶、一上張緊部、一下壓緊部、一彈性支撐部。所述上傳動(dòng)帶為所述履帶上部，其下表面設(shè)有至少一履帶內(nèi)齒；所述下傳動(dòng)帶為所述履帶下部，其上表面設(shè)有至少一履帶內(nèi)齒；所述上張緊部上端與所述上傳動(dòng)帶下表面相切或嚙合，用以張緊所述上傳動(dòng)帶；所述下壓緊部下端與所述下傳動(dòng)帶上表面相切，用以壓緊所述下傳動(dòng)帶；所述彈性支撐部的一端連接至所述上張緊部，其另一端連接至所述下壓緊部，用以支撐所述上張緊部及所述下壓緊部。

進(jìn)一步地，所述履帶張緊裝置還包括一個(gè)或兩個(gè)履帶側(cè)板、至少一腰型孔、至少一安裝軸；所述履帶側(cè)板設(shè)置于所述履帶的一側(cè)或兩側(cè)；所述腰型孔豎直式設(shè)于所述履帶側(cè)板的上部；每一安裝軸一端上下滑動(dòng)式設(shè)置于一腰型孔內(nèi)；或者，每一安裝軸兩端上下滑動(dòng)式設(shè)置于兩個(gè)相對(duì)的腰型孔內(nèi)，兩個(gè)腰型孔分別位于兩個(gè)履帶側(cè)板上。

進(jìn)一步地，所述安裝軸包括至少一齒輪安裝軸；所述上張緊部包括至少一張緊齒輪，每一張緊齒輪通過一滾動(dòng)軸承安裝至一齒輪安裝軸上，其上端與所述上傳動(dòng)帶下表面嚙合。

進(jìn)一步地，所述安裝軸還包括至少一傳動(dòng)輪安裝軸；所述上張緊部還包括至少一張緊傳動(dòng)輪，每一張緊傳動(dòng)輪通過一滾動(dòng)軸承安裝至一傳動(dòng)輪安裝軸上，其與所述張緊齒輪相切或嚙合；一“V”形架，其上部的兩端分別設(shè)有一傳動(dòng)輪安裝軸，所述“V”形架上方設(shè)有一齒輪安裝軸；其中，所述齒輪安裝軸與所述傳動(dòng)輪安裝軸平行，所述齒輪安裝軸位于兩個(gè)傳動(dòng)輪安裝軸中間處的上方?；蛘撸錾蠌埦o部還包括一“V”形架，其上部的兩端分別設(shè)有一齒輪安裝軸。

進(jìn)一步地，所述下壓緊部包括至少一張緊壓板，與所述下傳動(dòng)帶上表面相切；所述彈性支撐部包括一“∧”形彈性件，其上部的彎角處連接至所述上張緊部下端，其下部的兩端分別連接至一張緊壓板。

本實(shí)用新型優(yōu)點(diǎn)在于，本實(shí)用新型采用履帶及防滑塊結(jié)構(gòu)使得清掃機(jī)器人的車體可以在太陽能面板上自由行動(dòng)而不會(huì)滑落；左右前輪用雙電機(jī)分別驅(qū)動(dòng)，動(dòng)力較好，可以對(duì)車體的行進(jìn)狀況實(shí)現(xiàn)精確控制，使車體可以根據(jù)需要更靈活地調(diào)整行進(jìn)方向和實(shí)現(xiàn)原地轉(zhuǎn)彎，可以盡量增大行駛路徑的覆蓋范圍。

附圖說明

圖1為本實(shí)用新型實(shí)施例中清掃機(jī)器人的整體外觀示意圖；

圖2為本實(shí)用新型實(shí)施例中清掃機(jī)器人內(nèi)部的結(jié)構(gòu)示意圖；

圖3為本實(shí)用新型實(shí)施例中清掃機(jī)器人的分解結(jié)構(gòu)示意圖；

圖4為本實(shí)用新型實(shí)施例中動(dòng)力系統(tǒng)整體結(jié)構(gòu)示意圖；

圖5為本實(shí)用新型實(shí)施例中動(dòng)力系統(tǒng)去除履帶外殼后的結(jié)構(gòu)示意圖；

圖6為本實(shí)用新型實(shí)施例中第一種履帶張緊裝置的結(jié)構(gòu)示意圖；

圖7為本實(shí)用新型實(shí)施例中第一種履帶張緊裝置去除履帶側(cè)板后的結(jié)構(gòu)示意圖；

圖8為本實(shí)用新型實(shí)施例中第一種履帶張緊裝置去除履帶后的結(jié)構(gòu)示意圖；

圖9為本實(shí)用新型實(shí)施例中第二種履帶張緊裝置去除履帶側(cè)板后的結(jié)構(gòu)示意圖；

圖10為本實(shí)用新型實(shí)施例中第三種履帶張緊裝置去除履帶側(cè)板后的結(jié)構(gòu)示意圖；

圖11為本實(shí)用新型實(shí)施例中控制系統(tǒng)的結(jié)構(gòu)框圖；

圖12為本實(shí)用新型實(shí)施例中在機(jī)器人上建立三維坐標(biāo)系的示意圖。

圖中部件編號(hào)如下：

100太陽能面板清掃機(jī)器人/清掃機(jī)器人/機(jī)器人，300斜坡平面，400服務(wù)器；

1車體，2清掃裝置，3動(dòng)力系統(tǒng)，4控制系統(tǒng)，5電力系統(tǒng)；11車身；

21清掃電機(jī)，22滾刷，23傳動(dòng)機(jī)構(gòu)；

31左前輪，32右前輪，33左后輪，34右后輪，35、左驅(qū)動(dòng)電機(jī)，36右驅(qū)動(dòng)電機(jī)，37履帶，38輪轂輪齒，39履帶張緊裝置；

41數(shù)據(jù)采集單元，42處理器，43存儲(chǔ)單元，44報(bào)警單元，45無線通信單元；51電池盒；

311左前輪轂，312左前輪軸，321右前輪轂，322右前輪軸，331左后輪轂， 341右后輪轂；

371履帶外殼，372履帶內(nèi)齒，373防滑塊，374上傳動(dòng)帶，375下傳動(dòng)帶；

391上張緊部，392下壓緊部，393彈性支撐部，394履帶側(cè)板，395履帶頂板，396腰型孔，397安裝軸，398齒輪支架；

411加速度傳感器，412磁傳感器，413距離傳感器，414計(jì)數(shù)器，415影像傳感器；

3911 “V”形架，3912張緊傳動(dòng)輪，3913張緊齒輪，3914“V”形平板，3915橫梁，3916圓柱齒輪，3917圓柱聯(lián)動(dòng)部；

3921張緊壓板，3931 “∧”形彈性件；

3971齒輪安裝軸，3972傳動(dòng)輪安裝軸。

具體實(shí)施方式

以下參考說明書附圖介紹本實(shí)用新型的一個(gè)優(yōu)選實(shí)施例，證明本實(shí)用新型可以實(shí)施，所述實(shí)施例可以向本領(lǐng)域中的技術(shù)人員完整介紹本實(shí)用新型，使其技術(shù)內(nèi)容更加清楚和便于理解。本實(shí)用新型可以通過許多不同形式的實(shí)施例來得以體現(xiàn)，本實(shí)用新型的保護(hù)范圍并非僅限于文中提到的實(shí)施例。

在附圖中，結(jié)構(gòu)相同的部件以相同數(shù)字標(biāo)號(hào)表示，各處結(jié)構(gòu)或功能相似的組件以相似數(shù)字標(biāo)號(hào)表示。附圖所示的每一部件的尺寸和厚度是任意示出的，本實(shí)用新型并沒有限定每個(gè)組件的尺寸和厚度。為了使圖示更清晰，附圖中有些地方適當(dāng)夸大了部件的厚度。

本實(shí)用新型所提到的方向用語，例如「上」、「下」、「前」、「后」、「左」、「右」、「內(nèi)」、「外」、「?jìng)?cè)面」等，僅是附圖中的方向，只是用來解釋和說明本實(shí)用新型，而不是用來限定本實(shí)用新型的保護(hù)范圍。

當(dāng)某些部件被描述為“在”另一部件“上”時(shí)，所述部件可以直接置于所述另一部件上；也可以存在一中間部件，所述部件置于所述中間部件上，且所述中間部件置于另一部件上。當(dāng)一個(gè)部件被描述為“安裝至”或“連接至”另一部件時(shí)，二者可以理解為直接“安裝”或“連接”，或者一個(gè)部件通過一中間部件間接“安裝至”、或“連接至”另一個(gè)部件。

如圖1~圖3所示，本實(shí)施例提供一種太陽能面板清掃機(jī)器人100（以下簡(jiǎn)稱清掃機(jī)器人或機(jī)器人），包括一車體1，車體1可以在至少一太陽能面板上行駛；車體1內(nèi)部或外部設(shè)有一清掃裝置2、一動(dòng)力系統(tǒng)3、一控制系統(tǒng)4以及一電力系統(tǒng)5。

清掃裝置2用以在車體行進(jìn)過程中清掃太陽能面板；動(dòng)力系統(tǒng)3用以調(diào)整車體1在太陽能面板上的行進(jìn)方向和行駛速度，控制車體1行駛、停止或轉(zhuǎn)向；控制系統(tǒng)4分別連接至動(dòng)力系統(tǒng)3及清掃裝置2，用以向動(dòng)力系統(tǒng)3及清掃裝置2發(fā)出各種控制信號(hào)。電力系統(tǒng)5分別連接至動(dòng)力系統(tǒng)3、清掃裝置2、控制系統(tǒng)4，用以為動(dòng)力系統(tǒng)3、清掃裝置2、控制系統(tǒng)4提供電力。

本實(shí)施例太陽能面板清掃機(jī)器人100在太陽能面板上正常工作中，當(dāng)電力系統(tǒng)5啟動(dòng)時(shí)，控制系統(tǒng)4發(fā)出至少一行進(jìn)控制指令和至少一清掃控制指令，動(dòng)力系統(tǒng)3根據(jù)該行進(jìn)控制指令，控制車體1沿著一事先規(guī)劃的路徑行駛；同時(shí)，清掃裝置2根據(jù)該清掃控制指令啟動(dòng)清掃裝置2，開始清掃太陽能面板。在車體1行駛過程中，控制系統(tǒng)4對(duì)動(dòng)力系統(tǒng)3發(fā)出多個(gè)行進(jìn)控制指令，如校偏指令、轉(zhuǎn)彎指令、調(diào)頭指令，等等，從而命令車體1在直線行進(jìn)路線發(fā)生偏轉(zhuǎn)的情況下回到原路線上，也即進(jìn)行校偏處理；或者在一定條件下或一定位置轉(zhuǎn)彎或者進(jìn)行U字回轉(zhuǎn)（調(diào)頭），使得車體1可以根據(jù)事先規(guī)劃的優(yōu)化路徑行駛。具體的導(dǎo)航方法、校偏方法、控制車體轉(zhuǎn)彎或進(jìn)行U字回轉(zhuǎn)（調(diào)頭）方法，在下文中有詳細(xì)描述。在整個(gè)行駛過程中，無論車體1是何種行進(jìn)方式，如直行、偏轉(zhuǎn)、校偏、轉(zhuǎn)彎或回轉(zhuǎn)，清掃裝置2始終保持工作狀態(tài)。當(dāng)控制系統(tǒng)4基于某些工作參數(shù)（如事先規(guī)劃的路徑全部走完或者電力系統(tǒng)5電量不足）發(fā)出停止行進(jìn)的行進(jìn)控制指令時(shí)，車體1停止行駛；同時(shí)控制系統(tǒng)4發(fā)出一清掃控制指令，關(guān)閉清掃裝置2，停止清掃。

如圖4、圖5所示，在本實(shí)施例中，動(dòng)力系統(tǒng)3設(shè)置于在車體1底部，用以帶動(dòng)車體1行進(jìn)，包括一左前輪31、一右前輪32、一左后輪33、一右后輪34、一左驅(qū)動(dòng)電機(jī)35、一右驅(qū)動(dòng)電機(jī)36及兩個(gè)履帶37。

左前輪31安裝在所述車體底面前部的左側(cè)，包括一左前輪轂311及一左前輪軸312，左前輪軸312設(shè)置于左前輪轂311中心處；右前輪32安裝在所述車體底面前部的右側(cè)，包括一右前輪轂321及一右前輪軸322，右前輪軸322設(shè)置于右前輪轂321中心處；左后輪33安裝在所述車體底面后部的左側(cè)，包括一左后輪轂331及一左后輪軸332（圖未示），左后輪轂331與左前輪轂311設(shè)于同一直線上，所述左后輪軸設(shè)置于左后輪轂331中心處；右后輪34安裝在所述車體底面后部的右側(cè)，包括一右后輪轂341及一右后輪軸（圖未示），右后輪轂341與右前輪轂321設(shè)于同一直線上；所述右后輪軸設(shè)置于右后輪轂341中心處。所述右后輪軸直接連接或通過一傳動(dòng)裝置（圖未示）連接至所述左后輪軸。左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36通過一固定裝置固定連接至車體1上，通過至少一導(dǎo)線連接至電力系統(tǒng)5，通過至少一信號(hào)線連接至控制系統(tǒng)4。左驅(qū)動(dòng)電機(jī)35直接連接或通過一傳動(dòng)裝置（圖未示）連接至左前輪軸312，右驅(qū)動(dòng)電機(jī)36直接連接或通過一傳動(dòng)裝置（圖未示）連接至右前輪軸322。兩個(gè)履帶37皆為一柔性鏈環(huán)，其中一履帶37包覆在左前輪轂311、左后輪轂331的環(huán)形側(cè)壁外部；另一履帶37包覆在右前輪轂321、右后輪轂341的環(huán)形側(cè)壁外部。每一履帶37外部設(shè)有一個(gè)履帶外殼371，用以保護(hù)履帶及輪轂，防止有雜物進(jìn)入履帶或輪轂中，影響車體1正常行進(jìn)。

本實(shí)施例中，控制系統(tǒng)4根據(jù)事先規(guī)劃的優(yōu)化路徑向左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36發(fā)出至少一行進(jìn)控制信號(hào)，使得左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36同步調(diào)整左前輪31、右前輪32的轉(zhuǎn)速和旋轉(zhuǎn)方向，進(jìn)而調(diào)整車體1的行進(jìn)方向和行進(jìn)速度，使車體實(shí)現(xiàn)直行、校偏、90度轉(zhuǎn)彎、U字回轉(zhuǎn)（調(diào)頭）等動(dòng)作。

當(dāng)需要車體直線前進(jìn)時(shí)，控制系統(tǒng)4同時(shí)向左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36發(fā)出一直線行進(jìn)控制指令，控制指令中包括相同的電機(jī)轉(zhuǎn)速（例如左驅(qū)動(dòng)電機(jī)、右驅(qū)動(dòng)電機(jī)的轉(zhuǎn)速都是60轉(zhuǎn)/分鐘）和驅(qū)動(dòng)電機(jī)轉(zhuǎn)軸的轉(zhuǎn)動(dòng)方向（如左驅(qū)動(dòng)電機(jī)順時(shí)針轉(zhuǎn)、右驅(qū)動(dòng)電機(jī)逆時(shí)針轉(zhuǎn)），這樣就會(huì)帶動(dòng)左前輪31、右前輪32同步向前轉(zhuǎn)動(dòng)，左后輪33、右后輪34為從動(dòng)輪，在履帶37的帶動(dòng)下也與左前輪31、右前輪32同步向前轉(zhuǎn)動(dòng)，使得整個(gè)車體1前進(jìn)。

當(dāng)需要車體1向右偏轉(zhuǎn)時(shí)，控制系統(tǒng)4同時(shí)向左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36發(fā)出一校偏行進(jìn)控制指令，左驅(qū)動(dòng)電機(jī)35收到的控制指令中的電機(jī)轉(zhuǎn)速比右驅(qū)動(dòng)電機(jī)36收到的控制指令中的電機(jī)轉(zhuǎn)速偏大，轉(zhuǎn)速的差值取決于需要調(diào)整的偏差角度，偏差角度越小，轉(zhuǎn)速差值也就越小。類似地，當(dāng)需要車體1向左偏轉(zhuǎn)時(shí)，左驅(qū)動(dòng)電機(jī)35收到的控制指令中的電機(jī)轉(zhuǎn)速比右驅(qū)動(dòng)電機(jī)36收到的控制指令中的電機(jī)轉(zhuǎn)速偏小。當(dāng)車體1回到原來預(yù)設(shè)的行進(jìn)方向后，控制系統(tǒng)4重新再發(fā)出直線行進(jìn)控制指令，左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36的轉(zhuǎn)速再次變?yōu)橄嗤?，使得車體1繼續(xù)直線行進(jìn)。

當(dāng)需要車體做90度轉(zhuǎn)彎時(shí)，控制系統(tǒng)4根據(jù)預(yù)設(shè)轉(zhuǎn)彎半徑的大小計(jì)算出左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36的轉(zhuǎn)速和轉(zhuǎn)動(dòng)方向，如果轉(zhuǎn)彎半徑較大，其驅(qū)動(dòng)電機(jī)的轉(zhuǎn)動(dòng)方向可以相反（一個(gè)順時(shí)針、一個(gè)逆時(shí)針），左前輪31、右前輪32同步向前轉(zhuǎn)動(dòng)，或者設(shè)置成一個(gè)輪停止轉(zhuǎn)動(dòng)，從而實(shí)現(xiàn)行進(jìn)中轉(zhuǎn)彎的效果；如果轉(zhuǎn)彎半徑較小或者原地轉(zhuǎn)彎，左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36的轉(zhuǎn)動(dòng)方向可以設(shè)計(jì)為相同，同為順時(shí)針或同為逆時(shí)針，這樣左前輪31、右前輪32就會(huì)一個(gè)向前轉(zhuǎn)動(dòng)、一個(gè)向后轉(zhuǎn)動(dòng)，車體1的一側(cè)前進(jìn)，另一側(cè)后退，從而形成小半徑轉(zhuǎn)彎或原地轉(zhuǎn)彎的效果。

當(dāng)需要車體進(jìn)行U字回轉(zhuǎn)（也稱為調(diào)頭）時(shí)，需要車體在180度轉(zhuǎn)彎后行駛至與原車道相鄰的車道上；此時(shí)有一次性回轉(zhuǎn)或者分階段回轉(zhuǎn)的技術(shù)方案?？刂葡到y(tǒng)4根據(jù)預(yù)設(shè)轉(zhuǎn)彎半徑的大小計(jì)算出左驅(qū)動(dòng)電機(jī)35、右驅(qū)動(dòng)電機(jī)36的轉(zhuǎn)速和轉(zhuǎn)動(dòng)方向。在一次性回轉(zhuǎn)的方案中，轉(zhuǎn)彎半徑等同于車體寬度的一半，轉(zhuǎn)彎內(nèi)側(cè)的前輪停止轉(zhuǎn)動(dòng)或極慢速度向前轉(zhuǎn)動(dòng)（若向左進(jìn)行U字回轉(zhuǎn)，則左前輪停止轉(zhuǎn)動(dòng)；若向右進(jìn)行U字回轉(zhuǎn)，則右前輪停止轉(zhuǎn)動(dòng)），轉(zhuǎn)彎外側(cè)的前輪快速向前轉(zhuǎn)動(dòng)，實(shí)現(xiàn)向左或向右的U字回轉(zhuǎn)。分階段回轉(zhuǎn)的方案中，可以根據(jù)具體情況計(jì)算處不同的方案，本實(shí)施例中優(yōu)選如下方案：先控制車體1先在原地向左或向右做90度轉(zhuǎn)彎，然后再控制車體向前行駛一個(gè)車身寬度的距離，最后再控制車體在原地向左或向右做90度轉(zhuǎn)彎，既可以實(shí)現(xiàn)向左或向右的U字回轉(zhuǎn)，而且U字回轉(zhuǎn)后剛好行駛在與前一車道相鄰的車道上，從而使得本實(shí)施例的機(jī)器人行駛過的空間可以實(shí)現(xiàn)不重復(fù)、無死角的效果。

動(dòng)力系統(tǒng)3還包括至少一輪轂輪齒38，均勻設(shè)置在左前輪轂311、左后輪轂331、右前輪轂321、右后輪轂341的環(huán)形側(cè)壁外部表面；以及至少一履帶內(nèi)齒372，均勻設(shè)置在履帶37的內(nèi)側(cè)壁表面，履帶內(nèi)齒372與輪轂輪齒38嚙合，確保在兩個(gè)前輪31、32轉(zhuǎn)動(dòng)時(shí)，履帶37可以與兩個(gè)輪轂相配合，得以正常使用。

由于太陽能面板相對(duì)比較光滑，而且還有一定的傾斜度，因此清掃機(jī)器人車體在行駛過程中容易滑落。為解決這一問題，如圖4所示，動(dòng)力系統(tǒng)3還包括至少一防滑塊373，突出于兩個(gè)履帶37的外側(cè)壁，防滑塊373可以排列成有序的陣列，平均分布在整條履帶37上。本實(shí)施例的車體1采用履帶式結(jié)構(gòu)、在履帶外壁加裝防滑塊373，都是為了增大摩擦系數(shù)，增強(qiáng)抓地力，防止車體1在行進(jìn)中滑落。類似地，本實(shí)施例的履帶37上也可以設(shè)置至少一防滑花紋（圖未示），下凹于兩個(gè)履帶的外側(cè)壁，平均分布在整條履帶上，其效果與防滑塊相同。

本實(shí)施例中，動(dòng)力系統(tǒng)3的技術(shù)效果在于，采用履帶及防滑塊結(jié)構(gòu)使得清掃機(jī)器人的車體可以在太陽能面板上自由行動(dòng)而不會(huì)滑落；左右前輪用雙電機(jī)分別驅(qū)動(dòng)，可以對(duì)車體的行進(jìn)狀況實(shí)現(xiàn)精確控制，使車體可以根據(jù)需要更靈活地調(diào)整行進(jìn)方向和實(shí)現(xiàn)原地轉(zhuǎn)彎，可以盡量增大行駛路徑的覆蓋范圍。

如圖6~圖8所示，動(dòng)力系統(tǒng)3還包括兩個(gè)履帶張緊裝置39，每一履帶張緊裝置39分別設(shè)置在一個(gè)履帶37內(nèi)。履帶在安裝后，具有一定的松弛度，因此需要對(duì)該柔性鏈環(huán)進(jìn)行張緊調(diào)節(jié)，以保證履帶可以正常前進(jìn)?，F(xiàn)有技術(shù)是在履帶前方加裝誘導(dǎo)輪，誘導(dǎo)輪上配置分離機(jī)構(gòu)和兩個(gè)渦桿，通過調(diào)節(jié)分離機(jī)構(gòu)和蝸桿來實(shí)現(xiàn)張緊。這種調(diào)節(jié)的方式和結(jié)構(gòu)比較繁瑣，且只能一次性的調(diào)整完畢，而不能在履帶運(yùn)行過程中進(jìn)行實(shí)時(shí)調(diào)整。

本實(shí)施例提供以下三種履帶張緊裝置，如圖6~圖8所示，第一種履帶張緊裝置39包括一上張緊部391、一下壓緊部392以及一彈性支撐部393。

履帶37為一柔性鏈環(huán)，其內(nèi)側(cè)面設(shè)有均勻分布的履帶內(nèi)齒372。履帶37包括一上傳動(dòng)帶374、一下傳動(dòng)帶375；上傳動(dòng)帶374為履帶37的上部，下傳動(dòng)帶375為履帶37的下部，上傳動(dòng)帶374下表面與下傳動(dòng)帶375上表面皆設(shè)有至少一履帶內(nèi)齒372。

上張緊部391上端與上傳動(dòng)帶374下表面相切或嚙合，用以張緊上傳動(dòng)帶374，在履帶運(yùn)行中，上張緊部391與上傳動(dòng)帶374滑動(dòng)或滾動(dòng)式連接。下壓緊部下端與下傳動(dòng)帶375上表面相切，用以壓緊下傳動(dòng)帶375；彈性支撐部393的一端連接至上張緊部391，其另一端連接至下壓緊部392，用以支撐所述上張緊部及所述下壓緊部。

如圖6所示，履帶張緊裝置39可以包括兩個(gè)履帶側(cè)板394，分別設(shè)置于履帶37的兩側(cè)，兩個(gè)履帶側(cè)板394可以通過一個(gè)履帶頂板395連接在一起，組成一體化的履帶外殼371，履帶外殼371通過至少一螺栓固定連接至車體1的輪軸處。每一履帶側(cè)板394的上部設(shè)有至少一個(gè)豎直式的腰型孔396。履帶張緊裝置39還包括至少一安裝軸397，其兩端上下滑動(dòng)式設(shè)置于兩個(gè)相對(duì)的腰型孔396內(nèi)，兩個(gè)腰型孔396分別位于兩個(gè)履帶側(cè)板394上。安裝軸397及裝配在安裝軸397上的部件可以在腰型孔396所限制的范圍內(nèi)上下移動(dòng)。履帶張緊裝置39還可以只包括一個(gè)履帶側(cè)板394，設(shè)置于機(jī)器人履帶37的外側(cè)；該履帶側(cè)板的上部設(shè)有豎直式的至少一腰型孔，安裝軸397只有一端上下滑動(dòng)式設(shè)置于一腰型孔396內(nèi)。本實(shí)施例中優(yōu)選在一個(gè)履帶側(cè)板設(shè)置三個(gè)腰型孔的方案，三個(gè)腰型孔呈“品”字形排列。

安裝軸397包括至少一齒輪安裝軸3971和至少一傳動(dòng)輪安裝軸3972；本實(shí)施例優(yōu)選一個(gè)齒輪安裝軸3971和兩個(gè)傳動(dòng)輪安裝軸，齒輪安裝軸3971與兩個(gè)傳動(dòng)輪安裝軸3972呈“品”字形排列。上張緊部391包括一“V”形架3911、至少一張緊傳動(dòng)輪3912以及至少一張緊齒輪3913，本實(shí)施例優(yōu)選一個(gè)張緊齒輪3913和兩個(gè)張緊傳動(dòng)輪3912，張緊齒輪3913與兩個(gè)張緊傳動(dòng)輪312呈“品”字形排列。

“V”形架3911上部的兩端分別設(shè)有一傳動(dòng)輪安裝軸3972；“V”形架3911包括彼此平行設(shè)置的兩片“V”形平板3914及兩根橫梁3915，每一橫梁3915兩端分別固定連接至兩片“V”形平板3914；傳動(dòng)輪安裝軸3972垂直于“V”形平板3914。齒輪安裝軸3971設(shè)置于“V”形架3911上方，正對(duì)兩個(gè)傳動(dòng)輪安裝軸3972中間。

張緊傳動(dòng)輪3912通過一滾動(dòng)軸承（圖未示）安裝至所述傳動(dòng)輪安裝軸3972上；每一張緊齒輪通過一滾動(dòng)軸承（圖未示）安裝至一齒輪安裝軸3971上，其上端與上傳動(dòng)帶374下表面嚙合。

兩個(gè)張緊傳動(dòng)輪3912設(shè)于張緊齒輪3913兩側(cè)的下方。張緊傳動(dòng)輪3912與所述張緊齒輪3913相切或嚙合，二者可以實(shí)現(xiàn)傳動(dòng)；張緊齒輪3913、張緊傳動(dòng)輪上3912可以有齒輪面也可以有無齒輪面，若有齒輪面則二者嚙合，若無齒輪面則二者相切。

本實(shí)施例中，張緊齒輪3913為雙聯(lián)直齒圓柱齒輪，具體包括兩個(gè)圓柱齒輪3916和一圓柱聯(lián)動(dòng)部3917。兩個(gè)圓柱齒輪3916與上傳動(dòng)帶374下表面嚙合；圓柱聯(lián)動(dòng)部3917設(shè)于兩個(gè)圓柱齒輪3916之間；兩個(gè)圓柱齒輪3916的直徑相同；聯(lián)動(dòng)部3917直徑小于圓柱齒輪3916的直徑，每一張緊傳動(dòng)輪3912與張緊齒輪3913的聯(lián)動(dòng)部相切。

下壓緊部392為至少一個(gè)張緊壓板3921，優(yōu)選兩個(gè)，張緊壓板3921與下傳動(dòng)帶375上表面相切；彈性支撐部393包括一“∧”形彈性件3931，其上部的彎角處連接至上壓緊部391下端，也即“V”形架3911下部的彎角處；其下部的兩端分別連接至一個(gè)張緊壓板3921。

“V”形架3911下端的彎角處有一弧形孔，“∧”形彈性件3931上部的彎角為一半圓角；帶有半圓角的“∧”形彈性件3931的上部組接于該弧形孔內(nèi)。 “∧”形彈性件3931下部的兩端分別連接有一圓形鉤環(huán)，分別連接至兩個(gè)張緊壓板3921上表面；具體地說，每一張緊壓板3921上表面設(shè)有一凹槽，在凹槽內(nèi)設(shè)有一張緊壓板3921連接軸，每一圓形鉤環(huán)對(duì)應(yīng)連接至一張緊壓板3921連接軸。

本實(shí)施例的履帶在運(yùn)行中，由于履帶37為一柔性鏈環(huán)，其內(nèi)表面的履帶內(nèi)齒與前后兩個(gè)輪轂側(cè)壁嚙合，同時(shí)張緊齒輪3913也與上傳動(dòng)帶374下表面嚙合，履帶37向前滾動(dòng)時(shí)，帶動(dòng)張緊齒輪3913轉(zhuǎn)動(dòng)。

上述各部件組裝在一起之前，“∧”形彈性件3931在不發(fā)生形變的情況下，其張角較小；將上述各部件組裝好后，“∧”形彈性件發(fā)生形變，張開的角度增大，使得履帶37處于張緊狀態(tài)。此時(shí)，“∧”形彈性件具有恢復(fù)原先形狀（張角較小狀態(tài)）的趨勢(shì)。

當(dāng)帶輪轂的履帶前后運(yùn)動(dòng)時(shí)，履帶37作用于張緊齒輪3913，帶動(dòng)張緊齒輪3913轉(zhuǎn)動(dòng)，即相當(dāng)于受到履帶3931的作用力，該作用力產(chǎn)生一向下的分力，推動(dòng)張緊齒輪3913沿腰型孔396向下移動(dòng)，此時(shí)，張緊傳動(dòng)輪3912與張緊齒輪3913相切，并受張緊齒輪3913的作用了向下移動(dòng)，進(jìn)一步壓縮“∧”形彈性件3931，此時(shí)，“∧”形彈性件3931的張角繼續(xù)增大，“∧”形彈性件3931形變加大，產(chǎn)生的彈力進(jìn)一步增大。

當(dāng)履帶與張緊齒輪3913相離，或者張緊齒輪3913與傳動(dòng)輪相離時(shí)，“∧”形彈性件3931釋放一部分被壓縮的彈性勢(shì)能，張角變小，再次將履帶37張緊。如此往復(fù)循環(huán)，根據(jù)履帶37的運(yùn)動(dòng)狀態(tài)，彈性支撐部393可以實(shí)時(shí)調(diào)整張緊力，減少了部件之間的剛性摩擦，有利于增強(qiáng)部件的使用壽命。

如圖9所示，本實(shí)施例還提供第二種履帶張緊裝置，其大部分技術(shù)方案與第一種履帶裝置相同，其區(qū)別技術(shù)特征在于，第二種履帶張緊裝置中，安裝軸只包括至少一齒輪安裝軸3971，而不包括傳動(dòng)輪安裝軸3972，優(yōu)選兩個(gè)平行排列的齒輪安裝軸3971。上張緊部391包括一“V”形架及至少一張緊齒輪3913，本實(shí)施例優(yōu)選兩個(gè)張緊齒輪3913，兩個(gè)張緊齒輪3913呈品字排列。“V”形架3911上部的兩端分別設(shè)有一齒輪安裝軸3971，齒輪安裝軸3971垂直于“V”形平板3914。下壓緊部392為至少一張緊壓板3921，與下傳動(dòng)帶375上表面相切。彈性支撐部393為一個(gè)彈簧或多個(gè)彈簧組成的彈簧支架，也可以為橡膠墊，其一端連接至“V”形架3911下部的彎角處，其另一端連接至張緊壓板3921。第二種履帶張緊裝置結(jié)構(gòu)比較簡(jiǎn)單，成本較低，但張緊效果稍差，對(duì)彈性支撐部393的材質(zhì)要求較高；其工作原理與第一種履帶張緊裝置類似，在此不作贅述。

如圖10所示，本實(shí)施例還提供第三種履帶張緊裝置，其大部分技術(shù)方案與第二種履帶裝置相同，其區(qū)別技術(shù)特征在于，上張緊部391包括至少一張緊齒輪3913，優(yōu)選一個(gè)，每一張緊齒輪3913通過一滾動(dòng)軸承安裝至一齒輪安裝軸3971上；第三種履帶張緊裝置還包括一齒輪支架398，用以取代“V”形架，其上端安裝有齒輪安裝軸3971，其下端連接至彈性支撐部393。下壓緊部392為至少一張緊壓板3921，彈性支撐部393為一個(gè)彈簧或多個(gè)彈簧組成的彈簧支架，也可以為橡膠墊，其一端連接至齒輪支架398下端，其另一端連接至張緊壓板3921。第三種履帶張緊裝置結(jié)構(gòu)比較簡(jiǎn)單，成本較低，但張緊效果稍差，對(duì)彈性支撐部393及齒輪支架398的材質(zhì)要求較高；其工作原理與第二種履帶張緊裝置類似，在此不作贅述。

本實(shí)施例中，履帶張緊裝置的技術(shù)效果在于，采用一種“滑動(dòng)裝配設(shè)計(jì)”，即在上張緊部391與下壓緊部392之間加裝一彈性支撐部393，通過腰型孔實(shí)現(xiàn)該張緊裝置的上下滑動(dòng)，已達(dá)到實(shí)時(shí)調(diào)整的目的；這種調(diào)整為柔性調(diào)整，是根據(jù)履帶自身運(yùn)行而實(shí)現(xiàn)的實(shí)時(shí)調(diào)整，能夠改善剛性調(diào)整的部件磨損，降低部件之間的摩擦力，增加履帶的使用壽命；調(diào)整后的履帶，能夠及時(shí)適應(yīng)路面，具有該履帶張緊裝置的機(jī)器人，能夠達(dá)到省電的目的；而且結(jié)構(gòu)簡(jiǎn)單，組裝方便。

如圖11所示，本實(shí)施例中，控制系統(tǒng)4包括一數(shù)據(jù)采集單元41、一處理器42及至少一存儲(chǔ)單元43。數(shù)據(jù)采集單元41包括多種傳感器，用以采集車體1行進(jìn)過程中的至少一工作參數(shù)；處理器42連接至數(shù)據(jù)采集單元41，根據(jù)所述工作參數(shù)向動(dòng)力系統(tǒng)3發(fā)出至少一行進(jìn)控制指令，根據(jù)所述工作參數(shù)向清掃裝置2發(fā)出至少一清掃控制指令。存儲(chǔ)單元43連接至處理器42，用以存儲(chǔ)車體1行進(jìn)過中的工作參數(shù)及預(yù)先計(jì)算或設(shè)置的其他參數(shù)。所述工作參數(shù)包括車體1的實(shí)時(shí)加速度數(shù)據(jù)、實(shí)時(shí)行進(jìn)方向數(shù)據(jù)、液體分發(fā)容器實(shí)時(shí)液位數(shù)據(jù)、每一距離傳感器與太陽能面板之間的距離、車體前方的影像等參數(shù)。預(yù)先計(jì)算或設(shè)置的其他參數(shù)包括工作人員預(yù)設(shè)的各種工作數(shù)據(jù)，如預(yù)先計(jì)算和規(guī)劃好的清掃機(jī)器人行駛路徑（優(yōu)化路徑），液體分發(fā)容器25內(nèi)的液位數(shù)據(jù)報(bào)警閾值（達(dá)到此閾值時(shí)，報(bào)警單元報(bào)警）、液位數(shù)據(jù)停工閾值（達(dá)到此閾值時(shí)，抽水泵28停止運(yùn)行），等等。

工作人員預(yù)先將規(guī)劃好的優(yōu)化路徑錄入至控制系統(tǒng)4，為清掃機(jī)器人車體提供路徑導(dǎo)航，控制系統(tǒng)4根據(jù)所述優(yōu)化路徑進(jìn)行運(yùn)算和規(guī)劃，并將何時(shí)啟動(dòng)、何時(shí)停止、何時(shí)直線行駛、何時(shí)向左或向右90度轉(zhuǎn)彎、何時(shí)向左或向右90度進(jìn)行U字回轉(zhuǎn)等控制信息，以各種控制指令的方式發(fā)送給動(dòng)力系統(tǒng)，以控制車體在行進(jìn)中的動(dòng)作。

在車體控制技術(shù)中，如何判斷車體在斜坡平面上是否直線行駛、如何控制車體在斜坡平面上直線行駛是最基本的問題，如果車體在直線行駛過程中缺乏監(jiān)管，一旦車體因?yàn)槟承┮蛩兀ㄈ缏访婢植坎黄?、路面上有障礙物等）發(fā)生偏轉(zhuǎn)，就會(huì)發(fā)生越走越偏的現(xiàn)象，在本實(shí)用新型中，會(huì)導(dǎo)致機(jī)器人偏離既有的導(dǎo)航路徑，不能在最短時(shí)間內(nèi)走遍整個(gè)斜坡平面。在本實(shí)施例中，會(huì)導(dǎo)致清掃機(jī)器人作業(yè)完成后，太陽能面板上還有很多地方?jīng)]有及時(shí)清理干凈。

為了解決如何判斷本實(shí)施例的機(jī)器人是否在斜坡上直線行駛的技術(shù)問題，本實(shí)施例提供了如下技術(shù)方案。

在控制系統(tǒng)4中，數(shù)據(jù)采集單元41包括至少一加速度傳感器411，用以實(shí)時(shí)采集機(jī)器人100（或車體1）的加速度數(shù)據(jù)；加速度傳感器411連接至處理器42，將車體1的加速度數(shù)據(jù)傳送給處理器42，處理器42分析動(dòng)態(tài)加速度數(shù)據(jù)，可以分析出在車體行駛過程中車體的受力方向及行進(jìn)方向等。處理器42將機(jī)器人100的加速度數(shù)據(jù)建立三維坐標(biāo)系并分解計(jì)算，定義機(jī)器人100行進(jìn)方向?yàn)閅軸正方向，定義垂直于所述斜坡平面的方向?yàn)閆軸方向；所述X軸與所述Y軸所處平面與所述斜坡平面平行。根據(jù)加速度數(shù)據(jù)在X軸方向的向量，判斷車體1是否有向左或向右偏離，若發(fā)生偏離，所述處理器向動(dòng)力系統(tǒng)3發(fā)出至少一方向調(diào)整指令，使得車體1回到其原本的直線路線上；若沒有偏離，處理器42判定車體1為直線行駛。

進(jìn)一步地，為了保證直線行駛判斷的精確性，除了用加速度傳感器判定之外，還可以采用磁傳感器技術(shù)對(duì)加速度傳感器判定發(fā)現(xiàn)偏離路線的情況，再次進(jìn)行判定，也就是磁傳感器二次判定。為此，在控制系統(tǒng)4中，數(shù)據(jù)采集單元41還可以包括一磁傳感器412，連接至處理器42，磁傳感器412以感應(yīng)磁場(chǎng)強(qiáng)度來測(cè)量電流、位置、方向等物理參數(shù)。本實(shí)施例中，磁傳感器412用以實(shí)時(shí)采集行進(jìn)方向數(shù)據(jù)，與根據(jù)優(yōu)化路徑數(shù)據(jù)預(yù)先設(shè)定的標(biāo)準(zhǔn)行進(jìn)方向?qū)Ρ群筮M(jìn)行判斷，以確認(rèn)車體是否為直線行駛，使得車體是否直線行駛的判斷更加精確。

為了解決如何判斷本實(shí)施例所述的太陽能面板清掃機(jī)器人（以下簡(jiǎn)稱機(jī)器人）是否為直線行駛的技術(shù)問題，本實(shí)施例提供了一種清掃機(jī)器人100在斜坡平面300上直線行駛判定方法，可以包括如下各個(gè)步驟。由于太陽能面板為一斜坡平面，因此本判定方法可以用于判斷太陽能面板清掃機(jī)器人是否為直線行駛。

步驟S1）如圖12所示，在所述機(jī)器人上建立三維坐標(biāo)系，定義所述機(jī)器人行進(jìn)方向?yàn)閅軸正方向，定義垂直于所述斜坡平面的方向?yàn)閆軸方向；所述X軸與所述Y軸所處平面與所述斜坡平面平行。

步驟S2）定義所述機(jī)器人行進(jìn)方向?yàn)門s時(shí)，重力加速度g在所述三維坐標(biāo)系三個(gè)方向上的標(biāo)準(zhǔn)分向量g_xs0、g_ys0、g_zs0。

步驟S3）生成一標(biāo)準(zhǔn)方向參數(shù)庫；具體包括如下步驟：步驟S31）控制所述機(jī)器人在所述斜坡平面上沿著預(yù)設(shè)的一圓環(huán)路徑做勻速圓周運(yùn)動(dòng)，所述勻速圓周運(yùn)動(dòng)的角速度為0.1~1.0度/秒；步驟S32）在所述機(jī)器人做圓周運(yùn)動(dòng)過程中，每隔一定時(shí)間間隔t₀實(shí)時(shí)采集并記錄至少一組標(biāo)準(zhǔn)方向參數(shù)，所述時(shí)間間隔t₀為0.1-5.0秒；每一組標(biāo)準(zhǔn)方向參數(shù)包括所述機(jī)器人的一行進(jìn)方向Ts及對(duì)應(yīng)該行進(jìn)方向的標(biāo)準(zhǔn)分向量g_xs0、g_ys0、g_zs0；以及步驟S33）根據(jù)至少一組標(biāo)準(zhǔn)方向參數(shù)生成一標(biāo)準(zhǔn)方向參數(shù)庫。以角速度0.1度/秒，采集時(shí)間間隔t₀=1秒為例，機(jī)器人100在斜坡平面300上完成一次勻速圓周運(yùn)動(dòng)，大概需要3600秒，每隔1秒采集一次機(jī)器人的行進(jìn)方向Ts及相應(yīng)的加速度標(biāo)準(zhǔn)分向量g_xs0、g_ys0、g_zs0，這樣就可以得到3600組不同方向的參數(shù)，將其記錄為3600組標(biāo)準(zhǔn)方向參數(shù)。

步驟S4）控制所述機(jī)器人在所述斜坡平面上沿著預(yù)設(shè)的一直線路徑向任一方向Tm直線行駛。

步驟S5）從所述標(biāo)準(zhǔn)方向參數(shù)庫中調(diào)取對(duì)應(yīng)該行進(jìn)方向Tm的標(biāo)準(zhǔn)分向量g_xm0、g_ym0、g_zm0數(shù)據(jù)。

步驟S6）每隔一定時(shí)間間隔t實(shí)時(shí)采集一組實(shí)時(shí)方向參數(shù)，所述實(shí)時(shí)方向參數(shù)包括重力加速度g在所述三維坐標(biāo)系三個(gè)方向上的實(shí)時(shí)分向量g_xm1、g_ym1、g_zm1，所述時(shí)間間隔t為0.1-1.0秒。

步驟S7）計(jì)算重力加速度g在所述X軸方向上的實(shí)時(shí)分向量與標(biāo)準(zhǔn)分向量的分向量差值g_xd=g_xm1 -g_xm0 。

步驟S8）判定所述機(jī)器人是否沿著預(yù)設(shè)的直線路徑行駛；當(dāng)g_xd等于0時(shí)，判定所述機(jī)器人沿著預(yù)設(shè)的直線路徑行駛，返回步驟S6）；當(dāng)g_xd不等于0時(shí)，判定所述機(jī)器人偏離預(yù)設(shè)的直線路徑。

由于機(jī)器人100在斜坡平面300上的重力加速度g是一個(gè)定值，當(dāng)機(jī)器人100在斜坡平面300上運(yùn)行時(shí)，行進(jìn)方向Ts及該方向加速度分向量數(shù)據(jù)g_xs、g_ys、g_zs應(yīng)該是與標(biāo)準(zhǔn)數(shù)據(jù)庫中的標(biāo)準(zhǔn)方向參數(shù)是一致的。在本實(shí)施例中，判斷機(jī)器人是否直線行駛，本質(zhì)上就是判斷機(jī)器人是否相對(duì)于直線行進(jìn)路線發(fā)生向左或向右的微小偏離，因此只需要判斷重力加速度g在所述X軸方向上的實(shí)時(shí)分向量與標(biāo)準(zhǔn)分向量與是否相同即可，相同就沒有偏離，不同就發(fā)生偏離，進(jìn)一步地，可以根據(jù)分向量差值g_xd=g_xm1 -g_xm0是正數(shù)還是負(fù)數(shù)來判斷是向左偏離還是向右偏離。

進(jìn)一步地，本實(shí)施例還提供了另一種機(jī)器人在斜坡平面上直線行駛判定方法，在上述步驟S8）判定所述機(jī)器人偏離預(yù)設(shè)的直線路徑之后還可以包括如下步驟：步驟S9）利用一磁傳感器獲取實(shí)時(shí)行進(jìn)方向Tn；步驟S10）比對(duì)所述實(shí)時(shí)行進(jìn)方向Tn與所述行進(jìn)方向Tm，如果二者一致，判定所述機(jī)器人沿著預(yù)設(shè)的直線路徑行駛，返回步驟S6）；如果二者不一致，判定所述機(jī)器人偏離預(yù)設(shè)的直線路徑。在前次判定機(jī)器人偏離直線路徑的情況下，對(duì)其進(jìn)行二次判定，以避免出現(xiàn)意外，使得判斷結(jié)果更加精確。

控制系統(tǒng)4發(fā)現(xiàn)機(jī)器人行駛路線發(fā)生偏移后，必須第一時(shí)間將其糾正過來，使得機(jī)器人可以盡早回到應(yīng)有路線，這一過程可以稱為校偏處理。為了解決如何控制所述機(jī)器人在斜坡平面上直線行駛的技術(shù)問題，本實(shí)施例提供了一種機(jī)器人在斜坡平面上直線行駛控制方法，可以包括如下步驟。

步驟S11）根據(jù)前文中步驟S1）-S8）或者步驟S1）-S10）所述的機(jī)器人在斜坡平面上直線行駛判定方法來判斷一機(jī)器人是否沿著預(yù)設(shè)的直線路徑行駛；若所述機(jī)器人偏離預(yù)設(shè)的直線路徑，執(zhí)行步驟S12）。

步驟S12）控制所述機(jī)器人在行駛過程中向所述Tm方向偏轉(zhuǎn)；具體包括如下步驟：步驟S121）在標(biāo)準(zhǔn)方向參數(shù)庫調(diào)取與所述實(shí)時(shí)方向參數(shù)對(duì)應(yīng)的實(shí)際行進(jìn)方向Tn；步驟S122）計(jì)算所述機(jī)器人需要調(diào)整的偏轉(zhuǎn)方向和偏轉(zhuǎn)角度；所述偏轉(zhuǎn)角度為所述實(shí)際行進(jìn)方向Tn與預(yù)設(shè)行進(jìn)方向Tm的夾角角度；步驟S123）根據(jù)所述機(jī)器人需要調(diào)整的偏轉(zhuǎn)方向和偏轉(zhuǎn)角度，向動(dòng)力系統(tǒng)3發(fā)出一方向調(diào)整指令，控制所述機(jī)器人向左或向右發(fā)生偏轉(zhuǎn)。

步驟S13）控制所述機(jī)器人在所述斜坡平面上沿著Tm方向直線行駛；返回步驟S11）。

其中，所述機(jī)器人在斜坡平面上直線行駛的判定方法，如步驟S1）-S8），或步驟S1）-S10），可以在極短時(shí)間內(nèi)根據(jù)一組加速度數(shù)據(jù)（及磁傳感器數(shù)據(jù)）快速判斷出車體在斜坡上是否直線行駛；由于加速度傳感器可以實(shí)時(shí)采集數(shù)據(jù)，每隔一段時(shí)間就會(huì)采集一組數(shù)據(jù)；因此，上述的判定過程也是每隔一段時(shí)間就會(huì)定期判定一次。無論何時(shí)發(fā)現(xiàn)機(jī)器人（車體）在斜坡平面上過程中，偏離了直線路線，都可以判定此時(shí)機(jī)器人發(fā)生偏離。

其中，所述機(jī)器人在斜坡平面上直線行駛的控制方法，如步驟S11）~步驟S13），是基于前述的機(jī)器人在斜坡平面上直線行駛判定技術(shù)，當(dāng)確認(rèn)機(jī)器人發(fā)生偏離之后，第一時(shí)間調(diào)整機(jī)器人的行進(jìn)方向，使其回復(fù)到原有方向的路徑上來。

在本實(shí)用新型中，所述機(jī)器人在斜坡平面上直線行駛的判定方法與所述機(jī)器人在斜坡平面上直線行駛的控制方法配合使用，可以確保清掃機(jī)器人在直線行駛過程中不會(huì)發(fā)生偏離，從而可以確保清掃機(jī)器人可以沿著預(yù)先設(shè)定的優(yōu)化導(dǎo)航路徑，在最短時(shí)間內(nèi)走遍整個(gè)太陽能面板，又快又好地將整個(gè)太陽能面板清掃干凈。

根據(jù)時(shí)間最短、行駛路徑最短的原則，機(jī)器人在一矩形斜坡上的優(yōu)化導(dǎo)航路徑很容易就可以規(guī)劃和計(jì)算出來，控制系統(tǒng)可以使機(jī)器人可以沿著預(yù)先設(shè)定的優(yōu)化導(dǎo)航路徑行駛。

在本實(shí)施例中，數(shù)據(jù)采集單元41還可以包括至少一距離傳感器413，包括但不限于超聲波傳感器及光脈沖傳感器。距離傳感器413設(shè)置于機(jī)器人100（車體1）外部邊緣處，具體地說，可以設(shè)置在車體1（車身11）的四個(gè)角上，如圖2所示，當(dāng)機(jī)器人100在一矩形斜坡上行駛時(shí)，距離傳感器413前端朝向矩形斜坡方向。距離傳感器413連接至處理器42；用以實(shí)時(shí)采集距離傳感器413與矩形斜坡的距離數(shù)據(jù)；處理器42根據(jù)距離傳感器413與所述矩形斜坡的距離數(shù)據(jù)，判斷車體1是否位于所述矩形斜坡的邊緣處或角落處。

在本實(shí)施例中，距離傳感器413數(shù)目為四個(gè)，分別設(shè)置于機(jī)器人（車體）的四個(gè)角落處；當(dāng)只有兩個(gè)距離傳感器413能采集到所述距離數(shù)據(jù)時(shí)，處理器42判定機(jī)器人（車體）位于矩形斜坡300的邊緣處，向動(dòng)力系統(tǒng)3發(fā)出至少一轉(zhuǎn)向指令（U字回轉(zhuǎn)）；當(dāng)只有一個(gè)距離傳感器采集到所述距離數(shù)據(jù)時(shí)，所述處理器判定機(jī)器人（車體）位于矩形斜坡300的某一角落處，向動(dòng)力系統(tǒng)3發(fā)出至少一轉(zhuǎn)向指令（90度轉(zhuǎn)彎或U字回轉(zhuǎn)）。四個(gè)距離傳感器413也可以分別設(shè)置于車體1每一側(cè)邊的中部，處理器發(fā)現(xiàn)某一側(cè)邊上的距離傳感器413無法采集到距離數(shù)據(jù)時(shí)，就可以判斷這一側(cè)邊位于矩形斜坡的邊緣處；如果有兩個(gè)相鄰的側(cè)邊皆位于矩形斜坡邊緣處，就可以判斷車體1位于太陽能面板的某一角落處。距離傳感器413數(shù)目也可以為八個(gè)，分別設(shè)置于車體1的四個(gè)角落處或車體1四個(gè)方向側(cè)邊的中部。

控制系統(tǒng)4還可以包括一計(jì)數(shù)器414，用以計(jì)算車體1在斜坡平面行駛中經(jīng)過的角落，在機(jī)器人的一次工作中，每當(dāng)處理器42判斷出車體到達(dá)某一角落時(shí)，就在計(jì)數(shù)器上加一。處理器42通過計(jì)數(shù)器414反饋的技術(shù)結(jié)果可以清楚地知道車體1到達(dá)的角落的順序（第幾個(gè)角落）。

工作人員預(yù)先將規(guī)劃好的優(yōu)化路徑錄入至控制系統(tǒng)4的存儲(chǔ)器，所述處理器并根據(jù)所述導(dǎo)航路徑和機(jī)器人（車體）的實(shí)時(shí)位置向動(dòng)力系統(tǒng)3發(fā)送控制指令，包括啟動(dòng)、停止、直行、向左或向右90度轉(zhuǎn)彎、向左或向右U字回轉(zhuǎn)（轉(zhuǎn)到相鄰車道上的180度轉(zhuǎn)彎），以控制車體在行進(jìn)中按照導(dǎo)航路徑行駛。

數(shù)據(jù)采集單元41還包括一液位傳感器259，連接至處理器42，用于實(shí)時(shí)采集液體分發(fā)容器25中的液位數(shù)據(jù)，在清掃裝置工作中，控制系統(tǒng)4可以根據(jù)液體分發(fā)容器25內(nèi)的實(shí)時(shí)液位數(shù)據(jù)向抽水泵28發(fā)送至少一抽水泵28控制信號(hào)以啟動(dòng)或停止抽水泵28的運(yùn)行，或者控制液體排放速度。例如，當(dāng)液體分發(fā)容器25內(nèi)的實(shí)時(shí)液位數(shù)據(jù)降低到一預(yù)設(shè)閾值時(shí)，控制系統(tǒng)4可以發(fā)出一抽水泵28減速指令，控制抽水泵28減慢抽水速度；當(dāng)液體分發(fā)容器25內(nèi)的實(shí)時(shí)液位數(shù)據(jù)降低到最低點(diǎn)時(shí)，或者，當(dāng)控制系統(tǒng)4發(fā)出一車體停止指令時(shí)，控制系統(tǒng)4可以發(fā)出一抽水泵28停止指令，控制抽水泵28停止運(yùn)行。

控制系統(tǒng)4還包括至少一報(bào)警單元44，連接至處理器42，報(bào)警單元44可以為設(shè)置在車體外部的一紅燈或蜂鳴器。當(dāng)某一工作參數(shù)超過設(shè)定閾值時(shí)，所述報(bào)警單元發(fā)出報(bào)警信號(hào)，例如，當(dāng)液體分發(fā)容器25中的液位數(shù)據(jù)低于某一預(yù)設(shè)閾值時(shí)，或者當(dāng)電力系統(tǒng)5電力不足時(shí)，或者當(dāng)所述清掃機(jī)器人發(fā)出故障時(shí)，報(bào)警單元44都可以發(fā)出報(bào)警信號(hào)以提醒用戶。

數(shù)據(jù)采集單元41包括至少一影像傳感器415或攝像頭，連接至處理器42，設(shè)置于車體1前端（如圖2、圖3所示），用以采集車體1行進(jìn)過程中車體1前方的影像，這些影像可以存儲(chǔ)至所述存儲(chǔ)單元以便于工作人員查看機(jī)器人的工作狀態(tài)。

本實(shí)施例中，控制系統(tǒng)4的技術(shù)效果在于，提供多種清潔機(jī)器人在太陽能面板上行進(jìn)的優(yōu)化路徑以及機(jī)器人在斜坡平面直線行進(jìn)的控制方法，確保機(jī)器人可以不重復(fù)地走過太陽能面板的全部空間，覆蓋面積大，不會(huì)從太陽能面板邊緣處落下，既可以保證了清潔效果，又可以保證工作效率。

太陽能面板清掃機(jī)器人100還可以包括至少一無線通信單元45，無線連接至一服務(wù)器400，用于在太陽能面板清掃機(jī)器人100與服務(wù)器400之間建立通信。車體1前方的影像可以實(shí)時(shí)發(fā)送至服務(wù)器400，以便于工作人員實(shí)現(xiàn)清掃機(jī)器人在工作進(jìn)程中的有效查看，有效解決現(xiàn)有技術(shù)中太陽能面板位于高處時(shí)，清掃機(jī)器人在面板上工作狀態(tài)監(jiān)控困難的技術(shù)問題。

在本實(shí)施例中，如圖3所示，電力系統(tǒng)5為一個(gè)或一組設(shè)置在電池盒51內(nèi)的一次性電池或可充電電池（圖未示），需要工作人員定期將所述清掃機(jī)器人從太陽能面板上取下，對(duì)其進(jìn)行更換電池處理或充電處理，使其可以繼續(xù)工作。

本實(shí)施例提供一種太陽能面板清掃機(jī)器人，可以在太陽能面板上自由運(yùn)行，有效去除面板上的灰塵及其他附著物，去污效果良好；本實(shí)用新型的清掃機(jī)器人在太陽能面板上運(yùn)行過程中，按照設(shè)定的優(yōu)化路徑行駛，可以不重復(fù)地覆蓋面板的全部空間，工作效率高；本實(shí)用新型的清掃機(jī)器人可以根據(jù)程序自動(dòng)轉(zhuǎn)彎或調(diào)頭，實(shí)現(xiàn)自動(dòng)控制，操作方便。

以上所述僅是本實(shí)用新型的優(yōu)選實(shí)施方式，應(yīng)當(dāng)指出，對(duì)于本技術(shù)領(lǐng)域的普通技術(shù)人員，在不脫離本實(shí)用新型原理的前提下，還可以做出若干改進(jìn)和潤(rùn)飾，這些改進(jìn)和潤(rùn)飾也應(yīng)視為本實(shí)用新型的保護(hù)范圍。