一種機(jī)械臂振動(dòng)抑制裝置及其抑制方法
【專利摘要】本發(fā)明涉及的機(jī)械臂振動(dòng)抑制裝置及其振動(dòng)抑制方法,通過安裝在機(jī)械臂中部的電動(dòng)機(jī)的正轉(zhuǎn)和反轉(zhuǎn),可以帶動(dòng)絲杠向兩個(gè)方向運(yùn)動(dòng)。絲杠的運(yùn)動(dòng)推動(dòng)并拉緊機(jī)械臂一側(cè)的鋼索,以抵消末端載荷加速運(yùn)動(dòng)在相反方向上產(chǎn)生的力矩。根據(jù)末端載荷質(zhì)量和加速度,可以確定載荷慣性力在垂直于鋼索安裝面的方向上的投影,由此利用本發(fā)明所給出的絲杠需要的伸出長(zhǎng)度公式,可以確定絲杠的運(yùn)動(dòng)方向及其需要伸出的長(zhǎng)度。
【專利說明】一種機(jī)械臂振動(dòng)抑制裝置及其抑制方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及一種機(jī)械臂振動(dòng)抑制裝置及其抑制方法。
【背景技術(shù)】
[0002]隨著載人航天技術(shù)的不斷發(fā)展,機(jī)械臂在空間的應(yīng)用日趨廣泛。在飛船上,利用機(jī)械臂可以捕獲衛(wèi)星,對(duì)衛(wèi)星執(zhí)行檢修維護(hù)、更換零部件、調(diào)整太陽能電池板位姿等任務(wù)。在空間站,機(jī)械臂可以搬運(yùn)飛船運(yùn)送的給養(yǎng)、器材,完成空間站的擴(kuò)建、維護(hù)修理等工作。與地面的工業(yè)機(jī)械手相比,太空機(jī)械臂很長(zhǎng),工作空間大,為了減輕發(fā)射的重量,減少關(guān)節(jié)電機(jī)的功率和用電量,太空機(jī)械臂采用質(zhì)輕的細(xì)長(zhǎng)結(jié)構(gòu),手臂剛度低,工作時(shí)很容易產(chǎn)生大的彈性變形和振動(dòng)。由于太空環(huán)境中阻尼很小,機(jī)械臂振動(dòng)會(huì)持續(xù)很長(zhǎng)時(shí)間,影響正常的工作,因此抑制振動(dòng),提高機(jī)械臂末端的操作精度是太空機(jī)械臂應(yīng)用中急需解決的一個(gè)主要問題。
[0003]許多研究者和工程技術(shù)人員提出并研究了采用壓電材料作為傳感器和作動(dòng)器的方案,用于機(jī)械臂的振動(dòng)抑制,但由于太空機(jī)械臂太長(zhǎng),在表面粘貼壓電材料不僅需要付出昂貴的代價(jià),也增加了機(jī)械臂的重量和體積,另外,這種方案的一個(gè)致命弱點(diǎn)是抑制的結(jié)果機(jī)械臂因振動(dòng)產(chǎn)生的最大偏差仍出現(xiàn)在末端,而機(jī)械臂的定位精度就是末端的定位精度,只有盡可能減小末端的偏差,同時(shí),最大偏差出現(xiàn)在其余部分才是振動(dòng)抑制的理想結(jié)果。
【發(fā)明內(nèi)容】
[0004]鑒于壓電材料作為傳感器和作動(dòng)器的方案不僅代價(jià)昂貴,增加機(jī)械臂重量和體積,而且振動(dòng)產(chǎn)生的最大偏差仍出現(xiàn)在末端等弊端,本發(fā)明設(shè)計(jì)了一種機(jī)械臂振動(dòng)抑制裝置,通過適當(dāng)?shù)目刂品椒梢詫⒛┒说钠顪p小到零,臂桿最大偏差出現(xiàn)在中部附近。
[0005]本發(fā)明涉及的機(jī)械臂振動(dòng)抑制裝置及其振動(dòng)抑制方法,通過安裝在機(jī)械臂中部的電動(dòng)機(jī)的正轉(zhuǎn)和反轉(zhuǎn),可以帶動(dòng)絲杠向兩個(gè)方向運(yùn)動(dòng)。絲杠的運(yùn)動(dòng)推動(dòng)并拉緊機(jī)械臂一側(cè)的鋼索,以抵消末端載荷加速運(yùn)動(dòng)在相反方向上產(chǎn)生的力矩。根據(jù)末端載荷質(zhì)量和加速度,可以確定載荷慣性力在垂直于鋼索安裝面的方向上的投影,由此利用本發(fā)明所給出的絲杠需要伸出的長(zhǎng)度公式,可以確定絲杠的運(yùn)動(dòng)方向及其需要伸出的長(zhǎng)度。
[0006]本發(fā)明具有如下特點(diǎn):
[0007](I)機(jī)械臂末端的偏差減小到零,臂桿最大偏差出現(xiàn)在中部附近。
[0008](2)成本低廉;
[0009](3)增加的重量和體積很小。
[0010](4)仿真對(duì)比結(jié)果證明了抑制裝置及其抑制方法具有很好的效果.【專利附圖】
【附圖說明】
[0011]圖1是機(jī)械臂振動(dòng)抑制裝置結(jié)構(gòu)示意圖,圖2是承受兩個(gè)集中載荷的懸臂梁的受力圖,圖3是鋼索的拉力示意圖,圖3是鋼索的拉力示意圖。[0012]標(biāo)號(hào)說明:1電動(dòng)機(jī),2絲杠,3鋼索。
【具體實(shí)施方式】
[0013]1.機(jī)械臂振動(dòng)抑制裝置的結(jié)構(gòu)和工作原理
[0014]如圖1所示,機(jī)械臂振動(dòng)抑制裝置由電動(dòng)機(jī)(I)、絲杠(2)和鋼索(3)三部件組成。電動(dòng)機(jī)(I)安裝在機(jī)械臂的中部,其軸為空心軸,并可以正向和反向轉(zhuǎn)動(dòng)。空心軸內(nèi)側(cè)帶有螺紋。絲杠(2)是一個(gè)帶有螺紋的圓柱,螺紋與電動(dòng)機(jī)(I)空心軸內(nèi)側(cè)的螺紋相吻合。絲杠(2)的兩端帶有長(zhǎng)方體形狀的穿線柱,穿線柱中間開槽用于穿過鋼索(3)。兩根鋼索(3)布置在長(zhǎng)方體機(jī)械臂兩個(gè)相對(duì)的面上,穿過穿線柱開槽后兩端分別固定在機(jī)械臂的兩端。
[0015]通過機(jī)械臂末端位置和載荷質(zhì)量的估計(jì)可以計(jì)算出載荷慣性力在垂直于鋼索(3)安裝面方向上的投影,其相反方向就是絲杠(2)需要移動(dòng)的方向。按照下面的方法可以計(jì)算出絲杠(2)需要移動(dòng)的距離。以此方式驅(qū)動(dòng)電動(dòng)機(jī)(I)可以部分抵消末端載荷慣性力對(duì)機(jī)械臂的彎曲,達(dá)到振動(dòng)抑制的目的。
[0016]2.振動(dòng)抑制方法
[0017]2.1臂桿的曲線方程
[0018]取懸臂梁作為機(jī)械臂振動(dòng)抑制裝置的力學(xué)模型,如圖2所示,絲杠到懸臂每端的距離為L(zhǎng)/2,絲杠的長(zhǎng)度為1,絲杠對(duì)鋼索的支撐力為P,鋼索的拉力為R,在力P作用下懸臂梁在A,B兩點(diǎn)的支撐力分別為Ra和Rb,懸臂梁在B點(diǎn)受到的外力為F,則
[0019]
【權(quán)利要求】
1.一種機(jī)械臂振動(dòng)抑制裝置及其抑制方法,其特征在于:抑制裝置由電動(dòng)機(jī)(I)、絲杠(2)和鋼索(3)三部件組成;電動(dòng)機(jī)(I)安裝在機(jī)械臂的中部,其軸為空心軸,并可以正向和反向轉(zhuǎn)動(dòng);空心軸內(nèi)側(cè)帶有螺紋;絲杠(2)是一個(gè)帶有螺紋的圓柱,螺紋與電動(dòng)機(jī)(I)空心軸內(nèi)側(cè)的螺紋相吻合;絲杠(2)的兩端帶有長(zhǎng)方體形狀的穿線柱,穿線柱中間開槽用于穿過鋼索(3);兩根鋼索(3)布置在長(zhǎng)方體機(jī)械臂兩個(gè)相對(duì)的面上,穿過穿線柱開槽后兩端分別固定在機(jī)械臂的兩端。
2.根據(jù)權(quán)利要求1所述的機(jī)械臂振動(dòng)抑制裝置,其振動(dòng)抑制方法的特征在于通過機(jī)械臂末端位置和載荷質(zhì)量的估計(jì),計(jì)算出載荷慣性力在垂直于鋼索(3)安裝面方向上的投影F,其相反方向就是絲杠(2)需要移動(dòng)的方向;絲杠(2)需要的伸出長(zhǎng)度為
【文檔編號(hào)】B25J19/00GK103615495SQ201310571542
【公開日】2014年3月5日 申請(qǐng)日期:2013年11月7日 優(yōu)先權(quán)日:2013年11月7日
【發(fā)明者】安凱, 王飛飛, 王曉英, 安培亮, 安宏亮 申請(qǐng)人:安凱