《家用擦玻璃清潔機(jī)器人結(jié)構(gòu)設(shè)計畢業(yè)設(shè)計說明書》由會員分享，可在線閱讀，更多相關(guān)《家用擦玻璃清潔機(jī)器人結(jié)構(gòu)設(shè)計畢業(yè)設(shè)計說明書（56頁珍藏版）》請在裝配圖網(wǎng)上搜索。

1、河北工業(yè)大學(xué)2015屆本科畢業(yè)設(shè)計說明書 河 北 工 業(yè) 大 學(xué) 畢業(yè)設(shè)計說明書 作 者： 焦然 學(xué) 號： 111122 學(xué) 院： 機(jī)械工程學(xué)院 系(專業(yè))： 機(jī)械設(shè)計制造及其自動化 題 目： 家用擦玻璃清潔機(jī)器人結(jié)構(gòu)設(shè)計 指導(dǎo)者： 李輝 講師

2、 (姓 名) (專業(yè)技術(shù)職務(wù)) 評閱者： (姓 名) (專業(yè)技術(shù)職務(wù)) 2015 年 5 月 31 日 畢業(yè)設(shè)計中文摘要 家用擦玻璃清潔機(jī)器人結(jié)構(gòu)設(shè)計 摘要： 隨著時代的進(jìn)步，科技的發(fā)展，智能家居越來越流行，與此同時，智能機(jī)器人也如火如荼地發(fā)展起來，人們越來越注重智能化，自動化。 同時，人們住的樓層也越來越高，擦玻璃變成了很難辦的事情，本人自主研發(fā)設(shè)計了一款全自動民用擦玻璃小車，該小車

3、啟動之后，小車能夠同時對玻璃里外側(cè)進(jìn)行全自動擦拭。 本文首先闡述了本課題的背景以及國內(nèi)外發(fā)展概況，接著描述了擦玻璃機(jī)器人的整體方案的確定以及詳細(xì)機(jī)械結(jié)構(gòu)的設(shè)計，然后闡述了本課題控制系統(tǒng)的設(shè)計，最后介紹了機(jī)器人實體樣機(jī)的調(diào)試。 本課題主要完成的工作： （1）設(shè)計加工擦玻璃機(jī)器人的機(jī)械結(jié)構(gòu)并進(jìn)行實體裝配。 （2）基于STC12單片機(jī)，設(shè)計PCB板，加工并焊接零件，然后編程燒寫，上機(jī)調(diào)試。 關(guān)鍵詞： 機(jī)器人 全自動 實體裝配 單片機(jī) PCB 畢業(yè)設(shè)計（論文）外文摘要 Title Structure design of household cle

4、aning robot for cleaning glass Abstract Along with the progress of the times, the development of science and technology, the home automation is more and more popular, meanwhile, the intelligent robot is also in full swing, people pay m

5、ore and more attention to intelligent automation. At the same time, the floors which people live in are also getting higher and higher, wiping the glass becomes a troublesome thing, I design a fully automatic civil car to wipe glass in my research and development, when the car is started, it can wi

6、pe the glass outside and inside automatically at the same time. The background and foreign development situation are described in this paper at first, after representing the determination of the overall scheme of glass cleaning robot and detailed mechanical structure design, then the design of cont

7、rol system of the subject is elaborated on, at last, the debugging of the prototype robot entity is introduced in this paper. The main work of this thesis: (1) designing and processing the mechanical structure of glass robot and assemble the entity. (2) based on STC12 microcontroller, desi

8、gning PCB board, processing and welding parts, and then programming and debugging the machine. Keywords： robot automatic entity assembly MCU PCB 目 錄 第一章 引言 ……………………………………………………………… 1 1.1 課題背景……………………………………………………………1 1.2 國內(nèi)外擦玻璃機(jī)器人的研究概況…………………………………1 1.3 本課題的主要工作………………

9、…………………………………3 第二章 家用擦玻璃清潔機(jī)器人總體方案設(shè)計 …………………………… 3 2.1 家用擦玻璃清潔機(jī)器人的設(shè)計原則…………………………………4 2.2 家用擦玻璃清潔機(jī)器人的總體方案的確定…………………………4 2.2.1 家用擦玻璃清潔機(jī)器人的總體方案……………………………4 2.2.2 總體方案的對比與選擇…………………………………………12 第三章 家用擦玻璃清潔機(jī)器人詳細(xì)結(jié)構(gòu)設(shè)計………………………………14 3.1 關(guān)鍵部件的選型………………………………………………………14 3.1.1 電機(jī)的選型…………………………………………

10、……………14 3.1.2 微動開關(guān)的選型…………………………………………………15 3.1.3 電池的選擇………………………………………………………15 3.1.4 磁鐵的選擇………………………………………………………16 3.2 微動開關(guān)緩沖機(jī)構(gòu)的設(shè)計……………………………………………16 3.3 磁鐵升降機(jī)構(gòu)的設(shè)計…………………………………………………17 3.3.1 磁鐵升降機(jī)構(gòu)的ANSYS分析……………………………………18 第四章 家用擦玻璃清潔機(jī)器人控制系統(tǒng)設(shè)計………………………………21 4.1 單片機(jī)控制系統(tǒng)電路的設(shè)計……………

11、………………………… 21 4.1.1 單片機(jī)系統(tǒng)元器件的選型…………………………………… 21 4.1.2 單片機(jī)系統(tǒng)的硬件電路及I/O口分配……………………… 25 4.2 單片機(jī)系統(tǒng)編程框圖……………………………………………… 25 第五章 家用擦玻璃清潔機(jī)器人樣機(jī)研制與調(diào)試……………………………27 5.1控制電路板的設(shè)計與調(diào)試……………………………………………27 5.1.1 PCB設(shè)計…………………………………………………………27 5.1.2 電路板的調(diào)試……………………………………………………28 5.2 家用擦玻璃清潔機(jī)器人樣機(jī)的

12、制作…………………………………31 5.3 家用擦玻璃清潔機(jī)器人樣機(jī)的測試…………………………………31 第六章 總結(jié)與展望……………………………………………………………33 參考文獻(xiàn)……………………………………………………………………… 34 致謝…………………………………………………………………………… 35 附錄…………………………………………………………………………… 37 IV 1 引言 1.1 課題背景 智能家居近兩年發(fā)展火熱，作為其重要組成部分的智能服務(wù)機(jī)器人也不甘示弱，伴隨著計算機(jī)和自動化

13、技術(shù)的迅速發(fā)展,人們對機(jī)器人的智能性的要求也越來越高，同時智能服務(wù)機(jī)器人產(chǎn)業(yè)近年來也陸續(xù)被寫入國家發(fā)展戰(zhàn)略。2006年,發(fā)展智能服務(wù)機(jī)器人被列入《國家中長期科學(xué)和技術(shù)發(fā)展規(guī)劃綱要(2006-2020年)》; 2012年,我國出臺《智能制造科技發(fā)展“十二五”專項規(guī)劃》和《服務(wù)機(jī)器人科技發(fā)展“十二五”專項規(guī)劃》，足見我國對機(jī)器人行業(yè)發(fā)展的重視。 在智能機(jī)器人如火如荼得發(fā)展過程中，目前具有一定的智能性的清潔機(jī)器人也成為研究熱點(diǎn)之一,智能清潔機(jī)器人系統(tǒng)的研究在發(fā)達(dá)國家受到廣泛的關(guān)注,許多高科技應(yīng)用領(lǐng)域,以及實際生產(chǎn)實踐中的特殊應(yīng)用環(huán)境的強(qiáng)烈需求更成為它不斷發(fā)展的強(qiáng)勁動力。 近年來,都市中的高層建筑

14、越來越多,目前對高層建筑的玻璃窗的清洗工作主要還是由清洗工人搭乘吊籃完成的,傳統(tǒng)的人工清洗方式既危險,效率又低且成本高，但如果自己清洗的話不僅有危險而且費(fèi)時費(fèi)力，況且現(xiàn)在更多的人們希望從繁瑣的日常事務(wù)中解放出來，因此迫切需要一種設(shè)備協(xié)助甚至替代人來完成玻璃的清洗工作。 1.2 國內(nèi)外擦玻璃機(jī)器人的研究概況 眾所周知，日本是機(jī)器人發(fā)展較為發(fā)達(dá)的國家，其對智能機(jī)器人的研究實力雄厚，值得我們學(xué)習(xí)，下圖的多用途壁面機(jī)器人是一個日本開發(fā)的清潔機(jī)器人的范例：該機(jī)器人自重100kg，同時可載150kg負(fù)重，小車的車輪上具有磁性設(shè)計，采用磁吸附方式吸附在墻壁上，可直接越過坑洼不平的墻面以及其他墻上的不明障

15、礙物，多用于橋墩底部、玻璃幕墻等檢測和修復(fù)作業(yè)。 1 圖1.1 多用途壁面機(jī)器人 圖1.2 雙車體機(jī)器人 上圖的雙車體機(jī)器人也是由日本人研制，其采用負(fù)壓吸盤吸附，在運(yùn)行過程中吸盤與壁面之間產(chǎn)生有滑動密封效果，強(qiáng)大的大氣壓能夠保證小車不會從墻壁上滑落，由四個高摩擦系數(shù)的輪子貼合在墻壁面上，在吸盤保持負(fù)壓的過程中，機(jī)器人通過控制輪子的正反轉(zhuǎn)控制機(jī)器人的行走方向，輪子的差速保證了機(jī)器人的轉(zhuǎn)彎功能的實現(xiàn)，且由于四個輪子均為獨(dú)立控制，所以該機(jī)器人控制起來顯得格外靈活。 不僅國外有類似的清潔機(jī)器人，國內(nèi)雖然起步較晚，但也已

16、經(jīng)有了相對成熟的東西，圖1.3為北京航空航天大學(xué)機(jī)器人研究所研制的用于清洗國家大劇院玻璃幕墻的樣機(jī)，圖上所示為該機(jī)器人工作在國家大劇院的場景，其由攀爬機(jī)構(gòu)、俯仰調(diào)節(jié)機(jī)構(gòu)、移動機(jī)構(gòu)和清洗機(jī)構(gòu)等部分構(gòu)成，總長約3m, 高0.5m，寬1m, 整個機(jī)身主體由鋁型材搭建而成，不僅強(qiáng)度高而且相對重量也輕了許多，其在工作過程中把安裝在建筑物上的滑動導(dǎo)桿作為中介，成功避免了機(jī)器人對建筑物的直接抓取所可能帶來的損傷以及其他不安全因素。 圖1.3北航清潔機(jī)器人 通過對上述文獻(xiàn)的分析，無論是國外的多用途壁面機(jī)器人還是國內(nèi)的清洗機(jī)器人，在體積及重量上都相對較大，多用途壁面機(jī)器人本身就重達(dá)100kg，顯然這個重

17、量是普通家庭玻璃難以承受的，而北航機(jī)器人研究所所研發(fā)的清潔機(jī)器人樣機(jī)高度竟然達(dá)到了2.9米,這對于比較寬闊的玻璃幕墻來說,清洗起來確實方便、迅速，但是對于一些普通的家庭玻璃窗來說,這明顯是不合適的。 1.3 本課題的主要工作 本設(shè)計擬在設(shè)計一款機(jī)器人，該機(jī)器人能夠?qū)崿F(xiàn)全自動擦拭家庭玻璃的功能，而且需確保擦拭無死角且擦拭干凈。 具體工作如下： （1）進(jìn)行機(jī)器人機(jī)械結(jié)構(gòu)設(shè)計，繪制機(jī)器人的三維圖，并在三維圖的基礎(chǔ)上導(dǎo)出其二維圖，然后進(jìn)行ansys分析工作，以確保機(jī)械結(jié)構(gòu)的合理性。 （2）聯(lián)系廠家進(jìn)行機(jī)械部件的加工，并將各個部件進(jìn)行實體裝配。 （3）設(shè)計PCB板子并聯(lián)系廠家加工以作為控制機(jī)

18、器人的硬件。 （4） 基于單片機(jī)控制系統(tǒng)進(jìn)行C語言編程，以完成整個機(jī)器人的擦拭功能。 （5）將機(jī)器人在玻璃上進(jìn)行上機(jī)調(diào)試，完善程序，確保機(jī)器人能夠?qū)⒉ＡР潦酶蓛簟? 2 家用擦玻璃清潔機(jī)器人總體方案設(shè)計 2.1 家用擦玻璃清潔機(jī)器人的設(shè)計原則 家庭用擦玻璃機(jī)器人在國內(nèi)還比較少，國外雖然做的相對成熟但產(chǎn)品一般比較昂貴，并不能實現(xiàn)普及到國內(nèi)的大部分家庭中愿景，因此，我們要設(shè)計一款具有自主知識產(chǎn)權(quán)的成品低廉的擦玻璃機(jī)器人，與此同時，本課題的設(shè)計過程中也要保證如下原則： （1）該機(jī)器人能夠?qū)崿F(xiàn)擦拭各種厚度的玻璃的工作，而且各個部件具有較好的互換性，以便維修。 （2）各零件應(yīng)便于裝配，

19、便于加工。 （3）機(jī)器人應(yīng)操控簡單，可以實現(xiàn)無線控制。 （4）機(jī)器人真正實現(xiàn)智能化，能夠全自動地將自己的擦拭任務(wù)完成。 2.2 家用擦玻璃清潔機(jī)器人的總體方案的確定 在經(jīng)過無數(shù)的文獻(xiàn)查閱以及自己的思考工作之后，我已經(jīng)對擦玻璃機(jī)器人有了進(jìn)一步的認(rèn)識，經(jīng)過對文獻(xiàn)的整合以及自己的創(chuàng)新，我最終確定了以下幾套相對可行的方案。 2.2.1 家用擦玻璃清潔機(jī)器人的總體方案 總體方案一： 圖2.1 仿人形擦玻璃機(jī)器人 如上圖所示，將擦玻璃機(jī)器人做成完全仿人型的自動化機(jī)器，機(jī)器人的手上安裝有擦拭玻璃的抹布以及刷子等，通過對機(jī)器人的示

20、教編程，機(jī)器人能夠記住各個關(guān)節(jié)的角度，以及擦玻璃的運(yùn)行模式，就能夠達(dá)到全自動擦拭的目的。 機(jī)器人底部由四個輪子支撐，其中包括兩個具有驅(qū)動能力的動力輪和兩個萬向輪，這樣能夠在運(yùn)用最少的驅(qū)動的前提下，確保機(jī)器人具有前往各個方向運(yùn)行的能力，與此同時機(jī)器人的各個輪子均具有升降功能，即能夠確保機(jī)器人在相對不平的地板上能夠自由地運(yùn)行；然后往上看是機(jī)器人的中干，其腰部由具有三個自由度的旋轉(zhuǎn)桿構(gòu)成，其機(jī)構(gòu)簡圖如圖2.2所示 圖2.2 機(jī)器人中干結(jié)構(gòu)簡圖 正如圖2.2中表達(dá)的那樣，機(jī)器人的腰部底端具有一個豎直的旋轉(zhuǎn)副，再往上具有兩個水平的旋轉(zhuǎn)副，

21、到此該空間開鏈機(jī)構(gòu)給機(jī)器人的末端執(zhí)行機(jī)構(gòu)-擦拭手爪，提供的自由度為3。 圖 2.3 機(jī)器人上肢結(jié)構(gòu)簡圖 圖2.3所示機(jī)構(gòu)見圖為機(jī)器人的上半部分，其中支架的旋轉(zhuǎn)副代表機(jī)器人的肩關(guān)節(jié)，然后以下關(guān)節(jié)依次代表機(jī)器人的肘關(guān)節(jié)和腕關(guān)節(jié)，不難看出，該部分機(jī)構(gòu)給機(jī)器人末端執(zhí)行構(gòu)件提供的自由度為3，而整個機(jī)器人的機(jī)構(gòu)為空間開鏈機(jī)構(gòu)，所以綜上所述可以得出，機(jī)器人的自由度為6，可以實現(xiàn)各種所需要的空間動作。 總體方案二： 采用永磁式的雙面吸附小車貼在玻璃兩側(cè)的運(yùn)動來實現(xiàn)擦玻璃的功能。小車分為兩個部分：包括主動小車和從動小車，其分別位于玻璃的內(nèi)側(cè)和外側(cè)，通過相互間強(qiáng)磁鐵的吸附來保證小車貼在玻璃上不會滑落，

22、巧妙的編程給了小車靈魂，通過主動一側(cè)帶動從動一側(cè)在玻璃上按照程序中編寫的路徑行走，并在移動過程中通過兩面小車底盤的擦拭裝置將玻璃擦拭干凈。 圖2.4 正面小車整體效果圖 圖2.5 正面小車內(nèi)部圖 圖2.4圖2.5為正面小車三維圖，其中小車總長260mm，總寬228mm。 如圖2.5所示，該圖為正面小車的內(nèi)部結(jié)構(gòu)圖，其中四塊強(qiáng)磁鐵吸附在鐵質(zhì)的升降架子上，而架子則通過螺桿與升降旋鈕相連接，升降旋鈕的底部與外殼上部相接觸，因此，當(dāng)旋動旋鈕，在外殼的支撐作用下，升降架便能帶動磁鐵完成升降動作；在反面小車上，也存在四塊磁鐵，該四塊磁鐵與正面的磁鐵均為N S極相對，

23、產(chǎn)生強(qiáng)大的吸引力，通過升降機(jī)構(gòu)的調(diào)節(jié)，能夠很方便得調(diào)整正反面磁鐵之間的距離，從而達(dá)到手動調(diào)節(jié)兩面小車間的吸引力的目的以適應(yīng)擦拭不同厚度玻璃時的情況。 小車的動力來源于分布在小車兩側(cè)的直流減速電機(jī)，兩個小車的輪胎緊緊壓在玻璃上，通過對電機(jī)正反轉(zhuǎn)的調(diào)節(jié)完成小車在玻璃上前進(jìn)以及倒退的動作，同時通過兩輪的差速調(diào)節(jié)完成小車的轉(zhuǎn)彎動作。 圖2.6 磁鐵的旁邊是小車的微動開關(guān)緩沖機(jī)構(gòu)，如圖2.6所示，當(dāng)小車在運(yùn)行中一端頂?shù)酱皯暨吙驎r，緩沖架向小車內(nèi)部移動，并觸動微動開關(guān)，此時被觸動的微動開關(guān)觸發(fā)小車的其他動作，當(dāng)小車的這一端離開窗戶邊框時，在彈簧的作用下，緩沖架恢復(fù)到初始狀態(tài)，微動開關(guān)撥

24、片也隨著彈開了，能夠避免該微動開關(guān)一直觸動小車去做相同的動作所造成的死機(jī)。 圖2.7 反面小車的整體效果圖 圖2.8 反面小車內(nèi)部圖 圖2.7圖2.8為反面小車的圖，其中小車總長229mm，總寬200mm。 該面小車為隨動面，即完全靠正面小車的吸引力作為動力在玻璃上完成整套擦拭動作。 總體方案三： 與方案二相類似，依舊采用雙面小車吸附在玻璃上的方式來擦拭玻璃，但是本人在方案二的基礎(chǔ)上對小車做了進(jìn)一步結(jié)構(gòu)優(yōu)化，整體的機(jī)械結(jié)構(gòu)變得更加緊湊，沒有產(chǎn)生任何多余的浪費(fèi)的空間。 圖2.9 正面小車整體效果圖 圖2.10 正面小車內(nèi)部圖 圖2.9、2.10為

25、正面小車圖，其中小車總長178mm，總寬190mm。 圖2.11 反面小車整體效果圖 圖2.12 反面小車內(nèi)部效果圖 圖2.11、2.12為反面小車圖，其中小車總長160mm，總寬172mm。 在本方案中，磁鐵升降機(jī)構(gòu)置于反面，且微動開關(guān)的安裝結(jié)構(gòu)相比上一方案更加緊湊，從總體來看，無論長度，寬度還是高度的尺寸都比上一方案小巧了好多，使用起來更加便捷。 2.2.2 總體方案的對比與選擇 綜合分析以上三種方案，雖然方案一在表面上看著更加直接，更加可信，其實它存在著天生的弊端：首先，方案一設(shè)計制作工序繁瑣，工程龐大，編程復(fù)雜，雖然做的是一個仿人型的機(jī)器人，但完成的功能則只

26、有擦玻璃而已，實則是大材小用，也可以說并不是針對要完成的擦玻璃功能的專一化設(shè)計，所以并不能為人所采用；而且，方案一的機(jī)器人還有另一個致命的缺點(diǎn)，那就是它雖然能很好的擦拭屋內(nèi)一面的玻璃，但是對窗外一面的玻璃則全然束手無策。而對方案二來說它有自己的優(yōu)點(diǎn)，那就是相比方案一來說它已經(jīng)做了實質(zhì)性改變：將擦玻璃的動作轉(zhuǎn)化為小車的來回運(yùn)動，雖然擦玻璃工作的順序看似很復(fù)雜無章，但其實還是有規(guī)律可循，只要適當(dāng)?shù)臍w納總結(jié)便能歸結(jié)出合適的運(yùn)動路徑，換言之，通過恰當(dāng)?shù)木幊虂砜刂菩≤囋诓Ａ闲凶叩穆窂?，車到之處，玻璃變得干干凈凈，這樣不僅能起到自動擦玻璃的效果，而且能夠同時擦拭雙面的玻璃，節(jié)約了擦玻璃的時間，而且也解決

27、了城市居民窗外一側(cè)玻璃難擦的困擾，同時相比方案一極大地節(jié)約了成本，使其量產(chǎn)成為可能。 依據(jù)以上的論述，我們決定采用雙面吸附小車擦玻璃的方式來實現(xiàn)功能，那對比方案二和方案三，很明顯方案三中的小車，體積更小，結(jié)構(gòu)更加緊湊，小車也更加輕便，更能夠讓現(xiàn)在生活空間不大的城市居民所接受，圖2.13為小車吸附在玻璃上的效果圖。 圖2.13 玻璃吸附效果圖 步驟1 步驟2 圖2.14 小車工作流程圖 如圖2.14所示，小車的工作步驟為： ① 將雙面小車置于玻璃上，令其頭部大致朝上。 ② 調(diào)節(jié)磁鐵升降機(jī)構(gòu)，以確保磁鐵的吸引力能夠保證小車在玻璃上平穩(wěn)運(yùn)行。 ③ 打開電源開關(guān)，按下紅外

28、線遙控器的開始按鈕。 ④ 小車在程序的驅(qū)動下，自己運(yùn)行，首先完成步驟一：小車向上行駛，當(dāng)碰到上邊框后停止，然后經(jīng)過一段延時，小車后退一個車身，然后通過車輪差速，右輪轉(zhuǎn)動而左輪不轉(zhuǎn)，小車成功實現(xiàn)轉(zhuǎn)彎當(dāng)小車水平后停止。 ⑤小車完成步驟二：在步驟一的基礎(chǔ)上小車前行，當(dāng)碰到窗戶左邊框后小車停止，然后小車倒退直行，在陀螺儀的驅(qū)動下保證平穩(wěn)直至碰到右邊邊框停止，然后小車?yán)貌钏僭硐蛳罗D(zhuǎn)動，然后將車頭調(diào)正后再向左直行，如此往復(fù)，直至小車的邊框碰到窗戶的下邊框時停止，至此整塊玻璃的正反面已被小車擦拭干凈。 第三章 家用擦玻璃清潔機(jī)器人詳細(xì)結(jié)構(gòu)設(shè)計 3.1 關(guān)鍵部件的選型 3.1.1 電機(jī)的

29、選型 根據(jù)該小車的工作方式，可以計算得出，該小車所需的動力扭矩為： 根據(jù)以上計算的數(shù)據(jù)，在下表選擇電機(jī)扭矩為8.8NM，即兩個電機(jī)扭矩之和為17.6NM，遠(yuǎn)大于所需要的扭矩，因此選用該電機(jī)滿足使用要求。 圖3.1 電機(jī)參數(shù)表 3.1.2 微動開關(guān)的選型 圖3.2 微動開關(guān)實物圖 KW10-Z1P開關(guān)體長度12.8毫米，寬度5.8毫米，高6.5毫米；不銹鋼壓片長13.5毫米，寬3.75毫米，厚0.28毫米；腳長3.5毫米，寬0.85毫米，厚0.56毫米；耐壓125V1A；安裝孔2毫米大，孔中心距6.5毫米。 該微動開關(guān)只需接出兩根線，其中一根GND

30、一根常開線，當(dāng)不銹鋼壓片沒有被壓下時，兩根線相當(dāng)于斷路，當(dāng)壓片被壓下時，兩根線接通，觸發(fā)小車動作。 3.1.3 電池的選擇 圖3.3 電池參數(shù)圖 小車的電機(jī)為12V直流減速電機(jī)，所以綜合考慮之下電池的選擇參數(shù)如上所示。 3.1.4 磁鐵的選擇 兩面小車均依靠磁鐵的吸引力吸附在玻璃兩側(cè)，所以選擇永磁鐵的規(guī)格很重要，如果磁鐵的吸引力過大，會導(dǎo)致電機(jī)支座甚至電機(jī)的損壞，但如果其吸引力過小又會導(dǎo)致小車車輪與玻璃間摩擦力太小，從而引起小車的打滑現(xiàn)象，甚至滑離玻璃，經(jīng)過一番實驗驗證，我選擇的磁鐵規(guī)格為：材質(zhì)：釹鐵硼稀土永磁，電鍍涂層:鍍鎳，性能:N535，最大耐溫:80，形狀規(guī)格:40

31、X30X10MM，正反面小車分別各裝有四塊該永磁鐵，由于釹鐵硼稀土材料做的磁鐵磁力很大，所以在小車中磁鐵全都被封裝了起來以防止發(fā)生意外。 3.2 微動開關(guān)緩沖機(jī)構(gòu)的設(shè)計 圖3.4 緩沖機(jī)構(gòu)正面圖 圖3.5 緩沖機(jī)構(gòu)反面圖 圖3.6 緩沖機(jī)構(gòu)正面細(xì)節(jié)圖 圖3.7 緩沖機(jī)構(gòu)反面細(xì)節(jié)圖 微動開關(guān)緩沖機(jī)構(gòu)如上圖所示，四只扭簧相互配合起到了將擋板控制在恰當(dāng)?shù)钠胶馕恢玫淖饔?，同時，當(dāng)小車走到玻璃的盡頭，擋板將微動開關(guān)1、2壓下，為了避免小車一直執(zhí)行微動開關(guān)1、2觸動下的程序，當(dāng)小車離開窗戶邊緣后，在扭簧1、2的共同作用下，擋板被彈

32、開回到初始位置；同理扭簧3、4也是這樣工作的。 該機(jī)構(gòu)設(shè)置了卡槽，正是這一對卡槽對擋板起到了限位作用，當(dāng)小車撞到窗戶邊界時，有了卡槽的保護(hù)，能夠防止微動開關(guān)不會被擋板撞壞，同時，擋板上端的卡槽和下端的伸出端配合起來起到了限制擋板上下躥動的作用。 3.3 磁鐵升降機(jī)構(gòu)的設(shè)計 圖3.8 升降機(jī)構(gòu)細(xì)節(jié)圖 磁鐵升降機(jī)構(gòu)是小車很重要的一個構(gòu)件，通過旋轉(zhuǎn)旋鈕，螺桿被擰入旋鈕中，在外殼的支撐下以及導(dǎo)向桿的導(dǎo)向作用下，升降架豎直升起，進(jìn)而調(diào)節(jié)反面小車的磁鐵到玻璃的距離來調(diào)節(jié)兩個小車間的吸引力，從而保證機(jī)器人能夠承擔(dān)不同厚度的玻璃的擦拭工作。 圖3.9 升降支架圖 3.3.1 磁

33、鐵升降機(jī)構(gòu)的ANSYS分析 圖3.10 ANSYS參數(shù)設(shè)置圖 將磁鐵升降機(jī)構(gòu)的三維文件導(dǎo)入到ANSYS中并對模型參數(shù)進(jìn)行設(shè)置如上圖所示，該零件為3D打印件，其材料為玻璃纖維參數(shù)為：抗拉強(qiáng)度（Tensile Strength）：44Mpa；彈性模量（Elastic Modulus）：3500 ~ 7800Mpa（取其為5000Mpa）；泊松比為0.25，然后設(shè)置其受力參數(shù)，四塊磁鐵的吸引力大約為60N，即每塊磁鐵對于升降機(jī)構(gòu)的壓力為15N，可得出其壓強(qiáng)為 然后對物件進(jìn)行網(wǎng)格劃分，其結(jié)果如圖所示： 圖3.11 ANSYS網(wǎng)格劃分圖 圖3.13第二主應(yīng)力圖

34、 圖3.12第一主應(yīng)力圖 經(jīng)過計算機(jī)的計算，結(jié)果如下： 圖3.15 整體應(yīng)力圖 圖3.14 第三主應(yīng)力圖 由以上分析可知，該機(jī)構(gòu)所受的最大應(yīng)力為，比該材料的許用應(yīng)力小很多，因此從這個角度看，該設(shè)計滿足應(yīng)力的限制要求。 以下為該機(jī)構(gòu)在各個方向的位移圖： 圖3.16 X方向位移圖 圖3.17 Y方向位移圖 圖3.19 整體位移圖 圖3.18 Z軸方向位移圖 第四章 家用擦玻璃清潔機(jī)器人控制系統(tǒng)設(shè)計 4.1 單片機(jī)控制系統(tǒng)電路的設(shè)計 4.1.1 單片機(jī)系統(tǒng)元器件的選型

35、（1）CPU的選擇 在本課題中，主控CPU需要實時監(jiān)控2X4的矩陣鍵盤，且需要具有兩路硬件PWM調(diào)速功能，然后還要連接外部紅外模塊以及陀螺儀MPU6050模塊，還要通過L298M芯片去驅(qū)動兩路直流減速電機(jī)等等，考慮到這些功能均需要很協(xié)調(diào)的實現(xiàn)，所以本人選用1T的基于51內(nèi)核的8位單片機(jī)STC12C5A60S2，如圖4.1所示。 圖4.1 單片機(jī)管腳圖 圖4.2 單片機(jī)內(nèi)部結(jié)構(gòu)框圖 該芯片的工作電壓為3.5-5.5V，工作頻率范圍：0～35MHz，相當(dāng)于普通8051的 0～420MHz，片上集成1280字節(jié) RAM，有K的Flash程序存儲器，有兩個定時器T0、T1，擁有獨(dú)

36、立的波特率發(fā)生器，有兩路UART串口，有兩路硬件PWM發(fā)生器，該種封裝擁有40-pin的I/O口，復(fù)位后為：準(zhǔn)雙向口/弱上拉（普通8051傳統(tǒng)I/O口）可設(shè)置成四種模式：準(zhǔn)雙向口/弱上拉，強(qiáng)推挽/強(qiáng)上拉，僅為輸入/高阻，開漏每個I/O口驅(qū)動能力均可達(dá)到20mA，但整個芯片最大不要超過120mA，擁有內(nèi)置EEPOM，內(nèi)部集成MAX810專用復(fù)位電路，內(nèi)置看門狗，具有外部中斷I/O口7路,傳統(tǒng)的下降沿中斷或低電平觸發(fā)中斷。 （2）紅外模塊 紅外模塊用于實現(xiàn)對小車的無線控制，本課題中采用HX1838模塊，該模塊具有寬電壓適應(yīng)、高靈敏度、低功耗、優(yōu)良的抗干擾特性，而且該模塊應(yīng)用廣泛，多用于家用電器

37、、空調(diào)、玩具等紅外遙控接收。 圖4.3 HX1838芯片引腳圖 （3）電機(jī)驅(qū)動模塊 圖4.4 L298M芯片引腳圖 本課題中采用了L298-M電機(jī)驅(qū)動模塊其運(yùn)用全新原裝L298芯片設(shè)計，雙H 橋能夠驅(qū)動2路直流或者1路步進(jìn)電機(jī)，峰值驅(qū)動電流能達(dá) 4A。在L298M芯片底部布置有大面積的金屬散熱片，用以快速散失掉驅(qū)動芯片產(chǎn)生的熱量，以免燒壞芯片。 L298M的使用方法：如果 IN1輸入高電平，OUT1將輸出高電平，如果IN1輸入低電平，OUT1將輸出低電平，同理IN2、 IN3、 IN4的編程方法與之類似。 圖4.5斬波電路圖

38、 圖4.6斬波原理圖 PWM調(diào)速的本質(zhì)便是通過斬波實現(xiàn)改變輸出有效電壓的方式來調(diào)節(jié)電機(jī)的速率，如上圖所示S表示開關(guān)， VD 表示續(xù)流二極管。當(dāng)S閉合時，直流電源電壓 加到電動機(jī)上；當(dāng)S斷開時，直流電源與電機(jī)斷開，電動機(jī)電樞電流經(jīng) VD 續(xù)流，因此兩端電壓接近于零。如此反復(fù)，電樞端電壓波形如圖所示，好像是電源電壓在時間內(nèi)被接上，又在 — 時間內(nèi)被斬斷，所以稱“斬波”。 運(yùn)用該模塊再融合進(jìn)STC12芯片的硬件PWM輸出，用PWM調(diào)制的方法，把恒定的直流電源電壓調(diào)制成頻率一定、寬度可變的脈沖電壓序列，從而可以改變平均輸出電壓的大小，進(jìn)而實現(xiàn)對直流減速電機(jī)

39、的無級調(diào)速。 （4）陀螺儀模塊 本課題中使用的陀螺儀型號為MPU6050，該模塊采用標(biāo)準(zhǔn)的IIC通信協(xié)議，其供電電源為3—5V，內(nèi)部整合了3軸陀螺儀、3軸加速器最大的加速度測量范圍為16g，陀螺儀測量范圍最大為2000/秒，本人利用該模塊反饋Z軸的加速度值去找到模塊與水平方向的夾角，從而在小車一開始向上運(yùn)行的過程中由該值判斷小車的姿態(tài)并通過PWM硬件調(diào)節(jié)兩邊電機(jī)的旋轉(zhuǎn)速率進(jìn)行差速調(diào)速，令小車靈活地不斷地為自己調(diào)平，實現(xiàn)豎直向上的運(yùn)動，同樣運(yùn)用X軸的加速度器反饋回來的值去控制小車在后來階段水平運(yùn)行的過程中的姿態(tài)調(diào)整，真正地實現(xiàn)小車姿態(tài)的閉環(huán)控制。 4.1.2 單片機(jī)系統(tǒng)的硬件電路及I/O口

40、分配 圖4.7 單片機(jī)控制系統(tǒng)原理圖 上圖為我所設(shè)計單片機(jī)控制系統(tǒng)的原理圖，其關(guān)鍵引腳表如下所示 P1.0 P1.1 P1.2 P1.3 OUT4 OUT2 OUT1 OUT3 表4.1 電機(jī)驅(qū)動引腳 P0.2 P0.3 P0.4 P0.5 P0.6 P0.7 ROW1 ROW2 COL1 COL2 COL3 COL4 表4.2 矩陣鍵盤引腳 P2.0 P2.1 SCL SDA 表4.3 MPU6050引腳 4.3 單片機(jī)系統(tǒng)編程框圖 啟動，頭部豎直向上，V左側(cè)=V右側(cè) ，正轉(zhuǎn) 是否收到頭部前測微動開關(guān)信號 驅(qū)動

41、行走單元直線運(yùn)動 否 是 控制單元控制驅(qū)動單元，驅(qū)動行走單元轉(zhuǎn)動，V左側(cè)=V右側(cè) ，反轉(zhuǎn) 延時信號檢測 保持轉(zhuǎn)動 延時未到 延時時間到 控制單元控制驅(qū)動單元，驅(qū)動行走單元停止, 然后驅(qū)動行走單元轉(zhuǎn)動V左側(cè)=0, V右側(cè)>0 , 延時信號檢測 保持轉(zhuǎn)動 延時未到 延時時間到 控制單元控制驅(qū)動單元，驅(qū)動行走單元轉(zhuǎn)動，V左側(cè)=V右側(cè) ，正轉(zhuǎn) 是否收到頭部前測微動開關(guān)信號 控制單元控制驅(qū)動單元，驅(qū)動行走單元轉(zhuǎn)動，V左側(cè)=V右側(cè) ，反轉(zhuǎn) 是否收到尾部后測微動開關(guān)信號 是 陀螺儀檢測信號 否 陀螺儀檢測信號 否 是 步驟100 步驟200 反

42、饋控制，行走單元 反饋控制，行走單元 第五章 家用擦玻璃清潔機(jī)器人樣機(jī)研制與調(diào)試 5.1控制電路板的設(shè)計與調(diào)試 結(jié)合小車的機(jī)械部分所留出來的空間，本課題作者設(shè)計并加工的控制板如下圖所示 圖5.1 控制板實物圖 5.1.1 PCB設(shè)計 圖5.2 PCB設(shè)計圖 上圖即為本課題中所繪制的PCB板子，首先要用altiumdesigner將各個元器件在板子上盡量有序得畫出來，然后把已經(jīng)擁有所有元器件的板子上的元件再進(jìn)行更加合理地排列，然后點(diǎn)擊AutoRoute/All開始自動布線，待布線完畢之后再進(jìn)行手工調(diào)整，到此PCB板大致繪制完成。 5.1.2 電路板的調(diào)試 為防

43、止剛剛焊接完成的板子運(yùn)行起來發(fā)生電路危險，還需要進(jìn)行一系列的硬件測試： （1）測試條件 圖5.3 電源模塊PCB圖 將K1的兩個焊盤短。 （2）電源測試 A) 首先測量J1的兩個焊盤有沒有短路，用二極管檔或者電阻檔測量。若短路，停止一 切測試，檢查原因。 B) 將12V電源的負(fù)極焊接在J1的GND焊盤上，正極懸空。 C) 將萬用表撥到直流20A檔，并將表筆插入對應(yīng)位置。 D) 將萬用表的紅色表筆接在電源的正極上，黑色表筆快速（大約0.5S）連接在電路板J1的+12V焊盤上。觀察萬用表的電流，若電流大于500mA，請停止一切測試，檢查問題

44、。若電流小于500mA，繼續(xù)測試。 E) 若C)中的電流正常（小于500mA），將萬用表撥到直流電壓20V檔，先測試U1的輸入即U1-pin1腳的電壓是否是12V，然后測試5V測試點(diǎn)的電壓是否為5V，若為5V則繼續(xù)測試；否則檢查U1是否為L7805CV并且查看L7805CV的datasheet看其引腳定義是否和PCB上的一致。 F) 測試U9-pin2腳的電壓是否為3.3V，若為3.3V則繼續(xù)下面的測試；否則檢查U9是否為AMS1117-3.3并且查看其datasheet，看其引腳定義是否和PCB上的一致。 圖5.4 電源模塊PCB細(xì)化圖1 圖5.5

45、電源模塊PCB細(xì)化圖2 （3）單片機(jī)最小系統(tǒng)測試 A) 測試U2-pin40腳的電壓是否為5V。 B) 測試U2-pin9腳的電壓是為為5V。 C) 通過USB轉(zhuǎn)TTL模塊給單片機(jī)下載程序，看是否能正常下載。 D) 觀察C)中下載的程序是否正常工作（這個程序一般為LED閃爍測試）。 （4）紅外接收傳感器測試 A) 測量U8-pin3是否為5V。 B) 移植紅外遙控測試程序，檢測紅外接收頭是否工作正常。 圖5.6 紅外線PCB圖 （5）電機(jī)驅(qū)動測試 A) 測量U4-pin6腳是否為12V。 B) 測量U4-pin8

46、、U4-pin12、U4-pin14三個引腳的電壓是否為5V。 C) 將兩個電機(jī)接上，并編寫程序測試該驅(qū)動是否正常工作。 （6）MPU6050測試 A) 測量U5-pin13腳的電壓是否為3.3V。 B) 測量U10-pin2、U10-pin8的電壓是否為3.3V。 C) 測量U10-pin15的電壓是否為5V。 D) 編寫程序讀取MPU6000的數(shù)據(jù)，然后觀察數(shù)據(jù)是否正常。 圖5.7 MPU6000 PCB圖 （7）其他測試 A) 將8路微動開關(guān)焊接到對應(yīng)位置上。 B) 測量U3-pin5、U6-pin5、U7-pin5腳是

47、否為5V。 C) 移植按鍵測試程序，觀察這8個開關(guān)是否可實現(xiàn)共用一個中斷。 圖5.8 微動開關(guān)PCB圖 5.2 家用擦玻璃清潔機(jī)器人樣機(jī)的制作 通過以上一系列的工作，擦玻璃機(jī)器人的設(shè)計工作已經(jīng)宣告完畢，由于零件要求重量輕且需有一定的強(qiáng)度，故3D打印成了最合適的加工方式，其中電機(jī)座和磁鐵升降架所用的材料為玻璃纖維，而其它件均采用光敏樹脂的材料打成，再經(jīng)過實體裝配后，實物圖如下圖所示： 圖5.9 實體樣機(jī)展示圖 5.3 家用擦玻璃清潔機(jī)器人樣機(jī)的測試 圖5.10 機(jī)器人運(yùn)行狀態(tài)1 圖5.11機(jī)器人運(yùn)行狀態(tài)2 圖5.12 機(jī)器人運(yùn)行狀態(tài)3 以上幾

48、圖為機(jī)器人的上機(jī)運(yùn)行情況，機(jī)器人行走較為平穩(wěn)，且各個環(huán)節(jié)均運(yùn)行正常，陀螺儀確實起到了實時調(diào)速的作用，保證了小車始終保持水平姿態(tài)的運(yùn)行，小車最終也是按照程序里面規(guī)劃的路徑將整塊玻璃走完，整個過程實現(xiàn)了全自動化，且擦拭效果良好。 第六章 總結(jié)與展望 本課題自主設(shè)計了一款適用于家庭擦玻璃的機(jī)器人，該機(jī)器人可以在玻璃上全自動運(yùn)行并同時將玻璃擦拭干凈。本課題作者首先閱讀了大量文獻(xiàn)，發(fā)現(xiàn)了國內(nèi)外清潔機(jī)器人存在的一系列弊端，但也發(fā)現(xiàn)了其可取之處，經(jīng)過取長補(bǔ)短以及自己的思考之后得到了自己的方案，然后根據(jù)方案做出了實體樣機(jī)，歸納總結(jié)整個過程，本課題的主要工作有以下幾點(diǎn)

49、： （1）完成了擦玻璃機(jī)器人的整體的機(jī)械結(jié)構(gòu)設(shè)計，并進(jìn)行了加工制作及裝配。 （2）完成了整個機(jī)器的程序編制并將其燒寫在單片機(jī)中，并令小車行走順暢。 （3）利用陀螺儀反饋回小車的位姿并實時對其進(jìn)行閉環(huán)控制。 （4）利用差速原理實現(xiàn)了小車在玻璃上的轉(zhuǎn)彎，并運(yùn)行良好。 樣機(jī)的運(yùn)行結(jié)果表明，以上的努力都得到了應(yīng)有的回報，但是在此基礎(chǔ)上，本人認(rèn)為，有待進(jìn)一步研究的工作還有很多，歸納如下： （1）擦玻璃機(jī)器人屬于智能家居范疇，需要更好的人機(jī)界面才能滿足人們的需求。 （2）由于電機(jī)的原因，小車運(yùn)行起來噪聲較大，需要設(shè)計添加防噪裝置。 （3）陀螺儀的程序還不夠完美，需要進(jìn)一步加上卡爾曼濾波算法

50、，使小車閉環(huán)控制更加精確。 （4）由于小車是上帶有強(qiáng)磁，所以為了避免在使用過程中造成意外，需要添加隔磁裝置。 參考文獻(xiàn) [1] 王巍,張厚祥等.曲面幕墻清潔機(jī)器人攀爬技術(shù)[J]. 北京航空航天大學(xué)學(xué)報,2008，34（1）：17~19 [2] 唐伯雁.自攀爬幕墻清洗機(jī)器人機(jī)械結(jié)構(gòu)的設(shè)計與研究[D]，北京：北京工業(yè)大學(xué)，2005：1~14 [3] 王碩.智能家居中玻璃窗自動清洗裝置的研制[D]，大連：大連工業(yè)大學(xué)，2012：1~5 [4] 錢志源,付莊等.玻璃幕墻清洗機(jī)器人壁面適應(yīng)能力分析[J].上海交通大學(xué)學(xué)報，2006 , 40（7）：

51、1158~1159 [5] 王巍，唐伯雁.倒錐面高層玻璃幕墻清洗機(jī)器人設(shè)計[J]. 北京航空航天大學(xué)學(xué)報， 2006 , 32（6）：738~739 [6] 陳沛富.高樓玻璃幕墻清洗機(jī)器人設(shè)計研究[D]，重慶：重慶大學(xué)，2006：3~8 [7] 胡啟寶.多吸盤式玻璃幕墻清洗機(jī)器人本體設(shè)計[D]，上海：上海交通大學(xué)，2007：17~25 [8] 邵浩,趙言正等. 用于玻璃幕墻清洗作業(yè)的爬壁機(jī)器人系統(tǒng)[J].制造業(yè)自動化, 2000 , 22（2）：6~7 [9] 老楊.51單片機(jī)工程師是怎樣練成的[M].北京：電子工業(yè)出版社，2012 [10] 程國鋼,陳躍琴等.51單片機(jī)典型模塊

52、開發(fā)查詢手冊[M].北京：電子工業(yè)出版社， 2012 [11] J.Kuffner,Jr.,S.Kagmi, K. Nishiweki, M. Inaboa, and H. Inolue, "Dynamically-Stable Motion Planning for Robots," Autonomous Robots, vol.12, pp. 105-118, 2002. [12] Lee,C.S.G.,Robot Arm kingmatics,Dymaies,and Control.Computer,Vol. 15,PP.62-80,1982 [13] 高金蓮.工程圖學(xué)[M].

53、北京：機(jī)械工業(yè)出版社，2008 [14] 何貢.互換性與測量技術(shù)（第二版）[M].北京：中國計量出版社，2005 [15] Daniel.E.Whitney,State Space Task of Remote Manipulation Models, IEEE Trans,Vol.14,pp617-623,No.6,1969 [16] 胡仁喜,王慶五等.ANSYS 8.2機(jī)械設(shè)計高級應(yīng)用實例[M].北京：機(jī)械工業(yè)出版社， 2005 [17] 王碩, 陶學(xué)恒等. 智能家居中玻璃窗自動清洗裝置的研制[J]. 機(jī)械設(shè)計，2011 , 28（12）：21~23 致謝 時間轉(zhuǎn)瞬即

54、逝，不知不覺已經(jīng)到了畢設(shè)最后的日子，我的畢設(shè)差不多也該畫上句號了，我要感謝的人有很多，首先我要感謝我的畢設(shè)老師-張建華老師，正是張老師給了我這次畢設(shè)做實物的機(jī)會，老師給了我一個很大的舞臺，讓我在上面盡情演繹，有多少才華就施展多少才華，當(dāng)然在畢設(shè)路中，也是困難重重，道路坎坷，總會遇到這樣那樣的問題，正是張老師對我的幫助以及在背后不斷的鼓勵才令我有了一直向前進(jìn)的勇氣與力量，張老師嚴(yán)謹(jǐn)?shù)闹螌W(xué)態(tài)度對我影響頗為深刻，同時老師在生活中的細(xì)心，大氣又令我慨嘆，我要以張老師為標(biāo)桿，在以后的學(xué)術(shù)生涯中立志要成為張老師那樣的學(xué)者。 我的畢設(shè)是一個邊學(xué)習(xí)邊應(yīng)用的過程，在這個過程中，正是由于得到了無數(shù)同學(xué)們的幫助才

55、促成我畢設(shè)的結(jié)束，在此，我首先要感謝我的同學(xué)兼我的單片機(jī)老師：陳翔同學(xué)，他的單片機(jī)控制技術(shù)學(xué)的頗為強(qiáng)悍，但他對我一絲不茍的幫助更加令我慨嘆，是他讓我知道了什么是串口，什么是IIC等等，每次無論他多忙，都會不厭其煩地給我解答單片機(jī)的問題，他是我真正亦師亦友的伙伴；另外我要感謝我的師兄：郝建龍和曹建峰，在我的畢設(shè)制作過程中，他們的付出也很多，他們與我一起熬夜，在三維繪圖方面郝建龍師兄也給了我很多指導(dǎo)，促使我的快速進(jìn)步；我還要感謝我的學(xué)長：孫存磊，每次單片機(jī)編程方面遇到問題，孫學(xué)長總能給我最有效的解決辦法，孫學(xué)長也是真正的單片機(jī)大神，同時孫存磊學(xué)長還教會了我學(xué)習(xí)單片機(jī)的方法，正所謂授之以魚不如授之以

56、漁，多謝學(xué)長！還有張瑞寧，瑞寧的焊接板子的技術(shù)著實令我驚訝，在小的不能再小的金屬片上，瑞寧總能用他靈巧的手將焊錫點(diǎn)上，是他教會了我這項技術(shù)。 最后，我要感謝的是我的母校-河北工業(yè)大學(xué)，我四年前踏入河工大的那一刻，我內(nèi)心帶著些許的悲涼，因為我需要去適應(yīng)它的大草原，適應(yīng)草原上的羊群以及羊群旁邊的兩只牧羊犬，適應(yīng)東區(qū)食堂前的臭水溝，適應(yīng)我最初的宿舍東一A211，適應(yīng)學(xué)校的空曠與僅有的幾棟不太起眼的建筑。。。。需要適應(yīng)的太多，但是從現(xiàn)在看來，我完全不用去適應(yīng)，那才是最美的，最無瑕疵的，理由很簡單，因為這樣才是我的母校-河北工業(yè)大學(xué)；還有我還要感謝在河工大工作的教授我們知識的老師們，是他們用辛勤的汗水

57、讓我們學(xué)會了最專業(yè)的知識以及做人的道理，謝謝你們！ 希望河工大越來越漂亮，越來越擔(dān)當(dāng)，越來越輝煌！ 附錄 家庭擦玻璃機(jī)器人C語言程序設(shè)計 #include "STC12C5A.h" #include #include //Keil library #include //Keil library #define uchar unsigned char #define uint unsigned int sbit IN1 =

58、 P1^2; //L298N輸入控制端定義 sbit IN2 = P1^1; //L298N輸入控制端定義 sbit ROW1 = P0^2; sbit ROW2 = P0^3; sbit COL1 = P0^4; sbit COL2 = P0^5; sbit COL3 = P0^6; sbit COL4 = P0^7;//矩陣鍵盤定義 sbit IRIN = P3^2;//紅外接收頭數(shù)據(jù)線 sbit SCL=P2^0; //IIC時鐘引腳定義 sbit SDA=P2^1; //IIC數(shù)據(jù)引腳定義 unsigned int Cnt,i,a,b,c,pand

59、uan,biaozhi0,biaozhi1,biaozhi2,biaozhi3,biaozhi4; unsigned char d,IRCOM[7]; //**************************************** // 定義MPU6050內(nèi)部地址 //**************************************** #define SMPLRT_DIV 0x19 //陀螺儀采樣率，典型值：0x07(125Hz) #define CONFIG 0x1A //低通濾波頻率，典型值：0x06(5Hz) #define GYRO_CONF

60、IG 0x1B //陀螺儀自檢及測量范圍，典型值：0x18(不自檢，2000deg/s) #define ACCEL_CONFIG 0x1C //加速計自檢、測量范圍及高通濾波頻率，典型值：0x01(不自檢，2G，5Hz) #define ACCEL_XOUT_H 0x3B #define ACCEL_XOUT_L 0x3C #define ACCEL_YOUT_H 0x3D #define ACCEL_YOUT_L 0x3E #define ACCEL_ZOUT_H 0x3F #define ACCEL_ZOUT_L 0x40 #define TEMP_OUT_H 0x4

61、1 #define TEMP_OUT_L 0x42 #define GYRO_XOUT_H 0x43 #define GYRO_XOUT_L 0x44 #define GYRO_YOUT_H 0x45 #define GYRO_YOUT_L 0x46 #define GYRO_ZOUT_H 0x47 #define GYRO_ZOUT_L 0x48 #define PWR_MGMT_1 0x6B //電源管理，典型值：0x00(正常啟用) #define WHO_AM_I 0x75 //IIC地址寄存器(默認(rèn)數(shù)值0x68，只讀) #define Sla

62、veAddress 0xD0 //IIC寫入時的地址字節(jié)數(shù)據(jù)，+1為讀取 //**************************************** //函數(shù)聲明 //**************************************** void delay(unsigned int k); //延時 void Kalman_Filter(float Accel,float Gyro); void lcd_printf(uchar *s,int temp_data); //MPU6050操作函數(shù) void In

63、itMPU6050(); //初始化MPU6050 void Delay5us(); void I2C_Start(); void I2C_Stop(); void I2C_SendACK(bit ack); bit I2C_RecvACK(); void I2C_SendByte(uchar dat); uchar I2C_RecvByte(); void I2C_ReadPage(); void I2C_WritePage(); void display_ACCEL_x(); void display_ACCEL_y();

64、 void display_ACCEL_z(); uchar Single_ReadI2C(uchar REG_Address); //讀取I2C數(shù)據(jù) void Single_WriteI2C(uchar REG_Address,uchar REG_data); //向I2C寫入數(shù)據(jù) //延時 //**************************************** void delay2(unsigned int k) { unsigned int i,j; for(i=0;i

65、(j=0;j<121;j++); } } //************************************** //延時5微秒(STC90C52RC@12M) //不同的工作環(huán)境,需要調(diào)整此函數(shù) //當(dāng)改用1T的MCU時,請調(diào)整此延時函數(shù) //************************************** void Delay5us() { int p=0; for(p=0;p<10;p++) { _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_

66、nop_(); _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_nop_(); } } void dianjizhengzhuan() { IN1=0; IN2=0; CCAP0H=0X88; CCAP0L=0X88; CCAP1H=0X88; CCAP1L=0X88; } void dianjifanzhuan() { IN1=1; IN2=1; CCAP0H=0X88; CCAP0L=0X88; CCAP1H=0X88; CCAP1L=0X88; } void dianjifanzhuan1() { IN1=1; IN2=1; CCAP0H=0X66; CCAP0L=0X66; CCAP1H=0X66; CCAP1L=0X66; }