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