TW201512554A - 球座標轉向平行機構 - Google Patents

球座標轉向平行機構 Download PDF

Info

Publication number
TW201512554A
TW201512554A TW102134887A TW102134887A TW201512554A TW 201512554 A TW201512554 A TW 201512554A TW 102134887 A TW102134887 A TW 102134887A TW 102134887 A TW102134887 A TW 102134887A TW 201512554 A TW201512554 A TW 201512554A
Authority
TW
Taiwan
Prior art keywords
frame structure
arc
sets
rod
inner frame
Prior art date
Application number
TW102134887A
Other languages
English (en)
Other versions
TWI568942B (zh
Inventor
Wen-Der Trui
Shu-Ching Lin
Original Assignee
Wen-Der Trui
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wen-Der Trui filed Critical Wen-Der Trui
Priority to TW102134887A priority Critical patent/TWI568942B/zh
Priority to US14/493,414 priority patent/US9579786B2/en
Priority to EP14186117.9A priority patent/EP2863102B1/en
Priority to CN201410493157.2A priority patent/CN104511904B/zh
Priority to JP2014196071A priority patent/JP6494967B2/ja
Publication of TW201512554A publication Critical patent/TW201512554A/zh
Application granted granted Critical
Publication of TWI568942B publication Critical patent/TWI568942B/zh
Priority to US15/444,306 priority patent/US20170165831A1/en

Links

Abstract

本發明為一種球座標轉向機構,可補傳統平衡環式(Gimbals)機構之不足。本發明可簡述為:雙四面體結構端線共心軸接四組內、外軌弧桿之球座標轉向機構。本發明係由雙四面體所幾何定義之新構型,外框四結構四面體之端角分別固裝四組扭力輸出裝置,其出力軸之軸芯重合四面體之角心線,並分別共心軸接於四組外軌弧桿及四組內軌弧桿之軸芯,再經其分別共心軸接於內框結構四面體之角心線。

Description

球座標轉向平行機構
本發明為一種球座標轉向平行機構,可補傳統平衡環式(Gimbals)機構之不足,以提供各種扭力輸出裝置、伸縮舉昇機構與觀測定位裝置於球面經緯度運動之動力承載機構。
現行常用於球面經緯度運動之機構為傳統的平衡環式(Gimbals)機構。允許動力承載,如各種扭力輸出裝置、伸縮舉昇機構與觀測定位裝置,以大角度甚至連續旋轉。但是此機構係逐環架構。動力承載須置於內環,馬達及齒輪箱鍵接於內環驅動為動力承載對緯度軸旋轉,於是外環之馬達及齒輪箱就須負荷動力承載加內環之馬達及齒輪箱的慣量,方能驅動外環對經度軸旋轉。若動力承載體積或慣量龐大則內環與外環半徑亦須擴增,致使龐大的操作空間難以類比其承載容積。而且平衡環式機構因逐環架構亦會伴生電訊傳輸、線束纏繞等問題。
本發明之簡述為:雙四面體結構端線共心軸接四組內、外軌弧桿之球座標轉向機構。本發明之組合配置立體視圖如圖1,前視圖與側視圖如圖2。本發明又可區分為外掛式與內藏式。
本發明包含有:一外框結構與弧桿致動器(4)四端角分別鍵結四組外軌弧桿組(2),四組外軌弧桿組(2)與四組內軌弧桿組(1)彼此軸接,用以傳達四組弧桿致動器(4a)之輸出至內框結構與動力承載(3)。
外框結構(4o)固裝於外框托架(4b),外框結構(4o)框內之四頂端分別軸接四組弧桿致動器(4a),再分別鍵結外軌弧桿(2o)以輸出扭力,致動器可為馬達或油壓旋轉缸,如圖3
外軌弧桿(2o)之外端以外接軸芯(2a)與弧桿致動器(4a)出力軸鍵結,外軌弧桿(2o)與內軌弧桿(1o)以中接軸芯(2b)軸接,內軌弧桿(1o)之內端以內接軸芯(1a)軸接於內框結構(3o),如圖4
內框結構(3o)用以承接來自四組內、外軌弧桿組所傳達之扭力輸出。四組內軌弧桿(1o)再分別軸接於內框結構(3)之四端角。內框結構(3o)框外之一頂端軸接弧桿致動器(3a)以驅動承載弧桿(3c)以因應球座標轉向之適時變位需求,若無適時變位需求則不裝弧桿致動器(3a),則直接將承載弧桿(3c)固裝於內框結構(3o)框外之一頂端。內框結構(3o)框內之另 三頂端可分別串接三組角度檢知器(3b),如光學編碼器,以量測內軌弧桿與半內框框間之相對角度變化,以供精密校驗球座標轉向角度;若須強化扭力輸出亦可改接三組弧桿致動器,但將增加系統設計複雜度;若須節省內框空間則可完全不裝角度檢知器或弧桿致動器。最後將動力承載(3d)固裝於承載弧桿(3c)外端,如圖5
內框結構與動力承載(3)可區分為外掛式與內藏式。外掛式動力承載(3d)應用於機械人之肩關結或髖關結,或掛載扭力輸出裝置,如工具機之夾持模組,則設計承載弧桿(3c)置於外軌弧桿(2o)之外與外框結構(4o)之內,如圖5。若外掛式動力承載(3d)掛載為力臂變動之伸縮舉昇機構,如氣壓缸、油壓缸或電動螺桿缸,則設計加裝配重盤(3e)以配平重量減少力距變動,如圖6。若內藏式動力承載(3d)為體積或慣量龐大之量測定位裝置,如雷射儀、望遠鏡等,則設計承載弧桿(3c)置於內框結構(4o)之內,如圖7
以下分述本發明球座標轉向機構各組合件之幾何定義、問題關鍵與解決之道。
1.幾何定義
外框結構(4o)之幾何定義為四面體,令外框四面體之四端角至體心皆等距,四組致動器之軸芯線須重合於外框四面體之角心線。外框四面體體心標示為o u ,外框四面體之角心線標示為單位向量 u i ( i =1~4),各角心線間夾角標為Λ ij ( i,j =1~4i j ),以向量內積表示:Λ ij =cos -1[ u i u j ],如圖3。外框結構各角心線間之夾角範圍可設定為90度與120度之間以迴避奇異現象。即:90°Λ ij 120°( i,j =1~4; i j )。外框結構若恰為正四面體則其各角心線間之六夾角皆相等約109.5°,即:Λ121314232434 109.5°。外框結構若為正四面體因其單一對稱之特性較易於參數設計與運算模擬。但須注意正四面體必然出現四軸共線之奇異現象,詳如後述。故外框設計謹須符合四面體幾何定義不必為正四面體,其外形亦可設計如圖8
四組外軌弧桿組(2)與四組內軌弧桿組(1)之幾何定義:四外軌弧桿(2o)半徑皆相等,四內軌弧桿半徑皆相等。四組內、外軌弧桿各端軸必皆共心,即:四組外接軸芯(2a)、中接軸芯(2b)中與內接軸芯(1a) 可隨內框結構(3o)之姿態變動,但軸線必皆指向外框四面體之體心。第 i 外接軸芯(2a)之單位向量標示為 u i ,第 i 中接軸芯(2b)之單位向量標示為 w i ,第 i 內接軸芯(1a)之單位向量標示為 v i 。四外軌弧桿(2o)半徑標示為r u ,四內軌弧桿(1o)半徑標示為 r v 。第 i 外軌弧桿(2o)弧長標示為α i ,且定義為第 i 外接軸芯(2a)與第 i 中接軸芯(2b)之夾角,可以向量內積表示:α i =cos -1[ u i w i ]。第 i 內軌弧桿(1o)弧長標示為 β i ,且定義為第 i 內接軸芯(1a)與第 i 中接軸芯(2b)之夾角,可以向量內積表示: β i =cos -1[ v i w i ],如圖4。為迴避奇異現象:四組外軌弧桿(2o)弧長不必皆相等,四內軌弧桿(1o)弧長亦不必皆相等,詳如後述。
內框結構(3o)之幾何定義為四面體,令內框四面體之四端角至體心皆等距,弧桿致動器(3a)與三組角度檢知器(3b)之軸芯線須與內框四面體之角心線重合,如圖5。內框四面體之體心標示為o v ,內框四面體之角心線標示為單位向量 v i ( i =1~4),內框結構各角心線間夾角標示為Ω ij ( i ,j =1~4; i j ),可以向量內積表示,即:Ω ij =cos -1[ v i v j ],如圖3。內框結構各角心線間之夾角範圍可設定為90度與120度之間以迴避奇異現象。即90°Ω ij 120°( i,j =1~4; i j )。內框結構若恰為正四面體則其各角心線間之六夾角皆相等約109.5°,即:Ω121314232434 109.5°。內框結構若為正四面體因其 單一對稱之特性較易於參數設計與運算模擬。但須注意正四面體必然出現四軸共線之奇異現象,詳如後述。故內框設計謹須符合四面體幾何定義不必為正四面體,其外形亦可設計如圖6、圖7
2.問題關鍵
本發明實行之問題關鍵在於:如何控制四組內、外軌弧桿組彼此不相掣肘而且運轉如意?亦即如何避免所謂干涉與奇異現象之發生?以下分述本發明特有之干涉與奇異現象以供參數設計之參考。
(一)干涉現象:此所謂干涉係指某一弧桿之運轉路徑為另一弧桿所阻之現象。令任二外軌弧桿弧長之和等於其相應二外框角心線間之夾角,即:α i +α j ij ( i ,j =1~4; i j ),可完全避免二外軌弧桿於運轉時可能之交互干涉,如圖9a。同理,令任二內軌弧桿弧長之和等於其相應二內框角心線間之夾角,即:β i +β j ij ,可完全避免任二內軌弧桿之交互干涉。但是當任二外軌或內軌弧桿弧長之和最小時,其運動空間亦相對限縮幾近於無。
由上可知:任二外軌弧桿弧長之和必大於其相應外框二角心線間之夾角,即:α i +α j Λ ij ,若令外框四面體為正四面體,則任二外軌弧桿弧長之和必大於109.5°;任二內軌弧桿弧長之和必大於其相應內框二角心線間之夾角,即:β i +β j Ω ij ,若令內框四面體為正四面體,則任二內軌弧桿弧長之 和必大於109.5°。
根據機構幾何,任一內軌與其外軌弧桿弧長之和不可大於180°否則失去意義,即:α i +β i 180°( i =1~4)。若可不計實體結構,則可假設當四組內、外軌弧桿弧長之和皆等於180°時,其酬載艙之各自由度旋轉範圍最大,但事實上無法不計結構實體,此時交互干涉發生之機率最大,反使之運動空間最小,如圖9b。由此可知:任一內軌與其外軌弧桿弧長之和必須小於等於180°,即:α i +β i 180°。
綜合可知:無法因避免干涉而不限縮轉向運動空間,只能依所欲轉向之運動軌跡,預先模擬迴避之路徑相對擇優選配,並無絕對最佳參數設計值。
(二)奇異現象:此所謂奇異係指任一致動器之扭力輸出無法完全傳達於其所對應內框之端角,使其相應而動之現象,本發明已知之奇異現象可概分為單軸共線奇異、雙軸對接奇異與四軸共線奇異等。單軸共線奇異之前提是第 i 組內、外軌弧桿之弧長相等,即:α i =β i ( i =1~4),發生於內框之第 i 角心線與外框之第 i 角心線重合時,即: u i = v i 。單軸共線奇異尚不足為患,因為若僅單一致動器無法供輸,尚有其它三軸致動器可供運作以控制達到預定之轉向。
雙軸對接奇異是雙軸致動器併同發生輸出無法完全傳達之現象,如圖7。其前提是某二組內、外軌弧桿弧長之和皆等於180°,即:α i +β i =α j +β j = 180°( i ,j =1~4; i j )。發生於內框第 i、j 角心線與外框第 i、j 角心線對接時,即: u i =- v i u j =- v j 。此時無論此二致動器如何轉動,皆無法使其所連結之內框二端角相應而動,其餘二軸致動器雖可運作卻不足以控制達到設定之球座標轉向角度。欲避免此現象,所幸只須於參數設計時使其前提不成立,即:α i +β i ≠180°。再與上述交集整併,則得:任一內軌與其外軌弧桿之弧長之和必小於180°,即:α i +β i <180°。
最難避免的是四軸共線奇異,其前提是四組內、外軌弧桿弧長兩兩相等,即:α 1=β 1α 2=β 2α 3=β 3α 4=β 4,發生於內框之四角心線與外框之四角心線同時重合時,即: u 1= v 1 u 2= v 2 u 3= v 3 u 4= v 4,如圖10a。此時四組致動器無論如何轉動皆無法致動內框四端角。由於四軸共線奇異發生於球座標之極點,一經誤入難以脫離,偏偏極點又常是初始或還原必經之點,所以很難迴避。
3.解決之道
方法一:再依循前例,於參數設計時使其前提不成立,也就是四組內、外軌弧桿弧長彼此不相等,即:α i β i 。內、外軌弧桿弧長差距愈大,則當四組內、外軌弧桿完全共線時,四組致動器可控之等效力臂愈大,愈易使其脫離困境,如圖10b。但問題是弧長差距愈大則酬載艙運動空間之潰縮率愈大。
方法二:動力承載(3d)之體積與慣量決定內、外框結構之空間大小,亦即決定內、外框四面體體心至端角之距離,加計軸托架與角度檢知器等安裝空間後,可得內軌弧桿半徑r v 之參數值。本發明之必要關鍵在於端軸共心,是故內、外軌弧桿之半徑差距(即:r u -r v )愈大,則愈可確保各軸芯之幾何向心度。但是生剋相隨,此參數愈大亦將伴隨愈大之徑向力距,相較於內、外軸向力距,致動器之徑向力距承載能力薄弱,所以設定外軌弧桿半徑r u 之參數值時,須於各端軸芯幾何向心度與致動器可承載徑向力距之間取最大平衡。
方法三:禁止內框各角心線間之六夾角與外框各角心線間之六夾角完全相等,即:令內框四面體與外框四面體皆不得為正四面體。因為正四面體必然出現四軸奇異現象。所以必須妥設內、外軌弧桿弧長與內、外角心線間之夾角等參數以迴避奇異現象。例如內、外軌弧桿弧長應避免同時為直角。
方法四:侷限轉向運動路徑以避免使內框之四角心線不再同時與外框之四角心線重合,以脫離四軸共線之奇異現象,但此舉將大幅限縮轉向運動空間。欲使本發明之動力承載達成預設之運轉路徑,即預劃球座標轉向角度:經度角θ與緯度角φ,則須先計算出四組弧桿致動器(4a)之轉角輸出值。已知外框(4o)四角芯線向量 u i ,先將預設之球座標經度角θ 與緯度角φ,輸入尤拉角轉換矩陣,求得新姿態之內框(3o)四角芯線向量 v i ,跟據前次四組弧桿致動器(4a)之轉角輸出值與三組角度檢知器量(3b)測值,得出四組內、外軌弧桿間夾角估算值,可初估中軸芯線向量 w i 。整理各內、中、外軸芯線之向量內積式轉化為聯立多項式,重覆將已知或估算之參數值疊代至此聯立多項式。再慎選數值方法以求得四組致動器之轉角需求輸出值。
綜言之,對可能發生之干涉與奇異現象歸納分析,以為構型參數擇優選配之依據,並對可能影響本發明功能運作提出設計解決之道,以確保求取最大球座標轉向運動空間。
(1)‧‧‧內軌弧桿組
(1o)‧‧‧內軌弧桿
(1a)‧‧‧內接軸芯
(2)‧‧‧外軌弧桿組
(2o)‧‧‧外軌弧桿
(2a)‧‧‧外接軸芯
(2b)‧‧‧中接軸芯
(2)‧‧‧內框結構與動力承載
(3o)‧‧‧內框結構
(3a)‧‧‧弧桿致動器
(3b)‧‧‧角度檢知器
(3c)‧‧‧承載弧桿
(3d)‧‧‧動力承載
(3e)‧‧‧配重盤
(4)‧‧‧外框結構與弧桿致動器
(4o)‧‧‧外框結構
(4a)‧‧‧四組弧桿致動器
(4b)‧‧‧外框托架
1球座標轉向平行機構組件配置立體視圖
2球座標轉向平行機構組件配置前視圖與側視圖
3外框結構與弧桿致動器立體視圖與幾何定義
4四組內、外軌弧桿組之立體視圖與幾何定義
5內框結構與動力承載立體視圖與幾何定義
6加裝配重盤配平伸縮舉昇機構之外掛式設計
7因應慣量龐大之量測定位裝置之內藏式設計
8符合外框幾何定義之設計
9a任二弧桿交互之干涉現象
9b直角弧桿雙軸對接之奇異現象
10a同長弧桿四軸共線之奇異現象
10b長短弧桿四軸共線之奇異現象
1‧‧‧內軌弧桿組
2‧‧‧外軌弧桿組
3‧‧‧內框結構與動力承載
4‧‧‧外框結構與弧桿致動器

Claims (1)

  1. 本發明包含有:一外框結構與弧桿致動器(4)四端角分別鍵結四組外軌弧桿組(2),四組外軌弧桿組(2)與四組內軌弧桿組(1)彼此軸接,用以傳達四組弧桿致動器(4a)之輸出至內框結構與動力承載(3)。外框結構(4o)固裝於外框托架(4b),外框結構(4o)框內之四頂端分別軸接四組弧桿致動器(4a),再分別鍵結外軌弧桿(2o)以輸出扭力,致動器可為馬達或油壓旋轉缸。外軌弧桿(2o)之外端以外接軸芯(2a)與弧桿致動器(4a)出力軸鍵結,外軌弧桿(2o)與內軌弧桿(1o)以中接軸芯(2b)軸接,內軌弧桿(1o)之內端以內接軸芯(1a)軸接於內框結構(3o)。內框結構(3o)用以承接來自四組內、外軌弧桿組所傳達之扭力輸出。四組內軌弧桿(1o)再分別軸接於內框結構(3)之四端角。內框結構(3o)框外之一頂端軸接弧桿致動器(3a)以驅動承載弧桿(3c)以因應球座標轉向之適時變位需求,若無適時變位需求則不裝弧桿致動器(3a),則直接將承載弧桿(3c)固裝於內框結構(3o)框外之一頂端。內框結構(3o)框內之另三頂端可分別串接三組角度檢知器(3b),如光學編碼器,以量測內軌弧桿與半內框框間之相對角度變化,以供精密校驗球座標轉向角度;若須強化扭力 輸出亦可改接三組弧桿致動器,但將增加系統設計複雜度;若須節省內框空間則可完全不裝角度檢知器或弧桿致動器。最後將動力承載(3d)固裝於承載弧桿(3c)外端。內框結構與動力承載(3)可區分為外掛式與內藏式。外掛式動力承載(3d)應用於機械人之肩關結或髖關結,或掛載扭力輸出裝置,如工具機之夾持模組,則設計承載弧桿(3c)置於外軌弧桿(2o)之外與外框結構(4o)之內。若外掛式動力承載(3d)掛載為力臂變動之伸縮舉昇機構,如氣壓缸、油壓缸或電動螺桿缸,則設計加裝配重盤(3e)以配平重量減少力距變動。若內藏式動力承載(3d)為體積或慣量龐大之量測定位裝置,如雷射儀、望遠鏡等,則設計承載弧桿(3c)置於內框結構(4o)之內。
TW102134887A 2013-09-26 2013-09-26 球座標轉向平行機構 TWI568942B (zh)

Priority Applications (6)

Application Number Priority Date Filing Date Title
TW102134887A TWI568942B (zh) 2013-09-26 2013-09-26 球座標轉向平行機構
US14/493,414 US9579786B2 (en) 2013-09-26 2014-09-23 Spherical coordinates manipulating mechanism
EP14186117.9A EP2863102B1 (en) 2013-09-26 2014-09-24 Spherical coordinates manipulating mechanism
CN201410493157.2A CN104511904B (zh) 2013-09-26 2014-09-24 球坐标操控机构
JP2014196071A JP6494967B2 (ja) 2013-09-26 2014-09-26 球面座標操縦装置
US15/444,306 US20170165831A1 (en) 2013-09-26 2017-02-27 Spherical coordinates manipulating mechanism for inner frame pivotal configuration

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW102134887A TWI568942B (zh) 2013-09-26 2013-09-26 球座標轉向平行機構

Publications (2)

Publication Number Publication Date
TW201512554A true TW201512554A (zh) 2015-04-01
TWI568942B TWI568942B (zh) 2017-02-01

Family

ID=53437055

Family Applications (1)

Application Number Title Priority Date Filing Date
TW102134887A TWI568942B (zh) 2013-09-26 2013-09-26 球座標轉向平行機構

Country Status (1)

Country Link
TW (1) TWI568942B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI623345B (zh) * 2016-01-15 2018-05-11 崔文德 弧桿組合機構
CN110450142A (zh) * 2019-09-09 2019-11-15 哈工大机器人(合肥)国际创新研究院 一种基于双陀螺仪部件的六自由度并联机器人

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4878393A (en) * 1988-05-27 1989-11-07 Oprea Duta Dextrous spherical robot wrist
DE4337858C2 (de) * 1993-11-05 1997-06-05 Wolfgang Frentzel Mechanischer Drehmomentwandler
US6729197B2 (en) * 2001-05-15 2004-05-04 Willis A. Adcock Gyroscopic torque converter
GB0314685D0 (en) * 2003-06-24 2003-07-30 Imp College Innovations Ltd Drive system and method
WO2009026937A2 (en) * 2007-08-26 2009-03-05 Abozaied Abdallah Ezzat Abdall New robotic joint configuration
MX2010008384A (es) * 2008-01-30 2010-11-30 Cephalon Inc Derivados de piridazina substituida, con actividad antagonista de h3 de histamina.
WO2009127228A1 (en) * 2008-04-17 2009-10-22 Erke Erke Arastirmalari Ve Mühendislik A.S. Gear device, preferably motor device
WO2012007014A1 (en) * 2010-07-13 2012-01-19 Abdallah Ezzat Abdallah Abozaied Joint

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI623345B (zh) * 2016-01-15 2018-05-11 崔文德 弧桿組合機構
CN110450142A (zh) * 2019-09-09 2019-11-15 哈工大机器人(合肥)国际创新研究院 一种基于双陀螺仪部件的六自由度并联机器人

Also Published As

Publication number Publication date
TWI568942B (zh) 2017-02-01

Similar Documents

Publication Publication Date Title
JP6494967B2 (ja) 球面座標操縦装置
CN104690708B (zh) 一种力操作器平衡机构
CN101623864A (zh) 一种具有自重平衡特性的力反馈型主操作手
CN104551714B (zh) 一种具有空间两转动和一平动自由度的并联机构
CN103737207A (zh) 一种六自由度混联焊接机器人机构
JP2015068502A5 (zh)
CN101745820A (zh) 一种三自由度并联机构形式的五轴机床双摆头及控制方法
CN108621130A (zh) 具有2r1t和2t1r两种运动模式的并联机构
CN104308859A (zh) 基于行车的重载精密冗余三臂机械手
CN104552247B (zh) 一种三自由度混联机器人机构
CN103737582A (zh) 一种六自由度高精度先进焊接机器人机构
CN105082111A (zh) 一种完全解耦两移动三转动并联机器人机构
CN102501243A (zh) 一种一转动两移动解耦并联机器人机构
KR20160085246A (ko) 관절 암 로봇형 장치
TWI623345B (zh) 弧桿組合機構
CN105563462A (zh) 一种(1t2r)&amp;1t1r五自由度解耦混联机构
Merckaert et al. Independent load carrying and measurement manipulator robot arm for improved payload to mass ratio
TW201512554A (zh) 球座標轉向平行機構
CN105992677B (zh) 紧凑型并联运动机器人
US10035265B2 (en) Manipulator
CN109571444B (zh) 一种两平移一转动的部分解耦并联机构
CN104875187A (zh) 一种(2t1r)&amp;(2r)双动平台解耦混联机器人机构
TWI574722B (zh) 球座標轉向機構
US20140084131A1 (en) Apparatus including multi-jointed arm and gravity compensation method
CN105598953A (zh) 一种两转一移三自由度并联机构

Legal Events

Date Code Title Description
MM4A Annulment or lapse of patent due to non-payment of fees