陳飛,陳機林,候遠龍
(南京理工大學(xué)機械工程學(xué)院,江蘇南京 210094)
隨著并聯(lián)機構(gòu)的誕生,各種適應(yīng)不同應(yīng)用場合的并聯(lián)機構(gòu)層出不窮,但由于并聯(lián)機構(gòu)的某些特性,如工作空間和運動速度限制了其應(yīng)用范圍[1]。且常見并聯(lián)機器人結(jié)構(gòu)所用傳動機構(gòu)難以小型化,造成了并聯(lián)機器人結(jié)構(gòu)較大,空間利用率不足。本文作者設(shè)計了一種Z軸旋轉(zhuǎn)運動不受限制的六自由度并聯(lián)機器人。相對于常見的并聯(lián)機器人,此并聯(lián)機器人不需要齒輪傳動,結(jié)構(gòu)相對小巧,空間利用率較高。
文中除了介紹了這種并聯(lián)機器人的結(jié)構(gòu)以及運動原理,還對此并聯(lián)機器人姿態(tài)位置的反解、受力情況以及運動所需的力矩和功率做了研究,為實際設(shè)計提供了理論依據(jù)。
1965年,英國人STEWART第一次提出六自由度的并聯(lián)機構(gòu)[2],為了達到飛行員訓(xùn)練的目的,將其用作飛行模擬器。圖1所示為一個經(jīng)典的六自由度Stewart機械平臺,它由6根獨立伸縮的連桿將靜平臺和動平臺連接,通過每個連桿不同的伸縮量使得動平臺可以完成6個自由度的位置和姿態(tài)變化[3],即在空間內(nèi)可作任意方向平移以及繞任意方向的轉(zhuǎn)動。
圖1 并聯(lián)機器人模型Fig.1 Parallel robot model
但這種并聯(lián)機構(gòu)結(jié)構(gòu)相對復(fù)雜、整體尺寸較大,工作空間一般較小。
為了擴大并聯(lián)機器人的工作空間,減少整體尺寸,本文作者設(shè)計了一種新型并聯(lián)機器人,如圖2所示。此并聯(lián)機器人由靜平臺、動平臺、6個連桿、6個滑塊以及12個球鉸組成。其中靜平臺旋轉(zhuǎn)布置多個線圈,滑塊上貼有釹鐵硼磁鐵,通過不同線圈的通斷控制滑塊移動,可以將靜平臺視為定子,每個滑塊視為轉(zhuǎn)子共同組成其驅(qū)動部分。
圖2 并聯(lián)機器人模型Fig.2 Parallel robot model
此并聯(lián)機器人的動平臺位姿由6個滑臺的旋轉(zhuǎn)位置所決定,并且當(dāng)滑臺之間相對位置不變時同時增加驅(qū)動扭矩可以控制此六軸機器人繞靜平臺旋轉(zhuǎn)。
并聯(lián)機器人模型如圖2所示,該模型動平面由6個連桿與滑臺連接。為了描述平臺的運動,將該并聯(lián)機器人抽象為一個空間幾何模型,如圖3所示。其中點1-6和7-12分別為靜平臺與動平臺球鉸的中心。
圖3 空間幾何模型Fig.3 Spatial geometry model
在平臺中心構(gòu)建兩個坐標(biāo)系,靜坐標(biāo)系OXYZ和動坐標(biāo)系O′X′Y′Z′,如圖3所示。其中動坐標(biāo)系與動平臺固聯(lián),其坐標(biāo)原點位于動平臺中心,X′Y′平面與動平臺重合;靜坐標(biāo)系固定在大地上,坐標(biāo)原點在靜平臺中心。在平臺處于中位時,靜坐標(biāo)系與動坐標(biāo)系平行,當(dāng)動平臺運動時,動坐標(biāo)系隨平臺一起運動,而靜坐標(biāo)系始終靜止不動。
定義并聯(lián)機器人結(jié)構(gòu)參數(shù)如表1所示。
表1 并聯(lián)機器人尺寸參數(shù)Tab.1 Dimension parameters of parallel robot
運動學(xué)反解是在已知末端執(zhí)行器的位置和姿態(tài)的情況下求解驅(qū)動器的運動量[4]。文中末端執(zhí)行器為動平臺,驅(qū)動器是6個滑臺,可通過動平臺位姿信息求解各滑臺與X軸的夾角θ。
當(dāng)動平臺具有位姿Q=(αβγXYZ)時可以得到動平臺繞動坐標(biāo)系的旋轉(zhuǎn)變換矩陣如下:
(1)
(2)
(3)
(4)
(5)
式中:RX(α)、RY(β)、RZ(γ)分別表示動平臺繞靜平臺X、Y、Z軸旋轉(zhuǎn)的旋轉(zhuǎn)矩陣,以順時針為正;P0為動平臺相對靜平臺的位移;T為動坐標(biāo)系到靜坐標(biāo)系的坐標(biāo)變換矩陣。
對任意某支鏈分析,定義其連接動平臺的球鉸中心為點A,連接滑塊球鉸中心為點B,如圖4所示。
可得OA=TO′A+P0
(6)
(7)
cosφ=ax·Rcosθ+ay·Rsinθ=
(8)
定義:
(9)
可知滑塊i與X軸夾角θi,實際解算后θi有兩解,即表示對于動平臺的某一固定位姿Q,每個滑塊有兩個位置可以滿足運動需求,實際運動中將造成滑塊位置沖突,如圖5所示。
圖5 滑塊位置沖突Fig.5 Slider position conflict
位置沖突會導(dǎo)致滑塊相撞,可通過滑塊之間相對位置避免。具體步驟為:由滑塊大小可得兩滑塊互補相撞的最小夾角θmin,計算相鄰兩滑塊之間角度差使其大于最小夾角θmin?;瑝K夾角示意如圖6所示。
圖6 滑塊夾角示意Fig.6 The angle between the sliders
并聯(lián)機器人的動力學(xué)研究方法有:牛頓-歐拉(Newton-Euler)方程、達朗伯原理-虛位移原理、拉格朗日(Lagrange)方程、高斯(Gauss)方法、凱恩(Kane)方法、螺旋理論等[5]。文中采用牛頓-歐拉方程求解,分析此并聯(lián)機器人位姿Q的應(yīng)力。
當(dāng)動平臺具有位姿Q=(αβγXYZ)時,由于此并聯(lián)機器人的連桿為輕量化鋁合金,為簡化計算可將忽略其重力參數(shù),視為二力桿。則定義以下參數(shù)便于計算,見表2。
表2 并聯(lián)機器人運動參數(shù)Tab.2 Kinematic parameters of parallel robot
滑塊視為一個剛體,其受支鏈的反作用力、底座向上的支持力和指向坐標(biāo)原點的法向力、線圈繞組對滑塊的拖拽力。其中滑塊切向力僅只有線圈繞組切向的拖拽力、慣性力的切向分量與支鏈反作用力的切向分量。則有:
(10)
其中:Ti為線圈繞組的拖拽力切向分力。
動平臺受6個支鏈的反作用力與動平臺自身重力G,在動平臺運動時還有慣性力與慣性力矩,其合力與合力矩為0。
在靜坐標(biāo)系下,動平臺重力G、慣性力與6個支鏈的反作用力合力為0:
(11)
在動平臺質(zhì)心處,支鏈的反作用力矩、重力力矩以及慣性力矩滿足
(12)
公式(11)(12)在靜坐標(biāo)系下可以分為X、Y、Z三軸的分量解算,得到一個6個未知數(shù)的方程組。
此并聯(lián)機器人的驅(qū)動部分可以使用齒輪組合的方式通過固定在滑臺的電機驅(qū)動小齒輪轉(zhuǎn)動移動滑塊,但齒輪組合的方式需要在滑臺固定電機,增加了并聯(lián)機器人的尺寸大小,且動平臺繞Z軸旋轉(zhuǎn)圈數(shù)增加時電機的電纜線會互相纏繞。為避免這種情況,本文作者設(shè)計了一種軸向電機的多轉(zhuǎn)子驅(qū)動結(jié)構(gòu)。
此并聯(lián)機器人的底座與滑臺結(jié)構(gòu),由類似軸向電機的方式組成[6-7],如圖7、8所示。
其底座含有多個線圈繞組,每個線圈繞組可單獨通斷?;_含多個釹鐵硼磁鐵結(jié)構(gòu),在相近繞組接通后給予其動力,使得滑臺在底座轉(zhuǎn)動。通過控制相鄰線圈繞組通過的電壓大小可以使水平方向的拖拽力與滑臺運動軌跡相切,其控制方式類似無刷電機FOC(Field-Oriented Control)控制[8]。此驅(qū)動方式的并聯(lián)機器人活動結(jié)構(gòu)無電線連接,避免了運動過程中電纜的限制,同時其線圈繞組內(nèi)置在底座上,滑臺上僅需貼上釹鐵硼磁鐵即可,大大減小其結(jié)構(gòu)尺寸。
滑臺受力分為3個部分:支持力、軸向拉力以及切向力。其中切向力由線圈繞組提供。其驅(qū)動扭矩最大值由切向力決定,功率由滑塊運動速度與切向力共同決定。
轉(zhuǎn)子可提供的轉(zhuǎn)矩決定了此并聯(lián)機器人運動的快慢,要加強轉(zhuǎn)子力矩除了增加線圈繞組通過的電流還可以通過如下兩種方法:(1)增加滑臺尺寸,增加其釹鐵硼磁鐵的對數(shù)。(2)改變釹鐵硼磁鐵的排列結(jié)構(gòu),將單個釹鐵硼磁鐵變?yōu)槎鄠€小的釹鐵硼磁鐵組成的強磁陣列[9]的結(jié)構(gòu),如圖9所示。
圖9 釹鐵硼磁鐵的排列結(jié)構(gòu)Fig.9 The arrangement structure of NdFeB magnet:(a) conventional structure;(b)strong magnetic array structure
常規(guī)的六自由度并聯(lián)機器人空間運動范圍有限,本文作者提出一種新型并聯(lián)機器人,具有Z軸轉(zhuǎn)動不受限制的特點,極大地擴展了其運動范圍;且此并聯(lián)機器人驅(qū)動部分僅有線圈和釹鐵硼磁鐵組合,可以視為一個拆解的軸向電機,避免了齒輪傳動結(jié)構(gòu),還具有軸向電機結(jié)構(gòu)尺寸小、動力大等優(yōu)點;相對常規(guī)并聯(lián)機器人結(jié)構(gòu)尺寸極大減少,對并聯(lián)機器人的設(shè)計有一定的啟發(fā)作用。本文作者還提供了此并聯(lián)機器人運動姿態(tài)反解、運動受力分析,以及驅(qū)動器設(shè)計所需的幾個重要參數(shù)來源,便于實際設(shè)計。