壁面移動爬壁機(jī)器人的設(shè)計(jì)【含CAD圖紙、說明書】
壁面移動爬壁機(jī)器人的設(shè)計(jì)【含CAD圖紙、說明書】,含CAD圖紙、說明書,移動,挪動,機(jī)器人,設(shè)計(jì),cad,圖紙,說明書,仿單
摘 要
壁面移動機(jī)器人屬特種作業(yè)機(jī)器人,在核工業(yè)、石化企業(yè)、建筑行業(yè)、消防部門、造船等領(lǐng)域均有廣泛的應(yīng)用,自二十世紀(jì)六十年代出現(xiàn)以來,一直受到世界各國的關(guān)注。
本文在闡述了國內(nèi)外壁面爬行機(jī)器人發(fā)展的狀況后。根據(jù)工作的環(huán)境與特點(diǎn)選擇了雙鏈條、真空吸附方式的總體結(jié)構(gòu)。并對機(jī)器人在表面靜止、運(yùn)動和抗傾機(jī)構(gòu)進(jìn)行力學(xué)分析。
本文對于爬壁機(jī)器人的清刷機(jī)構(gòu)做出了兩種設(shè)計(jì),最后選用其中的一種進(jìn)行裝配,另一種作為備選方案。
關(guān)鍵詞:壁面移動機(jī)器人;模糊控制;姿態(tài)控制
Abstract
Wall-climbing robot has been used in many areas, such as nuclear industry, petrifaction enterprise, building industry, fire fighting and ship building etc. It has been provoking high attention world widely ever since it was born in 1960’s.
In the paper ,we clarify the developing situation of the wall-climbing robot,out and in the country . According to work situation ,we select single crawler movement and vacuum adsorption for the robot.The paper sets up mechanics model of the robot when it is immobile or mobile or it is effected by acclivitous – resistant devices ,makes kinemotics analyses.
In this paper, wall-climbing robot-brush made of the two institutions design, the final selection of one of the assembly. As another option.
Key Words:Wall-climbing robot;Fuzzy control;Posture control.
目 錄
摘 要 I
Abstract II
第1章 緒論 1
1.1 課題的來源、目的和意義 1
1.2 傳統(tǒng)爬壁機(jī)器人的結(jié)構(gòu)及特性 1
1.3國內(nèi)外爬壁機(jī)器人的現(xiàn)狀 2
1.4 模糊控制策略在機(jī)器人中的應(yīng)用 5
1.5 本文的研究內(nèi)容及主要工作 7
第2章 清刷機(jī)器人的總體結(jié)構(gòu) 8
2.1 引言 8
2.2 清刷機(jī)器人系統(tǒng)性能指標(biāo)和總體構(gòu)成 8
2.2.1清刷系統(tǒng)性能指標(biāo) 8
2.2.2 清刷機(jī)器人的總體構(gòu)成 8
2.3 清刷機(jī)器人本體結(jié)構(gòu)設(shè)計(jì) 9
2.3.1 行走機(jī)構(gòu) 10
2.3.2 吸附機(jī)構(gòu) 10
2.3.3 驅(qū)動機(jī)構(gòu) 12
2.3.4 傳動機(jī)構(gòu) 13
2.3.5 鏈條的張緊裝置 14
2.4 軸的計(jì)算 16
2.5 鏈條驅(qū)動方式的選擇 16
2.6 清刷機(jī)構(gòu) 17
2.6.1 運(yùn)動方式 17
2.6.2 清洗方式 19
2.6.3 清洗作業(yè)系統(tǒng)的滾刷系統(tǒng)及噴淋系統(tǒng) 19
2.6.4影響機(jī)器人清洗的因素 20
2.7 清刷機(jī)構(gòu)的第二方案 20
2.8 本章小結(jié) 21
第3章 清刷機(jī)器人力學(xué)分析 22
3.1 引言 22
3.2 力學(xué)分析及數(shù)學(xué)模型的建立 22
3.3 本章小結(jié) 25
第4章 清刷機(jī)器人控制系統(tǒng)的研制 26
4.1 引言 26
4.2 清刷機(jī)器人控制系統(tǒng)總體設(shè)計(jì) 26
4.3 控制系統(tǒng)硬件設(shè)計(jì) 27
4.3.1伺服電機(jī)驅(qū)動與控制電路設(shè)計(jì) 27
4.3.2 串行通訊電路的設(shè)計(jì) 29
4.4 傾角傳感器的原理及其數(shù)據(jù)采集 30
4.4.1 傾角傳感器的原理 30
4.4.2 傾角傳感器的數(shù)據(jù)采集 30
4.5 控制系統(tǒng)軟件設(shè)計(jì) 31
4.5.1 下位單片機(jī)控制軟件設(shè)計(jì) 31
4.5.2 上位PC機(jī)控制軟件設(shè)計(jì) 32
4.6 本章小結(jié) 32
結(jié) 論 33
參考文獻(xiàn) 34
致 謝 36
第1章 緒論
1.1 課題的來源、目的和意義
隨著城市的現(xiàn)代化高速發(fā)展,一座座高樓拔地而起。為了美觀,也為了得到更好的采光效果,很多寫字樓和賓館都采用了玻璃幕墻,但時間一長,就要對玻璃壁面進(jìn)行清洗。以美化市容市貌。很多開放性城市還規(guī)定,每年對高樓清洗若干次。目前對高層建筑的清洗工作主要是由人工完成的。清洗工人搭乘吊藍(lán)或腰系繩索進(jìn)行高空擦洗,稍有不慎就會出現(xiàn)事故,造成傷亡。不但如此,人工作業(yè)的效率也很低,清洗一幢大樓有時要耗時數(shù)天乃至數(shù)十天,耗資巨大。因此人們迫切的希望能夠設(shè)計(jì)制造出一種可以代替人工完成高層建筑清洗任務(wù)的裝置。
近年來出現(xiàn)的爬壁機(jī)器人,實(shí)現(xiàn)了這種理想。由于在垂直陡壁上作業(yè)是非常困難和危險的,超越了人的能力極限,所以在國外稱此類機(jī)器人為極限作業(yè)機(jī)器人。極限作業(yè)機(jī)器人的研制成功,解決了人類在特殊環(huán)境下從事危險、繁重體力勞動的難題,為改善勞動環(huán)境、保護(hù)人身安全及美化城市等方面,開辟了一個新的領(lǐng)域。目前為止,國內(nèi)外的許多家研究機(jī)構(gòu)都在積極開展此項(xiàng)研究工作。
1.2 傳統(tǒng)爬壁機(jī)器人的結(jié)構(gòu)及特性
爬壁機(jī)器人必須具有兩個基本功能在壁面上的吸附功能和移動功能。傳統(tǒng)爬壁機(jī)器人按吸附功能可分為真空吸附和磁吸附兩種形式:真空吸附法又分為單吸盤和多吸盤兩種結(jié)構(gòu)形式,具有不受壁面材料限制的優(yōu)點(diǎn),但當(dāng)壁面凸凹不平時,容易使吸盤漏氣,從而使吸附力下降,承載能力降低磁吸附法可分為電磁體和水磁體兩種,電磁體式維持吸附力需要電力,但控制較方便。水磁體式不受斷電的影響,使用中安全可靠,但控制較為麻煩。磁吸附方式對壁面的凸凹適應(yīng)性強(qiáng),且吸附力遠(yuǎn)大于真空吸附方式,不存在真空漏氣的問題,但要求壁面必須是導(dǎo)磁材料,因此嚴(yán)重地限制了爬壁機(jī)器人的應(yīng)用環(huán)境。爬壁機(jī)器人按移動功能分主要是吸盤式、車輪式和鏈條式。吸盤式能跨越很小的障礙,但移動速度慢。車輪式移動速度快、控制靈活,但維持一定的吸附力較困難;鏈條式對壁面適應(yīng)性強(qiáng),著地面積大,但不易轉(zhuǎn)彎。而這三種移動方式的跨越障礙能力都很弱。驅(qū)動方式有兩種真空式由氣缸驅(qū)動,磁吸附式由電動機(jī)驅(qū)動。氣缸和電機(jī)不僅質(zhì)量大,增加機(jī)器人本體的重量,而且效率很低,能耗非常大。
目前機(jī)器人的電能供給均采用有纜接電方式或者是較大的蓄電池。有纜方式使機(jī)器人的移動不方便,工作受到一定的影響,而且電纜在壁面上產(chǎn)生摩擦,具有一定的危險性而蓄電池質(zhì)量大,增加機(jī)器人的自身重量,并且供電的時間有限。
1.3國內(nèi)外爬壁機(jī)器人的現(xiàn)狀
1966年,日本的西亮教授首次研制成功壁面移動機(jī)器人樣機(jī),并在大阪府立大學(xué)表演成功。這是一種依靠負(fù)壓吸附的爬壁機(jī)器人。隨后出現(xiàn)了各種類型的爬壁機(jī)器人,到80年代末期已經(jīng)開始在生產(chǎn)中應(yīng)用。當(dāng)前,國內(nèi)外都非常重視爬壁機(jī)器人的研制,主要是因?yàn)樗兄鴱V泛的用途,特別是它可以在一些危險環(huán)境下進(jìn)行作業(yè)。主要的用途有: (1)清洗高層建筑物的瓷磚壁面或玻璃墻面; (2)在建筑行業(yè)用于巨型墻面噴漆、砌磚、貼瓷磚和點(diǎn)檢。
日本在開發(fā)爬壁機(jī)器人方面發(fā)展最為迅速,主要應(yīng)用在建筑行業(yè)與核工業(yè)。日本清水建設(shè)公司開發(fā)了建筑行業(yè)用的外壁涂裝與貼瓷磚的機(jī)器人,他們研制的負(fù)壓吸附清洗玻璃面的爬壁機(jī)器人,曾為加拿大使館清洗。由日本Hokaido tech college 研發(fā)的爬墻機(jī)器人,可以說是先進(jìn)處于領(lǐng)先地位。如圖1.1所示。
俄羅期彼得堡國立技術(shù)大學(xué)也研制成功負(fù)壓吸附爬壁機(jī)器人。英國在爬壁機(jī)器人領(lǐng)域取得許多成果。90年代初RTD公司推出了輪式磁吸附爬壁機(jī)器人(取名Beetle),已作為商品銷售。最高爬行速度達(dá)每分12米,可以自動記錄每隔一定距離的壁厚,最高爬行高度為25米。
日本化工機(jī)械技術(shù)服務(wù)公司研制出了用于清除核電站爐內(nèi)壁面上附著污染物的機(jī)器人(5 ,11 ,13) ,它采用的是單吸盤結(jié)構(gòu),靠真空泵產(chǎn)生負(fù)壓吸附于壁面上,這種機(jī)器人無獨(dú)立的移動功能,行走是靠與其連在一起的絞車?yán)瓌拥?但是這種機(jī)器人工作時要求吸附面與壁面間有滑動,若壁面是凸凹不平的混凝土面,則滑動就很困難。為了解決吸附與移動之間的矛盾,之后公司又開發(fā)出VACS 壁面移動機(jī)器人(12 ,13) 。它采用鏈條式行走方式,在鏈條上裝有許多獨(dú)立的吸盤室,當(dāng)與壁面接觸時,吸盤室與真空室相通,與壁面分離時與大氣相通。這樣吸盤與壁面在吸附時沒有相對移動。
圖1.1:由日本Hokaido tech college 研發(fā)的爬墻機(jī)器人(僅供參考)
我國在清洗機(jī)器人領(lǐng)域已進(jìn)入世界領(lǐng)先水平。本項(xiàng)目系國家"863"高技術(shù)計(jì)劃支持的項(xiàng)目,經(jīng)過國內(nèi)各個機(jī)器人公司不斷研究和完善,現(xiàn)已成功地研制出新一代的實(shí)用型機(jī)器人。我國哈爾濱工業(yè)大學(xué)機(jī)器人研究所已經(jīng)成功研制出單吸盤真空吸附車輪行走式爬壁機(jī)器人和永磁鐵吸附鏈條行走式爬壁機(jī)器人。如圖1.2所示。這種屬國家“863”計(jì)劃高科技項(xiàng)目的CLR-2型壁面清洗爬壁機(jī)器人,于2000年6月8日在北京著名的國貿(mào)大廈開始正式“上班”。它每小時可清洗墻壁面積120~150平方米。上海大學(xué)也于2004.02.19 申請了一種靈活性強(qiáng)、精度高的磁輪吸附式爬壁機(jī)器人。
北京航天航空大學(xué)機(jī)器人研究所與鐵道部北京鐵路局科研所于1996 年合作開發(fā)出Cleanbot —Ⅰ型壁面清洗機(jī)器人 ,它是多吸盤吸附,采用”十”字框架式結(jié)構(gòu),即由兩個成“十”字交叉狀的無桿氣缸組成驅(qū)動裝置,用以實(shí)現(xiàn)機(jī)器人在X、Y方向上的移動。
`
1. 鏈條;2. 永磁體塊;3. 主動軸;4. 萬向輪;5. 減速器;6. 交流
伺服電機(jī);7. 聯(lián)軸器;8. 主動鏈輪;9. 外側(cè)板; 10. 張緊螺釘;
11. 從動鏈輪;12. 支撐架;13. 抗傾杠桿;14. 從動軸
圖1.2 壁面爬行機(jī)器人本體結(jié)構(gòu)簡圖
1.提升滑軌2.提升圓片3.壓縮輪4.驅(qū)動輪5.基板
6.驅(qū)動電機(jī)7.吸盤8.同步帶9.連軸器
圖1.3 爬壁平臺整體結(jié)構(gòu)圖
目前還流行一種無源真空爬壁機(jī)器人。如圖1.3所示。無源真空吸附是指利用機(jī)構(gòu)將吸盤內(nèi)的一部分氣體排出使吸盤腔內(nèi)具有一定的真空度,從而達(dá)到吸盤吸附到壁面的目的。最簡單的無源真空吸附的例子是普通的吸盤掛鉤。
1.4 模糊控制策略在機(jī)器人中的應(yīng)用
我們通??梢杂谩澳:?jì)算”籠統(tǒng)地代表諸如模糊推理(FIS,F(xiàn)uzzy Inference System)、模糊邏輯(Fuzzy Logic)、模糊系統(tǒng)等模糊應(yīng)用領(lǐng)域中所用到的計(jì)算方法及理論。在這些系統(tǒng)中,廣泛地應(yīng)用了模糊集理論,并揉和了人工智能的其他手段,因此模糊計(jì)算也常常與人工智能相聯(lián)系。由于模糊計(jì)算方法可以表現(xiàn)事物本身性質(zhì)的內(nèi)在不確定性,因此它可以模擬人腦認(rèn)識客觀世界的非精確、非線性的信息處理能力。
模糊計(jì)算在應(yīng)用上可是一點(diǎn)都不含糊,其應(yīng)用范圍非常廣泛,它在家電產(chǎn)品中的應(yīng)用已被人們所接受,例如,模糊洗衣機(jī)、模糊冰箱、模糊相機(jī)等。另外,在專家系統(tǒng)、智能控制等許多系統(tǒng)中,模糊計(jì)算也都大顯身手。究其原因,就在于它的工作方式與人類的認(rèn)知過程是極為相似的。在這里,筆者結(jié)合自己的研究實(shí)踐,以一個建筑結(jié)構(gòu)選型的專家系統(tǒng)為例,說明模糊推理系統(tǒng)是如何模仿領(lǐng)域?qū)<业乃季S進(jìn)行工作的,其中所用到的步驟、計(jì)算過程在其他模糊系統(tǒng)中也具有典型的代表性。
圖1.4 FIS的系統(tǒng)構(gòu)成與工作原理
模糊推理系統(tǒng)的基本結(jié)構(gòu)由四個重要部件組成:知識庫、推理機(jī)制、模糊化輸入接口與去模糊化輸出接口。知識庫又包含模糊if-then規(guī)則庫和數(shù)據(jù)庫。規(guī)則庫(rule base)中的模糊規(guī)則定義和體現(xiàn)了與領(lǐng)域問題有關(guān)的專家經(jīng)驗(yàn)或知識,而數(shù)據(jù)庫則定義模糊規(guī)則中用到的隸屬函數(shù)。模糊規(guī)則的形式一般為if A is a then B is b,其中A與B都是語言變量(linguistic variable)而a和b則是由隸屬函數(shù)映射到的語言值
(linguistic values)。例如“if H 很適應(yīng) then 結(jié)構(gòu) 很合理”這樣一條模糊規(guī)則中,建筑高度“H”與“結(jié)構(gòu)”都是語言變量,而“很適應(yīng)”與“很合理”分別是它們的語言值,在數(shù)據(jù)庫中都有相應(yīng)的隸屬函數(shù)加以定義。推理機(jī)制(decision-making unit)按照這些規(guī)則和所給的事實(shí)(例如針對某一擬定方案)執(zhí)行推理過程,求得合理的輸出或結(jié)論(例如方案的評價值)。模糊輸入接口(fuzzification interface)將明確的輸入轉(zhuǎn)換為對應(yīng)隸屬函數(shù)的模糊語言值,而去模糊輸出接口則將模糊的計(jì)算結(jié)果換為明確的輸出。
由(圖1.4)我們可以看到,F(xiàn)IS的建立分為三個步驟:一是挑選能夠反映系統(tǒng)工作機(jī)制的控制輸入輸出變量 ;二是挑選這些變量的模糊子集;三是用模糊規(guī)則建立輸出集與輸入集的關(guān)系。而模糊系統(tǒng)F用三個步驟將輸入x映射到輸出F(x)。第一步是將輸入x并聯(lián)地匹配到所有“如果部分”的模糊集合,這一步依據(jù)輸入x屬于每一個“如果部分”集合A的程度來“激活”或“啟動”模糊規(guī)則。第二步是疊加所有按比例收縮的“則部分”集合,生成最終的輸出集合。第三步是去模糊化,系統(tǒng)計(jì)算出最終輸出集的形心或重心作為輸出F(x),常用的去模糊化方法有:面積中心法、面積等分法、極值法等。
圖1.5 FIS的推理機(jī)制
我們以對建筑設(shè)計(jì)高度是否適應(yīng)所選的結(jié)構(gòu)形式這一單因素評價為例看看系統(tǒng)的推理過程(見圖1.5)。對上述的“if H 很適應(yīng) then 結(jié)構(gòu) 很合理”規(guī)則而言,我們可以把H看作模糊單點(diǎn),與“很適應(yīng)”求交運(yùn)算,得到H的“很適應(yīng)”程度,亦即該規(guī)則前件的支持程度,再與“很合理”求交運(yùn)算得到的模糊集便衡量了該關(guān)系得以成立的權(quán)重。通俗而言,即“H 很適應(yīng)”得到多大程度的支持,則結(jié)構(gòu)亦在多大程度上“很合理”,整個模糊推理過程。例如語言變量x經(jīng)過A1所代表的語言值程度隸屬函數(shù),得到x對
A1的隸屬度,再與y對B1的隸屬度進(jìn)行求交或求并運(yùn)算,即可以得到第一個規(guī)則前件得以支撐的程度,然后再與后件語言值C1求交,得到該規(guī)則成立的權(quán)重,同樣也可以得到其他規(guī)則的權(quán)重。經(jīng)過面積中心法去模糊后就可以得到推論的結(jié)果。
模糊計(jì)算方法以模糊集理論為基礎(chǔ),它有諸如模糊信息檢索、模糊識別、模糊聚類等許多廣泛的應(yīng)用,而且由于其采用的方法也是人類大腦所采用的認(rèn)知方法,因而在社會學(xué)方面也大有用武之地。人腦也正是采用模糊的手段,極大地壓縮了信息的輸入量、處理量、存儲量,才得以滿意地處理所面臨的各種問題。
1.5 本文的研究內(nèi)容及主要工作
本論文“玻璃表面清刷機(jī)器人控制系統(tǒng)的研究”的研究目的是研制一種在玻璃表面清刷的機(jī)器人,重點(diǎn)是完成本體及控制系統(tǒng)的設(shè)計(jì)和研究,結(jié)合清刷機(jī)器人的吸附功能、移動功能和清刷作業(yè)功能,完成以下主要工作:
1. 清刷機(jī)器人總體結(jié)構(gòu)的研究和設(shè)計(jì)
根據(jù)玻璃清刷機(jī)器人的使用環(huán)境、技術(shù)指標(biāo)的要求和系統(tǒng)組成,研究和設(shè)計(jì)了清刷機(jī)器人的吸附機(jī)構(gòu)、驅(qū)動機(jī)構(gòu)、傳動機(jī)構(gòu)、抗傾覆機(jī)構(gòu)和清刷機(jī)構(gòu),建立了完整的真空吸附、單鏈條移動的機(jī)器人本體結(jié)構(gòu);
2. 清刷機(jī)器人力學(xué)及運(yùn)動學(xué)分析
建立了機(jī)器人在結(jié)構(gòu)表面靜止和運(yùn)動構(gòu)情況下的力學(xué)模型,進(jìn)行了力學(xué)分析,為確定單個吸盤所需的吸附力和選取驅(qū)動機(jī)構(gòu)參數(shù)提供了依據(jù);同時還對機(jī)器人進(jìn)行安全性分析,建立運(yùn)動學(xué)方程,為進(jìn)行姿態(tài)閉環(huán)控制提供了依據(jù)。
3. 清刷機(jī)器人控制系統(tǒng)的研究和設(shè)計(jì)
機(jī)器人的控制系統(tǒng)采用分布式控制方式。分布式控制是采用上、下位機(jī)的二級結(jié)構(gòu),上位機(jī)負(fù)責(zé)整個系統(tǒng)的管理以及運(yùn)動學(xué)計(jì)算、軌跡規(guī)劃等。下位機(jī)由多個CPU組成,每個CPU控制一個關(guān)節(jié)或一固定任務(wù),這些CPU和主CPU之間采用總線形式連接。分布式控制結(jié)構(gòu)工作速度和控制性能比較高。機(jī)器人的控制系統(tǒng)分為三部分:電機(jī)控制模塊、綜合控制模塊和用戶控制模塊。
第2章 清刷機(jī)器人的總體結(jié)構(gòu)
2.1 引言
本課題研究的主要任務(wù)是完成設(shè)計(jì)能夠獨(dú)立完成光滑壁面清洗的爬壁機(jī)器人,首先應(yīng)該具有良好的吸附機(jī)能和行走機(jī)能,能夠可靠地吸附在玻璃表面上,以及能夠在結(jié)構(gòu)表面上遙控自由地上下移動,速度為2~8米/分;其次,考慮到作業(yè)環(huán)境和作業(yè)性質(zhì)的特殊性,需要提高爬壁機(jī)器人具有一定的負(fù)載能力;最后,爬壁機(jī)器人裝上清洗刷后,能夠克服氣候及重力影響完成清洗作業(yè)。
2.2 清刷機(jī)器人系統(tǒng)性能指標(biāo)和總體構(gòu)成
2.2.1清刷系統(tǒng)性能指標(biāo)
根據(jù)清刷機(jī)器人在玻璃表面完成清刷作業(yè)任務(wù)的要求,爬壁機(jī)器人的整體性能應(yīng)達(dá)到如下主要技術(shù)指標(biāo):
(1) 吸附方式 真空吸附;
(2) 移動機(jī)構(gòu) 鏈條式;
(3) 移動速度 >2米/分;
(4) 負(fù)重能力 >30公斤;
(5) 控制方式 無線遙控;
(6) 作業(yè)能力 安裝上清洗刷后能完成清刷作業(yè)任務(wù)。
2.2.2 清刷機(jī)器人的總體構(gòu)成
綜合以上性能指標(biāo),考慮到系統(tǒng)的通用性和操作的簡便性,玻璃表面清刷作業(yè)機(jī)器人的系統(tǒng)總體設(shè)計(jì)如圖2.1所示。 機(jī)器人的控制系統(tǒng)采用分布式控制方式。分布式控制是采用上、下位機(jī)的二級結(jié)構(gòu),上位機(jī)負(fù)責(zé)整個系統(tǒng)的管理以及運(yùn)動學(xué)計(jì)算、軌跡規(guī)劃等。下位機(jī)由多個CPU組成,每個CPU控制一個關(guān)節(jié)或一固定任務(wù),這些CPU和主CPU之間采用總線形式連接。分布式控制結(jié)構(gòu)工作速度和控制性能比較高。機(jī)器人的控制系統(tǒng)(如圖2.1所示)分為三部分:電機(jī)控制模塊、綜合控制模塊和用戶控制模塊。
??? 用戶控制模塊包括操作盒和監(jiān)視器及與它們相連的無線收發(fā)設(shè)備。綜合控制模塊包括無線通訊和電源管理模塊。電機(jī)控制模塊包括兩個驅(qū)動電機(jī)及其驅(qū)動器。操作者可以控制操作手柄,將指令通過無線數(shù)傳模塊發(fā)給機(jī)器人上的綜合控制模塊。綜合控制模塊接受指令后,將其解釋,分別執(zhí)行。如果指令是給其他模塊的,綜合模塊將會重新編碼
通過I2C總線發(fā)送給其他模塊。同時其他模塊將要傳送給操作者的數(shù)據(jù)先通過I2C發(fā)送給綜合控制模塊,再由綜合控制模塊通過無線數(shù)傳模塊發(fā)送給操作者。
圖2.1 控制系統(tǒng)結(jié)構(gòu)圖
玻璃表面清刷機(jī)器人有如下幾部分構(gòu)成:
(1) 機(jī)器人本體 由真空吸附方式、雙鏈條結(jié)構(gòu)構(gòu)成玻璃表面清刷作業(yè)機(jī)器人的載體,是工作附件的運(yùn)載工具;
(2) 上位機(jī)負(fù)責(zé)整個系統(tǒng)的管理以及運(yùn)動學(xué)計(jì)算、軌跡規(guī)劃等。;
(3) 下位機(jī)由多個CPU組成,每個CPU控制一個關(guān)節(jié)或一固定任務(wù);
(4) 清刷機(jī)構(gòu) 完成壁面的清刷作業(yè)任務(wù)。
2.3 清刷機(jī)器人本體結(jié)構(gòu)設(shè)計(jì)
綜合考慮了清刷機(jī)器人的作業(yè)環(huán)境,作業(yè)要求,保證機(jī)器人的可靠性和安全性,選擇了單鏈條真空吸附式的壁面移動機(jī)器人,原因是:
1. 為了能在玻璃表面上行走,我們采用了真空吸附方式。要在玻璃表面上行走,機(jī)器人大多采用真空吸附方式。因?yàn)楸容^安全可靠,即使突然斷電,機(jī)器人也不會發(fā)生墜落現(xiàn)象,但采用真空吸附方式,需要龐大的、復(fù)雜的真空系統(tǒng),設(shè)計(jì)起來需要多方面考慮。
2. 選用雙鏈條的移動方式,與輪式相比,雖然結(jié)構(gòu)上比較復(fù)雜,但其接觸面大、穩(wěn)定、可增加負(fù)重且便于攜帶作業(yè)工具。將吸盤鑲在鏈條上形成吸盤鏈條,通過合理的設(shè)計(jì)鏈條結(jié)構(gòu),可以使鏈條負(fù)重的大小與其上所鑲嵌的吸盤數(shù)量近似成正比,這樣可保證在增加吸附力的同時,又可靈活地適應(yīng)玻璃表面;
3. 清刷機(jī)器人由鏈條完成移動功能,鏈條是鉸鏈聯(lián)接,具有一定的柔性,能夠適應(yīng)建筑表面的曲率變化,且可越過縫隙等存在于玻璃表面的障礙。
2.3.1 行走機(jī)構(gòu)
行走機(jī)構(gòu)模仿坦克鏈條結(jié)構(gòu),坦克采用雙鏈條行走和轉(zhuǎn)向,對于爬壁機(jī)器人,爬行中底部的鏈條要通過吸盤吸附在工作面上。如果采用雙鏈條機(jī)器人轉(zhuǎn)向理論上不易實(shí)現(xiàn),因此決定采用單鏈條模式在一封閉鏈條上交裝吸盤形成一條行走鏈條。通過前后兩個直徑為100mm的鏈輪,來支撐驅(qū)動鏈條,并在鏈條的下方設(shè)置導(dǎo)軌。前輪用來控制爬行的方向,一個雙作用汽缸用來控制前輪轉(zhuǎn)向。前后輪都用一交流伺服電機(jī)通過減速機(jī)構(gòu)來驅(qū)動。減速機(jī)構(gòu)選用德國NEUGART公司生產(chǎn)的PLE80精密行星齒輪箱作為減速器,電機(jī)選日本安川公司生產(chǎn)的?-L系列交流伺服電機(jī)(SGML-02AF14),體積小、單位體積功率大。電機(jī)驅(qū)動前后輪驅(qū)使機(jī)器人向前運(yùn)動,當(dāng)轉(zhuǎn)向汽缸驅(qū)動前輪偏轉(zhuǎn)一定角度,前部鏈條會隨之轉(zhuǎn)動一定的角度,因而,機(jī)器人會改變其前進(jìn)方向,所以,鏈條具有一定的柔性對系統(tǒng)的轉(zhuǎn)向很重要,鏈條的每一關(guān)節(jié)可偏轉(zhuǎn)2. 4度,轉(zhuǎn)向的實(shí)現(xiàn)問題在下面進(jìn)一步探討。本機(jī)器人本體機(jī)構(gòu)如圖2.2所示。
圖2.2 清刷機(jī)器人的本體結(jié)構(gòu)
2.3.2 吸附機(jī)構(gòu)
吸附機(jī)構(gòu)由安裝在鏈條上的吸盤及真空發(fā)生器等組成,吸附機(jī)構(gòu)由安裝在鏈條上的12組吸盤及真空發(fā)生器等組成,如圖2.3 所示,一系列鏈條連接板依次等間距安裝在鏈條
上,吸盤安裝在吸盤支撐板上, 吸盤支撐板和鏈條連接板之間通過連桿和彈簧相連, 由于連桿和鏈條連接板間可以滑動,因此,吸盤組在有比較小的障礙的墻面上, 可以象蠕蟲一樣產(chǎn)生避讓動作,使機(jī)器人可以越過障礙,每組吸盤由2個40 mm的吸盤組成,由單獨(dú)的機(jī)械閥控制其動作。隨著機(jī)器人的運(yùn)動,當(dāng)一組吸盤完全接觸工作表面到達(dá)吸附狀態(tài)時,對應(yīng)的機(jī)械閥打開,與之相連的真空發(fā)生器工作產(chǎn)生真空, 吸盤吸附在玻璃上,反之,隨著機(jī)器人前進(jìn), 當(dāng)一組吸盤即將要離開平面時, 對應(yīng)的機(jī)械閥關(guān)閉,則吸盤的吸附力逐漸降到零, 而可以脫離工作表面,在設(shè)計(jì)中,任何時刻都至少保證有12組吸盤同時吸附在工作表面上,以產(chǎn)生足夠的吸附力, 防止機(jī)器人從墻壁上滑下或傾翻。因?yàn)槊恳粋€機(jī)械閥和真空發(fā)生器都要與氣源連接,要確保它們隨著鏈條的轉(zhuǎn)動而不纏繞,用一旋轉(zhuǎn)接頭實(shí)現(xiàn)氣的供給并能防止纏繞。
1. 吸盤 2. 吸盤提升裝置 3. 撐板彈簧 4. 導(dǎo)向支 5. 導(dǎo)輪 6. 鏈
條連接板 7. 連桿 8. 吸盤支撐板
圖2.3 吸盤組導(dǎo)向和提升裝置
證吸盤組在垂直于工作面進(jìn)入吸附狀態(tài),并能夠維持垂直(近似) 姿態(tài)直到吸盤組脫離, 因此設(shè)計(jì)了吸盤組導(dǎo)向裝置 ,在框架兩側(cè)安裝了縱向的導(dǎo)向支撐板(導(dǎo)軌) ,鏈條連接板的兩端安裝有三導(dǎo)輪,吸盤組的導(dǎo)輪進(jìn)入導(dǎo)向支撐板后,在導(dǎo)向支撐板、鏈條及直線軸承的作用下,保證吸附狀態(tài)的吸盤連桿在機(jī)器人爬行時能保持相互姿態(tài)。為了避免吸盤在前輪下方切入時卷褶漏氣,設(shè)計(jì)了相應(yīng)的吸盤提升裝置 。在一吸盤組進(jìn)入吸附狀態(tài)前,吸盤支撐板上的滾輪作用在提升軌道上,提升軌道將吸盤支撐板連同吸盤相對于鏈條連接板提升一段距離, 到達(dá)吸附位置時, 在彈簧作用下將吸盤彈回,吸盤組進(jìn)入吸附狀態(tài)。
2.3.3 驅(qū)動機(jī)構(gòu)
機(jī)器人常用的驅(qū)動方式有:液壓驅(qū)動、氣動驅(qū)動、電動驅(qū)動和機(jī)械式驅(qū)動四種基本方式。電動驅(qū)動主要有步進(jìn)電機(jī)、直流伺服電機(jī)和交流伺服電機(jī)??紤]機(jī)器人的特殊作業(yè)環(huán)境,驅(qū)動機(jī)構(gòu)選用日本安川電器公司生產(chǎn)的?-L系列交流伺服系統(tǒng)中型號為SGML-02AF14的伺服馬達(dá)。該馬達(dá)具有全封閉結(jié)構(gòu),且具有可靠性高、轉(zhuǎn)子的轉(zhuǎn)動慣量小、系統(tǒng)的快速性好、同功率下重量和體積均較小等優(yōu)點(diǎn),其主要性能指標(biāo)見表2.2。
表2.2 SGML-02AF14型交流伺服馬達(dá)的性能指標(biāo)
額定
功率
(W)
額定
轉(zhuǎn)矩
(N.m)
瞬時最大扭矩
(N.m)
額定
轉(zhuǎn)速
(r/min)
額定
電流
(A)
額定
電壓
(V)
轉(zhuǎn)動
慣量
(kg.m2)
重
量
(kg)
200
0.637
1.91
3000
2.0
200
0.123′10-4
1.1
表2.3 SGDL-02AS型伺服單元的性能指標(biāo)
最大輸出電流
(A)
輸入電源
(V)
控制方式
反饋
重量
(kg)
6.0
單相AC200~230
50/60HZ
單相全波整流
正弦波驅(qū)動
增量型編碼器1024P/R
0.9
每個伺服馬達(dá)都有一個與之相匹配的伺服單元,沒有伺服單元的驅(qū)動,伺服馬達(dá)將不能運(yùn)動。和SGML-02AF14伺服馬達(dá)相匹配的伺服單元的型號為SGDL-02AS。該伺服單元的主要特性見表2.3。
馬達(dá)是高轉(zhuǎn)速、低扭矩的驅(qū)動部件,馬達(dá)的輸出軸要經(jīng)過減速器進(jìn)行減速,才能達(dá)到所需的轉(zhuǎn)速和轉(zhuǎn)矩的要求。我們選用了德國NEUGART公司生產(chǎn)的PLE80精密行星齒輪箱作為減速器,其性能指標(biāo)見表2.4。
表2.4 PLE80精密行星齒輪箱性能指標(biāo)
額定輸出扭矩(N.m)
最大輸入速度
(r/min)
轉(zhuǎn)動
慣量
(kg.m2)
最大徑向載荷
(N)
減
速
比
傳動級數(shù)
滿負(fù)載效率
重
量
(kg)
120
8000
0.39′10-4
950
160
3
90%
3.1
2.3.4 傳動機(jī)構(gòu)
2.3.4.1 鏈傳動的特點(diǎn)和應(yīng)用
根據(jù)本體結(jié)構(gòu)需要,綜合考慮傳動性能、成本等方面原因,這里選用鏈傳動。它由鏈條和主、從動鏈輪組成,鏈輪上制有特殊齒形的齒,依靠鏈輪輪齒與鏈節(jié)嚙合來傳遞運(yùn)動和動力。鏈傳動與帶傳動相比,無彈性滑動和打滑現(xiàn)象,因而保持準(zhǔn)確的平均傳動比,傳動效率較高。與齒輪傳動相比,鏈傳動的制造和安裝精度要求較低,成本低廉。鏈傳動的主要缺點(diǎn)是運(yùn)轉(zhuǎn)的瞬時速度不均勻,高速時不如帶傳動平穩(wěn),鏈條磨損后易發(fā)生跳齒現(xiàn)象。鏈傳動主要應(yīng)用于要求工作可靠,且兩軸相距較遠(yuǎn),以及其它不宜采用齒輪傳動的場合和極為惡劣的工作環(huán)境。這里采用的傳動鏈為兩側(cè)帶翼板的滾子鏈,以便在改形后的外側(cè)翼板上安裝吸盤。
2.3.4.2 鏈傳動主要參數(shù)的確定
1. 鏈輪齒數(shù)z1、z2和傳動比i
鏈條節(jié)距p的大小,與傳動的平穩(wěn)性、承載能力等均有一定的關(guān)系。在一定條件下,鏈條的節(jié)距越大,承載能力越高,但傳動的多邊形效應(yīng)也要增大,振動、沖擊、噪聲也越嚴(yán)重。為使傳動平穩(wěn)、結(jié)構(gòu)緊湊、延長鏈條的使用壽命,盡量選用較小節(jié)距的單排鏈??紤]鏈的傳動功率小于100kW,鏈速小于15m/s,選用了普通短節(jié)距傳動滾子鏈,其型號為:10A-1×80 GB1243.1-83,該滾子鏈的節(jié)距mm。
2. 鏈傳動的中心距a和鏈節(jié)數(shù)Lp
若中心距a過小,當(dāng)鏈速不變時,單位時間內(nèi)鏈條繞轉(zhuǎn)次數(shù)增多,則鏈條曲伸次數(shù)和應(yīng)力循環(huán)次數(shù)增加,可加劇鏈的磨損和疲勞,且鏈條在主動鏈輪上的包角變小,將導(dǎo)致輪齒所受的載荷增大,易出現(xiàn)跳齒和脫鏈現(xiàn)象。中心距太大,會引起從動邊垂度過大,
傳動時造成松邊顫動。一般初定中心距,從減小機(jī)器人的體積考慮,取。
鏈節(jié)數(shù)
(2-1)
考慮使磁塊均勻分布在鏈條上,并且每5個鏈節(jié)安裝一個磁塊,所以取Lp = 80節(jié)。
鏈傳動的理論中心距
(mm) (2-2)
實(shí)際中心距 (mm) (2-3)
3. 鏈輪的主要尺寸
分度圓直徑 (mm) (2-4)
齒頂圓直徑 (mm) (2-5)
式中:—滾子鏈的滾子外徑,mm。
齒根圓直徑
(mm) (2-6)
分度圓弦齒高 (mm) (2-7)
齒側(cè)凸緣直徑
(mm) (2-8)
式中:—滾子鏈內(nèi)鏈板高度,mm。
齒寬 (mm) (2-9)
式中:—內(nèi)鏈節(jié)內(nèi)寬,mm。
2.3.5 鏈條的張緊裝置
鏈條包在鏈輪上太松和太緊都不好,其松緊程度用松邊垂度來表示。合適的松邊垂度為。鏈條垂度過大時,會產(chǎn)生與鏈輪嚙合不良和鏈條的振動等現(xiàn)象,會導(dǎo)致磁性吸附塊與船體表面接觸不良,影響機(jī)器人的移動功能。并且鏈條在使用過程中也會因磨損而逐漸伸長,也需適時地調(diào)整鏈條的松緊程度。這里由于前后兩軸都與框架相連,所以通過調(diào)節(jié)連接兩個框架的螺栓來調(diào)節(jié)前后兩軸的距離,達(dá)到張緊的目的。其結(jié)構(gòu)如圖2.5所示。當(dāng)鏈條太松時,通過調(diào)整張緊螺栓,使前后兩框架的距離加大,從而加大了兩鏈輪的中心距,起到了調(diào)整鏈條松緊的作用。
圖2.5 張緊機(jī)構(gòu)示意圖
2.3.6 轉(zhuǎn)向機(jī)構(gòu)
轉(zhuǎn)向?qū)τ谂佬袡C(jī)器人非常重要,對于單一鏈條的爬壁機(jī)器人尤為重要,本機(jī)器人轉(zhuǎn)向的關(guān)鍵在于軸固定在框架上,而框架的一端裝有轉(zhuǎn)向關(guān)節(jié),轉(zhuǎn)向關(guān)節(jié)的兩端有兩個轉(zhuǎn)動副。另一端裝有轉(zhuǎn)向汽缸,汽缸的頂端裝有一個轉(zhuǎn)動副,當(dāng)轉(zhuǎn)向汽缸作用時,轉(zhuǎn)向關(guān)節(jié)隨著轉(zhuǎn)向汽缸的伸縮而左右轉(zhuǎn)動,使框架的的前端發(fā)生偏轉(zhuǎn),并且前輪的接觸中心點(diǎn)也發(fā)生很小偏移,前輪帶動前輪上纏繞的鏈條,這部分鏈條上的吸盤可以偏轉(zhuǎn)一定的角度,隨著機(jī)器人的連續(xù)移動,機(jī)器人就可以逐漸改變其運(yùn)動方向,但是,該機(jī)器人的轉(zhuǎn)彎半徑較大。
本機(jī)器人的轉(zhuǎn)向主要是根據(jù)兩個馬達(dá)的轉(zhuǎn)速控制完成的。當(dāng)兩個馬達(dá)的轉(zhuǎn)速不同是,的兩邊鏈條的轉(zhuǎn)動也就不響動,產(chǎn)生了一定的速度差。產(chǎn)生機(jī)器人轉(zhuǎn)向的效果。
2.4 軸的計(jì)算
由于后鏈輪軸主要傳遞扭矩,故按扭轉(zhuǎn)條件計(jì)算軸的最小直徑,計(jì)算如下:
A0:軸的材料參數(shù),軸的材料為40Cr,A0=97
P:軸的傳遞功率,單位為,P=0.4kw
n:軸的轉(zhuǎn)速,n=18.75r/min
求得: d≥26.90mm 根據(jù)軸承取d=30mm
2.5 鏈條驅(qū)動方式的選擇
鏈條行走裝置由于驅(qū)動位置的不同,鏈條內(nèi)張力的分布也不同。前驅(qū)動和后驅(qū)動方式的鏈條內(nèi)張力分布如圖2.7所示。其中(a)為前驅(qū)動方式,(b)為后驅(qū)動方式。圖中T0為鏈條的總預(yù)張力,F(xiàn)z'為主動輪上的牽引力,F(xiàn)zk為鏈條的內(nèi)部牽引力。鏈條預(yù)加張力是盡量減小鏈條的振動、噪音和磨損等因素對鏈條在行駛過程中的影響,鏈條總預(yù)張力T0包括預(yù)加動張力和預(yù)加靜張力兩部分。主動輪上的牽引力Fz'是用來克服鏈條行動裝置的內(nèi)部阻力和外部阻力的。而鏈條的內(nèi)部牽引力Fzk包括了所有作用于鏈條上的牽引力,即:。
前驅(qū)動方式的主動輪較后驅(qū)動的磨損較少,因?yàn)殒湕l在從壁面到主動輪的過程中,鏈條上攜帶的雜物已經(jīng)被較好地沖刷了。但從圖2.5(a)可以看出,驅(qū)動裝置前置時,大部分鏈條在行駛過程中承受較大的牽引力。隨著鏈條的使用,鏈條將劇烈地伸長,導(dǎo)致在行駛時下部鏈條處形成所謂的“鏈條腹部”,機(jī)器人在轉(zhuǎn)向行駛過程中,鏈條更會有脫落的危險。
圖2.5 采用不同驅(qū)動方式時鏈條的內(nèi)張力分布
而采用如圖2.5(b)所示的后驅(qū)動方式,由于會減輕鏈條拉伸的效果,的鏈條的使用壽命。所以我采用后雙驅(qū)動的模式,使前后兩牽引力相互抵消,進(jìn)而增加了鏈條的使用壽命和安全性。
2.6 清刷機(jī)構(gòu)
壁面自動清洗機(jī)器人的作業(yè)多鄉(xiāng)主要是高樓大廈的墻窗面.常見的大廈外墻多以平面組成.清洗作業(yè)系統(tǒng)是機(jī)器人進(jìn)行壁面清洗作業(yè)的具體執(zhí)行機(jī)構(gòu),它要適應(yīng)玻璃幕墻的特點(diǎn)??紤]到玻璃幕墻的灰塵黏結(jié)強(qiáng)度大、除水難和有水摩擦系數(shù)小等特點(diǎn)。我們可以采用沖洗、刷洗、刮洗、聯(lián)合作用的清晰作業(yè)方式。整個清洗作業(yè)系統(tǒng)包括滾刷系統(tǒng)、噴淋系統(tǒng)、接水刮水系統(tǒng)、恒壓系統(tǒng)。參見圖2.8。
2.6.1 運(yùn)動方式
驅(qū)動電機(jī)12通過同步齒形帶3驅(qū)動滾刷6做旋轉(zhuǎn)運(yùn)動。滾刷6的結(jié)構(gòu)如圖2.9所示。
1、排水管 2、接水板 3、同步帶 4、移動噴嘴 5、齒梳板
6、滾刷 7、刮水板 8、密封圍裙 9、固定噴嘴10、管路系統(tǒng)11、傳動絲杠12、驅(qū)動電機(jī)13、密封室框架
圖2.8 清洗機(jī)構(gòu)示意圖
圖2.9 滾刷結(jié)構(gòu)
2.6.2 清洗方式
首先以高壓水沖洗壁面,除去壁面上附著力較小的污垢并浸潤壁面;隨后右滾筒刷刷洗壁面,出去附著力較大的污垢;然后,有刮水板刮干凈殘留的液滴,有接水板承接和收集污水。
2.6.3 清洗作業(yè)系統(tǒng)的滾刷系統(tǒng)及噴淋系統(tǒng)
滾刷6的結(jié)果后如土2.9所示。內(nèi)層筒壁為尼龍,在尼龍筒壁上穿制豬鬃。尼龍筒壁兩端裝有軸頭,分別安裝軸承和同步齒形帶帶輪。滾刷的長度我們選定為;L=800mm。豬鬃通過粘膠固定在尼龍筒壁的穿制孔中。根據(jù)穿制工藝要求,孔深不能小于10mm,由此我們選擇尼龍層的厚度為15mm,選擇穿制空的直徑d1為4mm。
滾刷以來鬃毛的變形來跨越障礙,故鬃毛的長度h不能太小,h越小,越容易變形,且變形阻力小,容易跨越窗礦框等障礙;但h過大,導(dǎo)致機(jī)構(gòu)尺寸過大。綜合以上因素,選取鬃毛的長度為60mm。
為保證滾刷能連續(xù)清洗壁面(保證不漏洗壁面),滾刷周圍的鬃毛應(yīng)該保持稠密、均勻分布,而且周緣鬃毛應(yīng)該比較齊整,這是由穿制孔的螺距來保證的。鬃毛根部扎緊,頭部由于自然膨脹效應(yīng)呈倒圓錐發(fā)散,如圖2.10所示。
圖2.10鬃毛自然膨脹
噴淋系統(tǒng)主要包括移動噴嘴4、固定噴嘴9、管路系統(tǒng)10、傳動絲杠11。移動噴嘴固定在與傳動絲杠配合的絲杠螺母上。電機(jī)12的動力通過同步赤形帶傳遞到傳動絲杠11,從面帶動移動噴嘴相對壁面左右移動,完成沖洗壁面的目的。管路系統(tǒng)10的安裝在
密封室框架13上。固定噴嘴9安裝在管路系統(tǒng)10上,完成噴淋滾刷的目的,起到淋濕和清潔滾刷的目的。
2.6.4影響機(jī)器人清洗的因素
(1) 有無刮水工序
大量的被用在清晰作業(yè)上的清洗液,一般情況下都含有不溶解顆粒。即使清洗液可以經(jīng)過脫礦或離子化處理,控制其中的不溶微粒的含量小于允許值,但由于壁面本身粘附有許多礦質(zhì)污點(diǎn),當(dāng)清晰液噴淋上時,這些物質(zhì)迅速溶解到清洗液中,也導(dǎo)致液滴中不溶解的礦物質(zhì)微粒的含量大大超過允許值。礦物微粒在壁面上的析出形成一片暈圈,影響清洗清晰度。從理論上講,滴液不可能完全刮盡,但如果刮水后的玻璃壁面清晰度在肉眼認(rèn)可的范疇之內(nèi),認(rèn)為刮水有效。
(2) 垂直壁面壓力因素
垂直壁面壓力對清洗質(zhì)量已經(jīng)清洗是否順利有直接影響作用。壓力小,清洗執(zhí)行部件和壁面未接觸或者少量接觸,出現(xiàn)滾刷脫落開玻璃壁面或漏水等現(xiàn)象。壓力過大時,清洗執(zhí)行部件過度積壓壁面,摩擦阻力徒增,致使清洗作業(yè)無法正常進(jìn)行。
(3) 噴淋壓力及噴射流量
噴淋壓力及噴射流量,影響對滾刷的清潔和對壁面的沖洗。噴淋壓力過小,噴射流量小,沖擊力小,不利于清潔滾刷和沖洗壁面;噴淋壓力過大,噴射流量增加,增加了清洗液的消耗,對排污水帶來很大壓力。
(4) 噴嘴與壁面之間的距離和噴嘴噴流傾角
噴嘴與壁面之間的距離直接影響。噴流對壁面的沖擊力射流傾角影響清洗液對壁面的浸潤效果。
2.7 清刷機(jī)構(gòu)的第二方案
由于上述清刷機(jī)構(gòu)結(jié)構(gòu)比較復(fù)雜,考慮到制作成本維修難度等原因,可行性比較小。所以本文采用另一種清刷機(jī)構(gòu)。
本清刷機(jī)構(gòu)由擺動刷和刷體共同構(gòu)成。刷體由上下兩部分組成,由螺母連接成一個刷體,便于拆卸清洗。擺動刷和刷體組成一個清刷機(jī)構(gòu),并且連接到爬壁機(jī)器人的前端。本文采用了兩組清刷機(jī)構(gòu)。清刷系統(tǒng)也具有刷洗、刮洗、聯(lián)合作用的清晰作業(yè)方式。從整體的作業(yè)要求上可以滿足設(shè)計(jì)需求,而且簡單易行。
2.8 本章小結(jié)
本章介紹了玻璃表面清刷機(jī)器人的總體構(gòu)成和系統(tǒng)的性能指標(biāo);研究和設(shè)計(jì)了清刷機(jī)器人的吸附機(jī)構(gòu)、驅(qū)動機(jī)構(gòu)、傳動機(jī)構(gòu)、和清刷機(jī)構(gòu),建立了完整的真空吸附、雙鏈條移動的機(jī)器人本體結(jié)構(gòu);比較分析了鏈條采用前驅(qū)動方式,后驅(qū)動方式和雙驅(qū)動方式的優(yōu)缺點(diǎn),確立了采用雙驅(qū)動方式的鏈條結(jié)構(gòu)。
本文設(shè)計(jì)的真空吸附、單鏈條結(jié)構(gòu)的爬壁清刷機(jī)器人本體結(jié)構(gòu),成功地做到了機(jī)器人在壁面上穩(wěn)定地行走,保證了機(jī)器人能完成清刷作業(yè)任務(wù)。
第3章 清刷機(jī)器人力學(xué)分析
3.1 引言
爬壁機(jī)器人可以應(yīng)用在高層玻璃幕墻和瓷磚壁面的清洗工作中。哈爾濱工業(yè)大學(xué)研制成功的用于玻璃幕墻清洗作業(yè)的新型爬壁機(jī)器人,它是利用一個真空吸盤附著在垂直壁面上,采用四輪或雙輪單獨(dú)驅(qū)動來實(shí)現(xiàn)在壁面上行走的 。輪子在滾動過程中,真空腔與壁面之間處于滑動摩擦狀態(tài),不可避免地造成密封氣體的泄漏。如果氣體泄漏量過大,不能保證足夠的真空壓力,機(jī)器人就會從壁面跌落。所以在機(jī)器人設(shè)計(jì)過程中應(yīng)盡量選取參數(shù)保證氣體的泄漏量小于某一個值。利用氣體動力學(xué)的有關(guān)知識,不難看出氣體泄漏量與密封氣囊的所受壓力有著極為密切的關(guān)系。另外機(jī)器人是否能夠安全穩(wěn)定地附著在垂直壁面上,取決于其在各向受力及力矩是否平衡(勻速或靜止?fàn)顟B(tài)) 。爬壁機(jī)器人是否能夠在垂直壁面上安全地附著,取決于真空腔內(nèi)的氣體泄漏量,而氣體是否泄漏又取決于密封氣囊上所受的接觸壓力。所以能否精確地解出密封氣囊上的接觸壓力成為了問題的關(guān)鍵。本章利用積分方程的有關(guān)理論求解出了密封氣囊上的接觸壓力分布。進(jìn)一步探討了爬壁機(jī)器人的吸附穩(wěn)定性。
3.2 力學(xué)分析及數(shù)學(xué)模型的建立
首先建立一個坐標(biāo)系如圖3.1 所示。利用牛頓力學(xué)有關(guān)知識可以得到下列平衡方程:
ΣMz = 0
圖3.1 坐標(biāo)系圖
式中: u1 ———密封氣墊與壁面之間的摩擦系數(shù);
u2 ———驅(qū)動輪與壁面之間的摩擦系數(shù);
h ———名義載荷與壁面之間的垂直距離;
R ———爬壁機(jī)器人真空腔的半徑。
在上述方程組中,式(1) 是一個弗氏第一類積分方程, 根據(jù)弗氏積分方程理論[3] , 這個方程有無數(shù)解,即說明僅利用上述方程式無法解出密封氣墊上
的接觸壓力分布。一個標(biāo)準(zhǔn)的Fredholm 一類積分方程的形式如下:
∫Ωg ( x , y) f ( x) d x = q ( y) (4)
在上述方程中g(shù) ( x , y) 和q ( y) 是已知的函數(shù)。這種形式的方程是可解的。為了利用積分方程的理論求解密封氣墊上的壓力的分布。必須構(gòu)造一個這種標(biāo)準(zhǔn)形式的積分方程。如圖3 所示,利用z′軸為力矩簡化軸。而z′距z 軸的距離是y 。y 是一個變量,它的變化范圍可以取- R < y < R 。那么可以得到一個方程如下:
ΣMz′= 0
將式(2) 與式(3) 合并可求得:
F1 = F -{(w - u1 )/(u2 - u1)}(6)
再將式(6) 帶入式(5) , 式(5) 就是一個標(biāo)準(zhǔn)的第一類Fredholm 積分方程。這樣的一個積分方程是很難找到解析解的。把式(5) 對y 進(jìn)行離散??梢缘贸鲆欢鄡r線性方程組。然后可利用數(shù)值方法進(jìn)行求解。詳見文獻(xiàn)[4 ] 。對當(dāng)F = 100 kg , w = 10 kg , h =10 cm, u1 = 0. 07 , u2 = 0. 2 , R = 30 cm時的例子進(jìn)行求解,得結(jié)果如表1
表1
在表1 中q ( i) 中的i 表示節(jié)點(diǎn)號。從表1 的結(jié)果分析可以看出, 密封氣墊上的接觸壓力分布是線性分布的。這與定性分析得到的結(jié)果是一致的。爬壁機(jī)器人密封氣墊的接觸壓力直接影響密封氣墊的密封效果。如果密封效果不佳,爬壁機(jī)器人就有可能從壁面上跌落下來。從上表的計(jì)算結(jié)果來看,密封氣墊上的接觸壓力并不是均勻相等的。知道接觸壓力越大密封效果越好。那么上表中計(jì)算的例子中,密封的薄弱點(diǎn)發(fā)生在節(jié)點(diǎn)‘5’處。從密封氣墊的接觸壓力分布的數(shù)學(xué)模型上可以看出, 影響接觸壓力分布的參數(shù)主要有下列幾個: (1) w : 名義載荷;(2) h :名義載荷與壁面之間的垂直距離; (3) u1 , u2 :密封氣墊及驅(qū)動輪與壁面之間的摩擦系數(shù)。在爬壁機(jī)器人的設(shè)計(jì)過程中,確定這些參數(shù)非常重要。
為了便于說明問題,設(shè)| k | 為接觸壓力分布函數(shù)的斜率的絕對值。從計(jì)算實(shí)例上可以看出, | k |越大分布函數(shù)的狀態(tài)越不佳, 機(jī)器人的密封效果越不好。筆者對上例進(jìn)一步計(jì)算得到下面有關(guān)曲線:
圖3.2 ABS( k) - h 曲線(無量綱- cm)
圖3.3 ABS( k) - W 曲線(無量綱- kg)
圖3.4 ABS( k) - u1/ u2 曲線(無量綱)
從曲線| k | - w 可以看出,負(fù)載越大,接觸壓力分布函數(shù)狀態(tài)越差。名義載荷越小,機(jī)器人的吸附穩(wěn)定性越好,這是非常顯然的。但是在機(jī)器人設(shè)計(jì)過程中可以根據(jù)上面的計(jì)算方法確定爬壁機(jī)器人的極限載荷(不考慮拖動下滑) 。曲線| k | - h 告訴機(jī)器人的名義載荷應(yīng)盡可能緊貼壁面。這給設(shè)計(jì)機(jī)器人的工作執(zhí)行部件時提出了一個要求———盡量輕而扁平。
3.3 本章小結(jié)
這一章里我們討論了,安全負(fù)載的條件和機(jī)器人正常工作下的最大負(fù)載,并建立了真空度與安全負(fù)載的曲線圖,對于爬壁機(jī)器人來說,吸附穩(wěn)定性是一個十分復(fù)雜的問題.這將是不可缺少的一個環(huán)節(jié)
第4章 清刷機(jī)器人控制系統(tǒng)的研制
4.1 引言
控制系統(tǒng)猶如清刷機(jī)器人的神經(jīng)系統(tǒng),負(fù)責(zé)完成對清刷機(jī)器人的行走控制、清刷控制和姿態(tài)的檢測。玻璃表面清刷機(jī)器人要求控制系統(tǒng)滿足:
1. 控制機(jī)器人的移動速度為2~8m/min,調(diào)速方便;
2. 清刷機(jī)器人的工作性質(zhì)決定了需要對其進(jìn)行遙控操作,本樣機(jī)試驗(yàn)系統(tǒng)要求遙控距離>20米;
3. 靈活控制清洗刷,實(shí)現(xiàn)機(jī)器人在玻璃表面上的高效作業(yè)。
4.操作靈活、方便,便于使用。
4.2 清刷機(jī)器人控制系統(tǒng)總體設(shè)計(jì)
清刷機(jī)器人采用二級計(jì)算機(jī)控制系統(tǒng),以保證機(jī)器人即可實(shí)現(xiàn)自主作業(yè),又可人工進(jìn)行操縱,從而提高它的實(shí)用性和可靠性。上位PC工控機(jī)位于樓臺的運(yùn)載小車上,能夠?qū)崿F(xiàn)人機(jī)界面交互,具有環(huán)境初始值輸入,作業(yè)任務(wù)指定,機(jī)器人狀態(tài)顯示,機(jī)器人及輔助系統(tǒng)的動作協(xié)調(diào)等項(xiàng)功能。
4.3 控制系統(tǒng)硬件設(shè)計(jì)
4.3.1伺服電機(jī)驅(qū)動與控制電路設(shè)計(jì)
要使清刷機(jī)器人能在表面上靈活自如的爬行,驅(qū)動裝置的設(shè)計(jì)極其重要,針對本系統(tǒng)所要求的調(diào)速范圍寬、響應(yīng)快、抗干擾性強(qiáng)等特點(diǎn),我們選用了日本安川交流伺服馬達(dá)SGML-02AF14和與之匹配的伺服驅(qū)動器SGDL-02AS。馬達(dá)還自帶有一個高精度增量式編碼器(1024P/R)。伺服驅(qū)動器可實(shí)現(xiàn)速度和轉(zhuǎn)矩的控制,控制方式為單相全波整流正弦波驅(qū)動,具有過電流、過負(fù)載、過電壓、過速度、CPU異常、編碼器異常等保護(hù)功能。本系統(tǒng)采用速度控制方式,伺服驅(qū)動器接受控制系統(tǒng)的模擬速度電壓信號來控制電機(jī)的轉(zhuǎn)速,并且通過模擬速度電壓的正負(fù)來確定電機(jī)的正反轉(zhuǎn),從而確定爬壁機(jī)器人的運(yùn)行速度和運(yùn)動方向。
我們采用的速度伺服機(jī)構(gòu)是一個包含兩閉環(huán)的交流伺服系統(tǒng),如圖4.2所示,系統(tǒng)由速度環(huán)和電流環(huán)雙閉環(huán)組成。其中電流環(huán)的作用是改造內(nèi)環(huán)控制對象的傳遞函數(shù),提高系統(tǒng)的快速性,及時抑制電流環(huán)內(nèi)部的干擾,限制最大電流,使系統(tǒng)有足夠大的加速度轉(zhuǎn)矩,并且保障系統(tǒng)安全運(yùn)行。速度環(huán)
的作用是增強(qiáng)系統(tǒng)抗負(fù)載擾動能力,抑制速度的波動。
當(dāng)交流伺服馬達(dá)采用PWM矢量控制變頻裝置時,可以通過坐標(biāo)系統(tǒng)的靜止變換和旋轉(zhuǎn)變換,將具有強(qiáng)的耦合和嚴(yán)重非線性的交流伺服馬達(dá)模型等
效地變換為近似于直流電機(jī)的模型,等效模型見圖4.3
Id
Im
w1
減速機(jī)構(gòu)
速度
調(diào)節(jié)器
伺服
馬達(dá)
w
wd
+
+
伺服
放大
電流
調(diào)節(jié)器
-
-
編碼器
圖4.2交流伺服系統(tǒng)組成框圖
CT
Tz
Te
Id
ud0
w
-
+
圖4.3 交流伺服馬達(dá)等效模型
由圖4.3可得
(4-1)
式中:ud0—直流環(huán)節(jié)電源的理想空載電壓(V);
Id —直流環(huán)節(jié)電源的理想直流電流(A);
Td—電磁時間常數(shù),Td = L / R;
L—直流環(huán)節(jié)負(fù)載端等效電感(H);
R—直流環(huán)節(jié)負(fù)載端等效電阻(Ω);
Te—電磁轉(zhuǎn)矩(N.m);
Tz—負(fù)載轉(zhuǎn)矩(N.m);
J—轉(zhuǎn)動慣量(kg.m2);
P—電動機(jī)極對數(shù);
w—電動機(jī)輸出角速度(rad/s);
CT—電動機(jī)電磁轉(zhuǎn)矩與直流環(huán)節(jié)電流Id間的比例系數(shù)。
控制系統(tǒng)的模擬速度電壓信號是通過D/A轉(zhuǎn)換器將控制系統(tǒng)的數(shù)字信號轉(zhuǎn)換成模擬信號的,控制電路如圖4.4所示。DAC0832芯片通過兩級運(yùn)放擴(kuò)展成雙極性輸出時,所對應(yīng)的電壓為:
Vout = (4-2)
其中,Vout — DAC0832的輸出電壓(V);
NB — 二進(jìn)制碼;
Vref — 基準(zhǔn)電壓(V)。
圖4.4 電機(jī)模擬速度控制電路圖
增量式編碼器脈沖數(shù)為1024P/R,,如果要使6V模擬電壓信號對應(yīng)的轉(zhuǎn)數(shù)為3000
轉(zhuǎn)/分,則需要設(shè)置驅(qū)動器的額定速度為3000/6=500,從而電壓與
速度的關(guān)系式為υ=500V,其中,υ — 電機(jī)旋轉(zhuǎn)速度(轉(zhuǎn)/分);V — 輸入電壓(V)。
馬達(dá)是高轉(zhuǎn)速、低扭矩的驅(qū)動部件,馬達(dá)的輸出軸要經(jīng)過減速器進(jìn)行減速,才能達(dá)到所需的轉(zhuǎn)速和轉(zhuǎn)矩的要求。我們選用了德國NEUGART公司的PLE80精密行星齒輪箱作為減速器。驅(qū)動裝置能使機(jī)器人在建筑表面上的移動速度可在2~8m/min范圍內(nèi)根據(jù)作業(yè)要求實(shí)現(xiàn)無級調(diào)速,并通過兩輪速度的調(diào)節(jié)實(shí)現(xiàn)機(jī)器人在壁面上的全方位行走。
4.3.2 串行通訊電路的設(shè)計(jì)
本清刷作業(yè)機(jī)器人實(shí)驗(yàn)系統(tǒng)要求通訊距離在10米以上,并且交流驅(qū)動器同伺服電機(jī)連接電纜的長度不允許超過20米。因此,在設(shè)計(jì)時考慮將控制系統(tǒng)安裝在爬壁機(jī)器人上來解決。這時就存在上位PC機(jī)同控制系統(tǒng)的通訊問題,為了節(jié)省傳輸線路,采用串行通訊方式。
鑒于AT89C51單片機(jī)串行口TXD,RXD均為TTL電平,而PC機(jī)配置的是RS-232C標(biāo)準(zhǔn)串行接口,RS-232C規(guī)定的邏輯電平與一般的微處理器、單片機(jī)的邏輯電平不一樣。所以在實(shí)際應(yīng)用時,必須進(jìn)行電平轉(zhuǎn)換。這種轉(zhuǎn)換是由專門的電平轉(zhuǎn)換芯片來實(shí)現(xiàn)的。在標(biāo)準(zhǔn)的RS-232C串行通訊接口電路中常用的集成芯片有MAX201、MAX232等,本文采用的是MAX232芯片。MAX232是由MAXIM公司生產(chǎn)的、包含兩路接受器和驅(qū)動器的IC芯片,適用于各種EIA-232C的通信接口。MAX232芯片內(nèi)部有一個電源電壓變換器,可以把輸入的+5V電源電壓變換成RS-232C的輸出電平所需要的10V電壓。所以,采用此芯片接口的串行通信系統(tǒng)只需要單一的+5V電源就可以了。對于沒有12V電源的場合,其適應(yīng)性更強(qiáng)。加上此芯片的價格適中,硬件接口簡單,因此被廣泛的采用。接口總線變換電路如圖4.5所示。
圖 4.5 接口總線變換電路
4.4 傾角傳感器的原理及其數(shù)據(jù)采集
4.4.1 傾角傳感器的原理
傾角傳感器是一種測量姿態(tài)傾角的傳感器,按照其工作原理,可以分為“固體擺式”、“液體擺式”、“氣體擺式”三種傾角傳感器。這三種傾角傳感器各有所長。在重力場中,固體擺的敏感質(zhì)量是擺錘質(zhì)量,液體擺的敏感質(zhì)量是電解液,而氣體擺的敏感質(zhì)量是氣體。氣體是密封腔體內(nèi)的唯一運(yùn)動體,它的質(zhì)量較小,在大沖擊或高過載時產(chǎn)生的慣性力也很小,所以具有較強(qiáng)的抗振動或沖擊能力。但氣體運(yùn)動控制較為復(fù)雜,影響其運(yùn)動的因素較多,難以達(dá)到很高的精度。固體擺傾角傳感器有明確的擺長和擺心,其機(jī)理基本上與加速度傳感器相同,在實(shí)用中產(chǎn)品類型較多如電磁擺式,其產(chǎn)品測量范圍、精度及抗過載能力較高,應(yīng)用也較為廣泛。
我們選用的是液體擺式的傾角傳感器,其結(jié)構(gòu)原理是在電解質(zhì)溶液中留下一氣泡,當(dāng)裝置傾斜時氣泡運(yùn)動使電容發(fā)生變化而感應(yīng)出傾角,再通過電子線路將其轉(zhuǎn)化為角度值輸出。
4.4.
收藏