壓縮包內含有CAD圖紙和說明書,均可直接下載獲得文件,所見所得,電腦查看更方便。Q 197216396 或 11970985
用于汽車零件組裝的工業(yè)雙臂機器人的開發(fā)
摘要
一般的工業(yè)機器人由于只有單只手臂在工作運用中有一定的局限性。盡管某些特殊工業(yè)機器人有雙臂,但它們是單獨工作的。也就是說,每只手臂在控制下按照其基準彈道工作,對工作中的合作性不多以考慮,因此,它們在只能完成簡單的合作工作。近來,一些日本汽車生產商對雙臂機器人的使用產生了濃厚的興趣,因為它們能組裝汽車零件,而這需要機器人擁有雙臂,并且通過位置控制和力控制下能協調合作。我們正致力于開發(fā)能組裝汽車零件的雙臂機器人,其手臂的自由度達6DOF,整體自由度達3DOF,手臂負荷達10kg,可觸范圍達1.5m。此參數是為實現WIA有限公司和機器人谷有限公司的汽車組裝而設計的,并且融合了設計概念。
關鍵詞 :雙臂機器人 組裝 實時操作系統 運動控制器
1.簡介
自面世以來,工業(yè)機器人在各工業(yè)領域發(fā)揮著重要作用。機器人的應用在汽車行業(yè)更為顯著,如果汽車行業(yè)和生產商沒有機器人,那后果是無法想象的。但是,目前在很多領域仍沒有工業(yè)機器人能代替人完成需要雙臂操作的工作。一般的工業(yè)機器人由于只有單只手臂在工作運用中有一定的局限性。盡管某些特殊工業(yè)機器人有雙臂,但它們是單獨工作的。也就是說,每只手臂在控制下按照其基準彈道工作,對工作中的合作性不多以考慮,因此,它們在只能完成簡單的合作工作。近來,一些日本汽車生產商對雙臂機器人的使用產生了濃厚的興趣,因為它們能組裝汽車零件,而這需要機器人擁有雙臂,并且通過位置控制和力控制下能協調合作[5]。
我們正致力于開發(fā)能組裝汽車零件的雙臂機器人,其手臂的自由度達6DOF,整體自由度達3DOF,手臂負荷達10kg,可觸范圍達1.5m。此參數是為實現WIA有限公司和機器人谷有限公司的汽車組裝而設計的,并且融合了設計原理。
就一般工業(yè)機器人而言,用一個示教箱足以指導機器人定位操作,因為利用位置基準一個控制器只控制一只手臂。對于雙臂機器人,由于雙臂需合作完成零件組裝,控制器必須考慮兩只手臂以及組裝零件產生的相互作用力,光用定位指導是遠遠不夠??梢岳秒x線編程技術,但是我們需要更敏感的指示方法,因此采用了主從式技術。我們采用兩個商業(yè)主設備,每個設備都能達到6DOF的定位輸入和6DOF的力量輸出。因此,控制器需及時在0.05-0.01s內為從機器人和主機器人分別提供15DOF和12DOF反向/正向動力。這也正是為什么我們采用基于電腦的控制器的原因。我們將采用運動工程有限公司和實時擴展軟件產品有限公司的windows XP專業(yè)版奔騰處理器,引用控制器的原理和結構。
2、雙臂機器人的工件定義
我們對汽車公司利用雙臂機器人系統實現械零件組裝的自動化非常感興趣。而齒輪傳動和等速萬向接頭的組裝過程是我們的研究目標。毫無疑問,這兩個過程均需要雙臂合作才能完成,也就是所謂的“合作性工作”,所以,單臂機器人無法應用于這些過程。這也是大多數汽車公司在這些過程中未實現自動化的原因之一。
在此,對于這兩個過程我們不會詳述,僅展示一些圖片。圖1顯示的是裝配輸送線,它由很多齒輪和軸組成。圖2顯示的是等速萬向接頭生產線,它由兩個萬向接頭和軸組成。在WIA有限公司,這些都是政府資助的。很多不包含著兩個過程的汽車零件的生產線已經實現了自動化。雙臂機器人是為實現這兩個生產過程自動化而設計的。
雙臂機器人的高度需達1.5m以承受10kgf,克服轉矩10N.m,使轉動速度達150deg/s,這就要求可重復性達0.1mm。表1列舉了雙臂機器人要完成目標程序的參數要求。
圖1
圖2
表1
3、機器人設計
雙臂機器人多種多樣,有不同的運動結構,但大多數人形機器人的軀干自由度達3DOF,手臂自由度達6DOF。本課題研究的雙臂機器人與大多數人形機器人在運動結構上有所不同,雖然它們的自由度相同。圖3顯示了它們之間的區(qū)別。大多數人形機器人和人有類似的運動結構,但是我們所研究的雙臂機器人的運動結構不同,它的雙臂的運動結構和美洲獅的及其相像。我們期望它的動作和人類也不一樣。
人形機器人 本研究設計的機器人
圖3
我們設計的雙臂機器人要運用于傳送組裝線和等速萬向接頭組裝線,這要求手臂的末端功能器能360度不停旋轉。如果雙臂機器人的運動結構如圖3左邊所示,那么每只手臂需有一個額外的旋轉夾。這樣,將會降低其負荷或者需要更強勁的馬達系統。因此,選擇了圖3右邊所示的運動結構,最后一個接頭能使末端功能器實現螺旋運動,是組裝線360度旋轉。另外,這個運動結構還要一個優(yōu)點,那就是所謂的“解耦”,反向運動在閉合形式方案下也得以簡單表達。這都是我們選擇這種運動結構的原因。
圖4
圖5 雙臂機器人設計工具
圖4顯示的是機器人右臂的簡單草圖以及符合表1所示參數的設計。為實現工作分析,預備了運動解決方案,并開發(fā)了目光鑒定儀和簡單的雙臂分析工具,以便在制造過程中能夠進行運動評估和檢查控制計算等。圖5顯示的是雙臂機器人的設計工具。
4、控制器設計
圖6顯示的是控制器的總體構造,它由中心主機,可是控制器,遙控控制器和機器人控制器組成。所有這些控制器均基于電腦系統,并且每個控制器都通過CAN總線相互連接,控制器間可以實時交流信息。離線編程,視覺系統和遙控控制器不在本研究范圍內,在此只介紹機器人控制器。
圖6 控制器構造
一般的機器人控制器在機器人開發(fā)系統中非常實用,它對機器人運動參數和控制參數都起到借鑒作用。相對簡單的機器人而言,大多數普通機器人的控制器是可以利用的。但是要開發(fā)特殊的機器人,這些控制器則不可用,因為它們沒有所謂的“開放式體系結構”。用戶不能存取運動方程式的源編碼,所以特殊機器人不能用普通機器人的控制器。目前市場上還沒有轉為雙臂機器人設計的商業(yè)機器人控制器,因此,必須先開發(fā)雙臂機器人的專用機器人控制器。
開發(fā)雙臂機器人的專用機器人控制器有兩種方法:開發(fā)特殊的控制器板或使用商業(yè)運動板。本研究選用了運動工程有限公司的帶有ZMP網絡同步并基于電腦的機器人控制器,此外工業(yè)電腦也正在開發(fā)中。另外還選用了實時控制器。ZMP網絡同步的運動板是普通的運動板,它采用的是集成計算技術,當多根軸同時工作時,其控制頻率就降低了。它一次可控制4根48khz的軸,32根2khz的軸。它有明顯的特征那就是將用數位傳輸運用于馬達驅動器上,另外運動工程支持實時操作系統、RTX、RTLinux的軟件驅動。普通運動板沒用支持實時操作系統的驅動,所以不能用來組成基于電腦的機器人控制器。
RTX是windows XP的一種實時擴展,它的中斷等待時間很短(<10us)。RTLinux是最好的實時操作系統之一,但是對普通用戶而言在Linux系統中很難開發(fā)軟件,因此沒有選擇RTLinux系統。大多數電腦用戶使用windows XP,并且已經開發(fā)出了很多軟件開發(fā)包。考慮到市場情況,windows XP 是最好的操作系統,但是,windows XP不支持實時計算也不是非常穩(wěn)定的系統,所以,選擇了RTX。RTX在windows XP的基礎上增加了實時計算功能。圖7顯示了RTX的功能[4]。
圖7 RTX和windows
產品有限公司說RTX在單個CUP系統下中斷等待時間克達10us,但是我們的實驗結果和他們說的有所出入,因此選擇了雙核奔騰處理器。如果CPU大于兩核或是兩個CPU,那么RTX能不受windowsXP的影響而充分利用單核或者單個CPU。所以,即使電腦由于藍屏關機RTX也能在測試時保證中斷等待時間不少于2us。
用有獨自控制運算法則和軸插值的運動板組裝基于電腦的機器人控制器,主從控制器的同步性至關重要。RTX要有自己的計時器,運動板也使用單獨的計時器,所以選擇了ZMP網絡同步簡單機械霧化油槍[3]。
ZMP運動控制器能夠以特定頻率中斷主機,且頻率是控制器樣品頻率的幾倍。該主從式中斷被稱為同步中斷。對于需要使控制器和樣品所需的計算數據同步的系統,ZMP固件都有一個主程序標志。這個標志用于顯示主機軟件正在工作,并將所需的數據傳輸給ZMP,它是在主機工作后數據傳輸前由同步器同步開啟的。當所有程序完成后未進入休眠和等待下一個同步前主程序標志會被主機清除。ZMP軟件能在每個周期開始工作前檢查主程序標志,如果主程序標志在開始工作時是一個靜止的點,那么軟件便會在控制對象內設置一個狀態(tài)位以表示主機未及時完成工作任務。圖9顯示了電腦主機和運動板(ZMP)在是如何同步使用的[3]。
5、總結
雙臂機器人應用于汽車零件足證過程,它的控制器采用了工業(yè)電腦、ZMP運動板、微軟windows XP和RTX技術。介紹了雙臂機器人設計理念和運動結構,主機和ZMP運動板實現同步的方法以及RTX達到最短中斷等待時間的方法。
圖9運動板和主機的同步性
謝辭
感謝MOCIE和慶尚南道政府對本研究的大力支持。
參考文獻
1] Mark W. Spong, M. Vidyasagar, Robot dynamics
and control. John wiley & Sons, 1989
[2] John J. Craig, Introduction to Robotics, Addison
Wesley, 1989
[3] http://support.motioneng.com/Software-MPI/Top
ics/sync_interrupt.htm
[4] RTX Datasheet, Ardence (www.ardence.com)
[5] www.yaskawa.com
2011 IEEE/RSJ國際會議
智能機器人系統
2011年9月25-30日,舊金山,CA,USA
手腕和前臂可旋轉的DLR手臂系統:
機械設計,形狀分析及實驗驗證
Werner Friedl, Hannes H6ppner, Florian Petit and Gerd Hirzinger 德國航空航天中心(DLR),海燕,德國機器人與機電一體化研究所
郵箱:Werner.Friedl.Hannes.Hoeppner.Florian.Petit}@dlr.de
摘要
DLR手臂系統是基于變剛度的概念,這個進來提出的概念大大地提高現代影響的魯棒性和能源效率機器人。本文還引入了工作在雙向拮抗變剛度(BAVS)合資的概念,就是拮抗關節(jié)的延伸。這三種機械的設置利用不同的彈簧和凸輪盤組合,對實現預期的轉矩剛度特性進行了分析。雙BAVS的接入可以作為DLR手臂系統中手腕和前臂旋轉的聯合解決方案。此外,在實驗部分對偏轉扭矩余的校準和驅動進行了驗證。
I. 簡介
近來的研究的發(fā)展引導了可變抗撓性關節(jié)機器人技術。據報道DLR已經開發(fā)出了生物機動可變剛度機器人手臂稱手臂系統(HASy)。機械手含有26個自由度,其中19 自由度安裝在手部,另外7個自由度整合在前上臂上的所有電子設備。在幾個變剛度制動器(VSA)調整位置和剛度的同時,不同研究者要進行相應的分析。使用變剛度制動器擁有幾個好處,例如內在的依從性使在關節(jié)處來存儲機械能提供了可能,類似于人類。彈性元素的低通濾波特性對魯棒性原因息息相關。此外,能量存儲性質可以適用于高度動態(tài)的動作,比如扔球或在散步。在機器人安全背景下,被動遵守也進行了討論。
雖然VSA的想法類似于提到的所有的聯合原型,但是較大變化的機械執(zhí)行性和對不同VS接頭評價是正在進行研究的議題。也因此多個不同的VS關節(jié)已經應用在的DLR手臂系統。對于19自由度拮抗原則,也類似人類的手的彈性肌腱。該手臂關節(jié)1-4,即肘和肩關節(jié),實施浮動彈簧接頭(FSJ)。一個叫做雙向拮抗變量剛度(BAVS)原則的概念已被同時用于前臂和腕關節(jié)。本文的目的是引進雙向拮抗變量
剛度關節(jié)在HASy。
本文以以下方法敘述,我們首先評估雙向拮抗變量剛度的要求和托架設計,BAYS與上文中提到的DLR手臂系統YSA原則相比。接下來,我們分析預期轉矩剛度凸輪盤機構的結果,它主要影響VS性能的聯合。我們將集中在不同凸輪盤的組合和線性彈簧,線性彈簧由機械前臂和兩個腕關節(jié)設計主導。最后,我們將與第一次測量雙向拮抗變量剛度關節(jié)剛度的結果比較,,并顯示自動適應性的結果。
圖1.DLR手臂系統
II.BAVS聯合
DLR手臂系統包含多種不同聯合類型。BAVS聯合的原則是用于執(zhí)行的手腕和前臂關節(jié)的執(zhí)行。這種選擇所提出的要求如下。
A.要求:由于腕關節(jié)和前臂旋轉接頭的位置,與其他HASy關節(jié)比較,要求是不同的:
l 手腕:為了實現與人類的大小相同的不能放在重合位置的手腕腕關節(jié)執(zhí)行器關節(jié)軸,只能放置在前臂靠近肘部。因此,電機的轉矩要被轉移到手腕的前臂,類似于在手指肌腱實現權力交接關節(jié)。
l 手腕:此外,機械動力的傳輸必須盡量徹底,以實現致動器直接耦合到手腕。手指的運動能一定程度耦合到手腕上,這是很重要的。因而靈活的肌腱不能使用。
l 前臂:前臂旋轉接頭的主要挑戰(zhàn)是由電纜提供的電源,水冷管,以及通信總線電纜傳輸到前臂的傳輸,同時允許旋轉范圍1800?
l 另外,電源的前臂和兩個腕關節(jié)的尺寸比進行優(yōu)化,因為在有限的空間中含有前臂的42個致動器。
l 與肩部和肘部關節(jié)相比,手腕和前臂只需要較小的慣性和重量來支持要求較低 的扭矩能力。
其他VSA接頭則必須完成更多的要求,以滿足低摩擦和低轉動慣量的機械設計,以實現高的動態(tài)能力。
BAVS聯合概念使用更加適合這些要求。以下將闡述這種選擇各種的細節(jié)。
B. BAVS原則:
圖2.使用肌腱的對抗性和BEVS傳動原理
設計細節(jié)之前,已經給出主要性能的BAVS原則。在圖2中,標準的拮抗原理和BAVS原則的進行了比較。剛度和位置的改變的方式是相同的:共同運作彈簧引起了剛度的變化,同時同步運動電機用來在結合處產生扭矩。而本質的區(qū)別是,兩個電機的BAVS聯合具有推拉聯合的功效。因此,關節(jié)的最大轉矩等于兩個電機的轉矩的總和。
(1)
其中,1和T2是由兩個電機提供的轉矩。失速扭矩Tstall的是一臺電機的最大扭矩。這種BAVS原則上使用電動機的支持方式稱為幫助模式。總鏈路剛度k等于的剛度K1(T1)和k1(T2)每個馬達的彈簧單元的總和。
(2)
圖4顯示了BAVS聯合設置一個彈簧和兩個對稱凸輪盤,以及兩個特征模式。在圖4 b)該接頭是在幫助模式下,這兩個凸輪盤在相同的方向上提供了一個扭矩。在正常模式下,與所提供的凸輪盤的相對轉矩如圖 4C)所示。 圖3.
圖4
FSJ(如一個大的馬達的小型電動機的位置和關節(jié)的剛度改變)和拮抗原則相比,雙向對立導致高功率尺寸比,因為它主要所需的前臂和兩個腕關節(jié)。
C.機構的建立
對高剛度手腕的要求,為了避免手腕運動的無故損壞,不采用肌腱基于VSA機制。相反,諧波傳動齒輪三部分的設置控制同步電機彈性元件和驅動側的接頭,見圖3。
聯合運作以下列方式進行,參照圖3。波發(fā)生器連接到電機。正齒輪和柔性花鍵鏈接以輸出。所有圓形花鍵都連接到非線性彈性元件。移動兩個在相同的方向上的馬達使鏈接(正輪)的位置的變化。如果移動相反方向的無連桿運動的電機,柔性花鍵會被連桿互相阻擋。在圓形花鍵施加的扭矩,可以使非線性彈性元件張緊。通過阻斷電機,任何外部的運動鏈接將加載彈簧元件。因此,一個自然的扭力 - 角度關系與非線性增加轉矩是可以實現的。
剛度的非線性元件是通過非線性凸輪盤制動一個或多個線性彈簧。凸輪盤的形狀也可以影響扭矩剛度曲線的聯合。
在幫助模式下,轉矩—剛度曲線的影響的變化分析。
III.BAVS形狀分析
第II-C提供建議的機械安裝主要有兩種設計參數。首先,線性彈簧的數量(一個或兩個)和第二凸輪盤的形狀(對稱或不對稱)。在以下三種不同的設置進行了分析。
最簡單的設置是只使用一個線性彈簧的單個彈簧解決方案,如圖5a)所示。雙彈簧解決方案使用了兩個而不是僅一個彈簧,但在相同的設置有兩個凸輪盤,見圖5 B)。第三個分析的設置,和包含兩個彈簧和四個凸輪盤,如圖所示。5 c)圖5
所有的接頭都要滿足最大扭矩為8 Nm,相當于兩個失速轉矩馬達(Tmax = 2· Tstall = 8Nm),偏轉角為15°。線性彈簧的剛度采用22.1 kN / m。
A. 單彈簧方案
最簡單的可能的解決方案是一個彈簧和兩個對稱的凸輪盤(參見圖5)的組合,并需要最少的建造空間。由兩個對稱的凸輪盤的聯合施加的扭矩可由下列公式算出
(3)
¢關節(jié)的偏轉角,是凸輪盤的預緊角,c是回彈力,r是凸輪盤上杠桿比邊緣到凸輪盤中心的距離,,和,是凸輪盤和彈簧偏轉的偏轉角和它們的衍生物之間的關系的數學函數描述。關節(jié)的剛度是扭矩相對于偏轉的導數。
1)對稱凸輪盤:對于對稱的外形設計剛度,圍繞零偏轉¢= 0°為低電平時,當凸輪輥半徑限制了凸輪盤的形狀。這是因為以保證正確的凸輪滾子的滾動,曲率凸輪盤的凸輪半徑小于滾筒。因此,對于一個對稱的凸輪盤形狀的約束是必要的,以避免間斷。
圖6
一個彈簧解決方案也有缺點,預拉伸的關節(jié)的扭矩變化范圍是有限的,因為只有兩個凸輪盤幾乎完全偏轉,才可以產生最大的彈簧力。在正常的拮抗模式下,最好的結果只有約四分之一的最大扭矩,圖6頂部說明了這一點,其中的扭矩剛度關系為單個彈簧對稱的外形設計的解決方案做出了描繪。圖中的虛線示出了預拉伸為a =50%,它使約四分之一可達到的最大扭矩。此外,該圖表可作如下解釋:在曲線之間的步長大小等于10%預緊遞增。此外,其中一個電動機的Tstall曲線已用粗體打印在圖中,因為這條曲線相當于正常和幫助對抗模式之間的邊界。最低的曲線相當于非預緊機制()。最高的曲線對應為=90%的預拉伸。
此結果也可以通過轉矩剛度曲線的最大的剛度變化得到驗證。在此,用指數特性
(4)
e和d都是正常數,如果對稱凸輪光盤設計假定(和),(3)式就可轉變?yōu)?
(5)解決這個微分方程,將引入凸輪盤形狀與.所以一個彈簧和兩個對稱凸輪盤的結合,以實現所需的特性的不足。
2)非對稱輪盤:另一種可能的單彈簧的解決方案是兩個不對稱的凸輪盤結合,非對稱的圓盤意味著并不取決于,見圖5。為了實現一個使用分段函數的非對稱形狀的設計,從中心的偏移如下所述。不對稱圓盤形凸輪盤的一個例子是
(6)
其中RI和R2是不同的半徑。圖6的底部,描繪了一個分段的非對稱外形設計的扭矩剛度。最大50%的預張力的扭矩比最大對稱形狀扭矩幾乎大25%。
B.雙彈簧方案
由于一個彈簧解決方案的局限性,使用兩個彈簧與兩個不對稱的凸輪相結合將之代替。然而,如圖5所示的設置需要多一點的空間。
關節(jié)扭矩以下列公式計算
(7)
與不對稱的外形設計和支撐的單彈簧解決方案相比,可以產生兩倍的轉矩(幾乎是一半),相當于 50%的預拉伸。因為這兩個凸輪盤設計了完全偏轉的彈簧,彈簧的最大彈簧力總是可以被充分利用。對于單個彈簧的解決方案,在50%的預拉伸彈簧只能使最大撓度的一半偏轉。因此,這一機構的力矩剛性的帶寬增加。
C.兩個彈簧和四個凸輪盤的方案
最后一個分析的設置包含四個形狀不對稱的凸輪盤和有兩個彈簧的結合,見圖5。不對稱的凸輪盤允許一個非零的剛度,即使在零偏轉。單獨的凸輪盤安裝在兩個圓形諧波驅動齒輪的花鍵上。每個凸輪盤之間傳輸一個彈簧力。所要求的轉矩曲線,必須分為四個相同的鏡像曲線。通過凸輪盤上兩個彈簧的預張緊,產生了一定的扭矩。
圖7
圖8示出所得的指數扭矩剛性的關系,通過以下方式獲得(4)和(5)。這種方法給出了的扭矩剛度外形設計最大的靈活性。
圖8
與圖6中的非對稱的圓形形狀相比,如果預張緊凸輪盤,剛度減小更快。扭矩剛度特性也由任務而定。因此在這一點上,不能給一個通用的答案。
IV.設計
A. 前臂旋轉設計
達到一個最佳的封裝密度的效果,前臂旋轉使用了錐齒輪系統,而不是使用一個直齒圓柱齒輪系統(圖9)。出于同樣的原因,彈簧被放置與電機的旋轉軸平行。裝有冷卻水且用于控制電機的手的和完整的前臂的電纜,通過一個內孔的錐齒輪,與旋轉軸線平行。三個電位器是用來測量兩個凸輪盤的位置和連桿
圖9。
B.手腕設計
對于手腕的輸出,為了使相應的電機盡可能放置在靠近的基站點的前臂的地方,可引導的正機架的取代了斜輪。此外,該線性彈簧放置在垂直于電機的旋轉軸。這就使前臂內部有一個緊湊的設計。圖10示出了橫截面的在手腕BAVS驅動。
V.測量和實驗
A.扭矩剛度形狀校準
基于VS聯合的高精密的扭矩,需要扭矩撓度曲線的非線性的精確的校準。我們測量了手腕和前臂BAVS的轉矩偏轉曲線,使用一個安裝了額外的杠桿臂的測力計,來對平動旋轉的前臂進行測量。對于手腕扭矩撓度曲線的測量,測力計是直接連接到驅動手腕。
手腕上的制動,是由一個對稱的圓凸輪盤的形狀來實現的。理想曲線和所獲得的測量值示于圖11中。只要連接桿的剛度和測力計安裝有瑕疵,又會有微小的偏差。
圖10
圖11.
前臂旋轉扭矩 - 位移曲線示于圖12中。
再次使用對稱的圓,最大扭矩的減少是清晰可見的。與在圖11中的手腕上測量相比,由于制造公差較大的滯后需要追蹤,將來的聯合方案將會減少這一點。
圖12
B.全自動剛度適應、
如果接頭處于對立的模式,最大的關節(jié)力矩是電機停轉轉矩的一半。對于某些應用中,通過使用幫助模式達到更高的扭矩是必要的。在圖12中,關于正常與幫助模式的切換,已經給出了算法。采用的方法是減少的凸輪盤的預張力,當電動機的轉矩太高。
該方法可以實現實時模式的改變。關節(jié)內的阻尼是必要的。對于預拉伸的最大轉矩的計算方法,如果超出,則預張力會降低測量扭矩與最大扭矩的線性差。實驗在安裝了杠桿臂的旋轉前臂進行。外部扭矩手動生成。在圖13中是無剛度自動適應下力矩和剛度的繪制。如果達到第一電機的停轉轉矩,電機將被復原。在圖14激活了剛度自動適應。如果凸輪盤扭矩達到2.4 Nm,第二個凸輪盤預緊就會減少。
C.冗余驅動一個電機故障
沒有進一步分析的BAYS聯合的性質是電機的冗余,它增加了系統的魯棒性。
電機的對稱設置,實現了獨立的運動及以疊加的方式生成的剛性的接縫。考慮只有一臺電機的運作的情況下,由于第二電動機的故障,關節(jié)的剛度不能被改變,但仍然可以設置關節(jié)位置。雙向的方法可以驅動有故障的電機復原。這是一個很大的優(yōu)勢,對于自主工作機器人來說,因為一臺電機的故障不會停止機器人的基本功能。
圖13
余下的最大可達的鏈路轉矩依賴于運行的電動機的停轉轉矩減去失效電機驅動齒輪所需的轉矩。通過轉矩的計算計算補償的電機的位置。圖15示出了BAYS聯合在位置控制與電機閉合的關系的曲線圖。前面供給的計算出的位置可以使凸輪盤的偏轉完成反向驅動動作。
(8)
(9)
反向驅動扭矩隨著鏈路速度增加而增加。反向驅動將會記錄在額外的測試,同時測量齒輪的效率。
圖14
圖15
VI.結論與今后的工作
本文提出了,實現使用的諧波傳動機制雙向拮抗關節(jié)DLR手臂系統。具有不同的彈簧和凸輪盤的設置的三個主要的設計概念已被評估,并優(yōu)化在一定轉矩能力和剛度的范圍內,尤其是在幫助模式。還展示了手腕和前臂旋轉關節(jié)DLR的手臂系統的機械設計。,以及上文關于連接測量的校準和兩個實驗。首先,自動僵硬適應方案的實施提供最大扭矩。 其次,對電機有障礙的情況下進行了評估。在今后的工作中,非對稱形狀的設計的增加帶寬的剛度扭矩曲線將會實施和評估。此外,如果鏈接轉矩由兩個馬達的共享,也對系統的能量消耗在不同的狀態(tài)下記性評估。此次結果達到了預期的DLR手臂系統任務的執(zhí)行,還提供了扭矩剛度外形設計有價值的研究成果。
VII致謝
這部分工作由歐洲委員會第六框架計劃資助,作為STIFF項目之一,編號231576,也作為VIACTORS項目的之一,編號231554。
現場可編程陣列的三自由度的數字控制系統機械手
摘要
這項工作是以展示設計過程和執(zhí)行三自由度機械手為目的的,被由超高速集成電路硬件描述語言的數字系統控制,以及被現場可編程陣列執(zhí)行。用于控制的數字系統是通過互相連接的電路和功能塊設計的。
現場可編程陣列終端被用來控制三個步進電機序列,這種方式實現了三自由度機械手的運動,在控制系統和發(fā)電機中的接口階段是被基于晶體管的電力電子電路所開發(fā)的。這個設計是一個試圖說明設計階段以及主要關于機械手運動的數字控制系統的理論模型。對于這種情況,機械手設計并不依賴一個特定的情況,這是一個免費的軌跡,與此同時用戶能通過現場可編程陣列的界面決定機械手的運動。機械手通常沒有能力去移動大部件,既不能升大重力物體,也不能成為一個簡單的結構模型和被每個人訪問除非能用可循環(huán)材料建造它,它被做成這種形式只是處于教育的目的。
1.介紹
對現代人來說,根本不可能去構思他們的生活如果沒有數字電子的存在,因為電子應用出現在人們日常生活中的數量是巨大的,數字電子的應用是非常多和非常普遍的。
【1】傳感器,微芯片和致動器被普遍用于現在生產中。甚至傳統的機械工程領域的汽車工業(yè)也用微芯片在現代交通工具和機械結構
【2】機電一體化和有關的各種學問去接近設計工程發(fā)展的解決方案,提供一個重要的方向來跟隨教學和研究。因此,對成功的工程師來說這樣一個多學科學位的教學已經成為必要。
【3】世界上的大學用在機電一體化和機電工程方面介紹新學位來回報的方式出現。因為在相同的方式,它也通常發(fā)生在數字電子技術和電子產品,在很多應用里我們能找到電子設備涉及機械設備,其中的一個應用就是機械結構控制。
【4】在控制和施工條件下,教育和演示目的一個機械手,和大的工業(yè)機械手有相同的結構的,因此,理解用于控制他們的技術的設計是非常重要的。每一個數字系統設計開始于一組規(guī)格和完成模式開發(fā)的特性,此外它它用布爾運算功能所表示的邏輯圖結束,同時它被編程到現場可編程陣。
【5】實際上,邏輯設計師的任務是簡化使用描述性語言的電路。雖然多樣化的描述性語言存在,非常高速的集成硬件描述語言是最受歡迎的和使用時間最長的。硬件描述語言的描述性語言的目的是開展在可編程序邏輯方面的電路領悟,這技術是已知的像設計合成。
被提出的數字系統來控制機械臂是由自上而下的分層設計技術。使用這種技術,設計師有從容分開設計階段,確定幾個抽象水平,能夠治療系統黑盒來開發(fā)他們用并行方式。這個項目被分為三個主要部分來講:機械部分的手臂,電力電子接口電路和FPGA階段。非常重要的說,擬議中的數字系統的用來控制步進電機是不會考慮一個特定的軌跡。在這個項目中,數字系統,如同樣的方式,機械設計,不依賴任何運動軌跡。這是一個被推薦的FPGA接口所以運動軌跡是由用戶決定。圖1顯示了這個項目是主要部分劃分:
圖1設計過程階段
2.發(fā)展
2.1機械階段
機械階段重點建設機械臂結構,為此,各種各樣的元素被實用,如鋁鏈接、齒輪、滑輪、帶輪、步進電機、軸、參考線以及一些公共設施的元素在停止實用的的電子設備中都有包含。這個階段的項目很有趣,因為在齒輪、帶輪、滑輪中的機械聯合體,他們自己的生產,所有機械設備被放置在一個精確的方式來獲得想要的運動。圖2顯示了機械作臂是如何建立。
圖2三自由度的機械臂結構
圖2顯示了臂是如何被建立去完成三自由度的運動:在圖像的劣質部分,第一馬達是被鑒別的,允許整體的運動基于手臂的位置;在左邊圖像的優(yōu)越部分的馬達有助于開展二自由的運動,相當于第一個鏈接的運動,以其各自的機械連接,允許想要運動離開;最后,圖2也顯示了步進電機,是定位于攜帶出了運動的第三和最后的自由度,適當的加入這個運動反映了機制的第二環(huán)節(jié)。機械臂結構是建立在一個自由的方式,對于這個項目沒有必要采取合成過程來確定結構尺寸,比如鏈接的長度,基于一個特定的精密點軌跡。結構尺寸是任意選擇的和機械臂結構不是考慮一個特定的運動軌跡而建立。圖2沒顯示了機械臂的執(zhí)行機構由于目前情況下,執(zhí)行機構可以是一個螯,伊瑪目,一個支承面,一個電磁鐵,一支鉛筆,它實際上可以是任何東西,機械臂執(zhí)行機構是用戶的決定。
2.2電子階段
電子的階段主要是使用的電力電子接口連接FPGA和步進電機安裝在機械臂結構。這個FPGA包含一個非常廣泛的邏輯包為了應用現狀,但它的終端不能直接與步進電機相連接,因為步進電機電流的需求比支持現場可編程門陣列的要大得多。為了解決這個問題,有必要實現”接口電路”,它可以解釋FPGA輸出和采取相應的行動使發(fā)動機給必要的和足夠的力量,同時FPGA是受保護的。為此,光學絕緣體被用來在FPGA輸出和步進電機的輸入間消除身體接觸。圖三顯示了電路的應用原理圖:電力電子接口電路顯示在圖3是只有一個步進電機相,它是必須實現12次同樣的電力電子接口電路,因為每一個步進電機有四相和這個項目使用三個步進電機相來運動。有時FPGA輸出有一個非常低電壓水平,這就是為什么另一個電子電路選擇界面在FPGA和光絕緣子之間放一個緩沖區(qū),但對于目前的項目它不是必需的。光絕緣子輸出與相應的步進電機相具有相同的狀態(tài)(激活或禁用),但它是孤立于FPGA和有一個電壓水平稍高于它的輸入。光絕緣體輸出不能提供步進電動機所需求的電流,這就是為什么電力階段是適當的。高輸出增益的達林頓晶體管配置,被用在功率階段。最后,接口電路也有相應的步進電機相線可用的連接器:步進電動機常見的終端連接到供給電壓(Vcc),相應的步進電機相連接達林頓晶體管集電極。圖4顯示了完整的接口電子電路的實作界面及其到FPGA的連接:
圖4連接到FPGA電力電子接口電路
有許多不同的方式來實現功率電子接口電路,因為有大量的電力電子設備可以使用,這只是一個標準的電力電子接口電路和用戶可以決定使用哪些電子設備來實現它。
2.3現場可編程門陣列階段
FPGA階段包括在被VHDL描述的數字系統,它能夠控制機械手臂的運動。本設計提供了激活感覺和運動資格的選擇:用戶選擇想激活的電動機,它移動的意義和希望最后它可以激活運動的開始。可以使用的可編程邏輯作為一種個性化的邏輯設計,也就是說,設計思考關于自己的硬件。第一個器件是編程的通過面具,他們被電腦制造商開發(fā)的,在60年代初可編程序邏輯到達可融化的程度,從那時,這種技術對大小用戶的使用都很普遍。用一種更簡單的方法來描述數字系統為控制機械臂運動多樣化,它們使用的功能塊允許執(zhí)行必要的功能。數字系統被以下功能模塊建造借助分層設計基金會:時間坐標,步進電機有限狀態(tài)機和控制有限狀態(tài)機。
圖5數字系統功能塊
圖5顯示了數字系統功能塊并給出一個關于的互聯互通他們的主意,包括用戶選項用于選擇一些機械臂運動。時間坐標功能塊是像一個振蕩器,它確實沒有從用戶收到任何價值或命令,但它發(fā)送一個預先確定的和持續(xù)期脈沖控制有限狀態(tài)機,對于這種情況,周期是1 ms;在時間坐標生成的相對低頻脈沖功能塊用于處理相應的步進電機相來通過電力電子接口電路,同時,它允許解釋目前步進電機階段狀態(tài),來影響運動序列有變化的時候;具體來說,時間坐標功能塊設計可以像一個常數模塊計數器,由用戶決定的計時模塊,這種方式,時基脈沖周期可以有很多價值,但是所給的不改變;這是必要的時間坐標脈沖對電力電子接口電路設備有一個好操作。步進電機有限狀態(tài)機接收來自使用步進電機的轉向感(連續(xù)波或反時針方向)和步驟類型(退或全部步驟)值,同時用戶選擇步進電機運動開始的資格信號。顯而易見,用戶激活相應的步進電機將感覺信號,這一步類型的信號和選擇想要移動的步進電機,所以機械臂結構可以采取很多不同的運動軌跡。這是為什么機械手臂運動確實不依賴于一個特定的運動軌跡,因為用戶可以決定,實際上決定了,機械臂運動軌跡。步進電動機有限狀態(tài)機發(fā)送來控制有限狀態(tài)機的相應的步進電機相階段與從用戶選取的運動特征;步進電機有限狀態(tài)機包含適當的步進電動機相序為了生成兩個感覺運動,也包括一半和完整的步驟運動。
圖6步進電機有限狀態(tài)機
圖6顯示了步進電機有限狀態(tài)機的國家和它的特征。資格信號,轉換信號和步進式信號是輸入信號和它們的值從用戶直接定義的。步進電機的階段可以分化為兩種不同的方式:第一個只有一個極化階段,第二個有兩個極化階段??傊?步進電機有限狀態(tài)機認為四個狀態(tài)只有一個極化階段和另外四個個狀態(tài)的兩個極化階段,這樣一般和完整的步驟運動都能生成。沒有任何國家有三個或四極化階段,因為它不是一個為了興趣的步進電機運動。圖6也顯示了可能的運動序列:連續(xù)波和完整的步驟,連續(xù)波和半步驟,反時針方向和完整的步驟,最后,反時針方向和半步驟。步進電機的有限狀態(tài)機在圖6提供了一個參考狀態(tài),有限狀態(tài)機決定當復位信號(RST)被激活。復位和fpga時鐘信號是最高層次的信號因為復位信號重啟所有數字系統和時鐘信號,使這個設計成為一個同步數字系統確定數字系統操作速度,但另一個高的層次結構信號是資格信號,有資格的信號用戶允許或者阻礙選擇的步進電機運動,這樣,當資格信號是禁用的步進電機不動。轉變感覺和步進式信號不會有一個高的層次,但他們是很重要的,因為他們決定運動特性。對于目前項目有必要考慮半步驟的運動,因為它是更精確的運動相比完整步驟的運動,這種方式,提出的控制數字系統提供了兩種精度水平的步進電機運動,因此,可能得到更好的機械臂定位??刂朴邢逘顟B(tài)機接收時間坐標脈沖,相應的步進電機相狀態(tài)依據從用戶和步進電機的選擇信號選定的運動特性;時間坐標脈沖步進電機相階段來自內部功能塊,但步進電機選擇信號來自用戶;控制有限狀態(tài)機詮釋步進電機相狀態(tài)依賴于從步進電機有限狀態(tài)機選擇的步進電機運動特性,用戶選擇步進電機希望移動和控制有限狀態(tài)機指定相狀態(tài)到對應的步進電動機。這個過程是按以下方式進行:控制有限狀態(tài)機接收步進電機相狀態(tài)擁fpga時鐘速度,這就是說,每一個fpga時鐘脈沖控制有限狀態(tài)機更新對應的步進電動機階段狀態(tài)和運動資格信息,這樣,任何運動序列幾乎立即改變產生的相關的行動,FPGA輸出狀態(tài)也幾乎立即反映這種變化的影響;時間坐標功能塊的工作作為一個常數模塊計數器和發(fā)送控制有限狀態(tài)機的一個由設計師決定的常數周期脈沖。
控制有限狀態(tài)機發(fā)送給FPGA輸出相應的步進電動機相階段來選擇步進電動機, 但不是在fpga時鐘速度,它發(fā)送那個的價值在時間坐標脈沖速度。所有數字系統提出功能塊是和fpga時鐘完全同步的,但有必要減少它的頻率并用一個適當的速度進行相應的步進電動機相狀態(tài)。
1. 結果
結果的每一個階段在那個設計里被劃分成以下部分: 機械臂結構被建立在適當的位置安裝電機,在每一個三自由度生成一個自由運動; 一個基于功率晶體管的接口電路設計, 連接FPGA與步進電機; 最后,一個數字系統被設計生成必要的和適當的信號來控制機械手臂運動。如前所述,無論是機械臂結構和控制步進電機運動的數字系統并不是考慮一個特定的運動軌跡, 但它是提出一個FPGA接口采取關于轉換意義相應的價值, 步進式和從用戶選擇的步進電機。在接下來的四個圖片,可以看到控制數字系統仿真程序的結果。這是重要的說,照片顯示所有可能的運動的類型,連續(xù)波和完整步驟,反時針方向和完整步驟,連續(xù)波和半步驟,CCW和半步驟,最后, 一個額外的“堅持”的狀態(tài),但只有一個步進電機。仿真結果,數字7,8,9和10展示只會是選擇步進電機的運動選項。為了獲得一個正確的模擬他們定義一些控制信號。
這些信號是一種標志,可以給關于步進電機運動條件的一些信息:信號(RST)有能力重啟完整數字系統, 在模擬的開始它被激活, 過很短的時間,然后它使其余的仿真市區(qū)能力; 時鐘信號(時鐘)正是FPGA時鐘信號,
它有一個標準的50mhz的頻率;使感覺信號(C)選擇連續(xù)波或反時針方向改變感覺, 如果它是禁用的,默認轉換感覺是連續(xù)波轉換感覺, 如果轉換感覺信號被激活然后步進電機運動是在反時針方向轉換感覺; 步式信號(F)選擇步進電機的步進式, 它被激活時將選擇一個完整步驟序列,當它被禁用了默認類型是半步序列; 啟動類型運動信號(STM)只是一個控制信號,表明準確即時當步進電機的運動特性改變時; 步信號(S)只是一個控制信號,提示號碼必要的步驟來完成這個步驟類型選擇序列; 信息傳輸信號(S)是一個標志信號表明信息在正確的方式轉移, 當它被禁用時,信息轉移是正確的; 準備好信號是一個旗語,這是激活顯示選定的運動的完成, 而且它也被激活當選擇的步進電機是在“堅持”狀態(tài); 最后,這個階段信號(φ)是一個信號總線,代表選擇的步進電機相狀態(tài)。一個關于模擬過程的重要解釋已經有結果,可以看到步進電機序列是做在一個比FPGA標準頻率較低的頻率的改變。圖7顯示了模擬的第一部分,可以看到它完成半步和連續(xù)波序列, 和一些半連續(xù)波序列。圖8顯示第二部分的仿真。我們可以看到半步和連續(xù)波序列的結束退的武器序列,和的完整步驟連續(xù)波序列的開始。圖9顯示了模擬的第三部分, 我們可以看到完整步驟和連續(xù)波序列的結束,和完整步驟反時針方向序列的開始。圖10顯示了最后一部分的仿真, 它可以看到全部步驟和反時針方向序列的結束,和保持狀態(tài)。
4總結
機電一體化使用其他工程分支的知識,但是它有它的技術問題, 應用程序和作為獨立的工程的特定的設計。這個項目需要應用先前獲得的知識和技能,如:數字邏輯設計(有限狀態(tài)機);硬件描述語言(VHDL);
分層設計技術在于實現使用FRGA。 電子電路設計(接口和驅動電路); 最后,發(fā)動機和致動器(步進電機)。選擇一個FPGA設計的主要的理由是提供工具來實現數字系統的快速原型,這是必不可少的在當前的電子行業(yè),反應當前的行業(yè)慣例; 和使用VHDL硬件描述語言來描述數字系統。 合成和實際硬件作為一個替代設計平臺來實現[3]。這個項目的用戶界面可以是一個電腦鍵盤,計算機或電子電路, 但對于這種情況,選定的用戶界面是FPGA自己的控制, 按鈕和開關。這個用戶界面不是最好的一個,但它是非常實用和多功能的。最大的并發(fā)癥出現在機械階段,因為機械傳動和聯合結構是自己生產的, 有必要驗證那個元素的位置是否合適來生成一個自由運動。這個機械手臂提議是用可回收材料建造的。這個項目需要一個非常常見的工業(yè)應用:控制機械結構運動, 但在同時,它允許用FPGA做簡單化系統來控制復雜的機制。三自由度機械臂的被提出不能移動大部件,也不能提重物, 它可以被可回收的材料建立,如在這種情況下, 所以這個項目的主要目的是說明了數字設計流程和被專注于FPGA階段。
References
*[1] R. de Jes?us Romero Troncoso, Electr?onica Digital y
L?ogica Programable. Lascur?ain de Retana No. 5 C.P.
36000: Universidad de Guanajuato, 1st ed., 2007.
[2] V. Giurgiutiu, J. Lyons, D. Rocheleau, and W. Liu,
“Mechatronics/microcontroller education for mechanical
engineering students at the university of south carolina,”
Mechatronics, vol. 15, pp. 1025–1036, 2005.
[3] K. C. Aw, S. Q. Xie, and E. Haemmerle, “A fpga-based
rapid prototyping approach for teaching of mechatronics
engineering,” Mechatronics, vol. 17, pp. 457–461, Octo-
ber 2007.
*[4] R. Isermann, “Mechatronics design approach,” in The
mechatronics handbook (R. H. Bishop, ed.), CRC Press,
2002.
*[5] National Semiconductor, Programmable Logic Design
Guide, May 1986.
*[6] National Semiconductor, Programmable Logic Devices
Databook and Design Guide, 1990.