亚洲成年人黄色一级片,日本香港三级亚洲三级,黄色成人小视频,国产青草视频,国产一区二区久久精品,91在线免费公开视频,成年轻人网站色直接看

一種三自由度并聯(lián)機器人零點標定方法與流程

文檔序號:12440525閱讀:來源:國知局

技術(shù)特征:

1.一種三自由度并聯(lián)機器人零點標定方法,其特征在于:包括以下步驟:

一)布置靜平臺:在靜平臺末端安裝一個激光傳感器;

二)布置動平臺:在動平臺相對于靜平臺的等效中心處放置一圓形紙片,用以接收激光傳感器發(fā)射出的激光;

三)建立空間坐標系:在三自由度并聯(lián)機器人的工作平面內(nèi)建立一個空間直角坐標系,并將直角坐標系原點設(shè)定在靜平臺上;

四)移動動平臺:將動平臺移動到工作空間內(nèi)的任一位置,并記錄當前位置激光傳感器所示動平臺與靜平臺間的距離H1,然后控制動平臺沿x方向移動一個固定增量Δx,并記錄當前位置激光傳感器所示動平臺與靜平臺間的距離H2,然后控制動平臺沿y方向移動一個固定增量Δy,并記錄當前位置激光傳感器所示動平臺與靜平臺間的距離H3,最后控制動平臺在其工作空間內(nèi)分別沿z方向移動一個固定增量Δz,并記錄當前位置電傳感所示動平臺與靜平臺間的距離H4;

五)計算機器人主動臂空間位置:建立機器人通過計算得到動平臺經(jīng)三次移動后所處位置的坐標;然后根據(jù)逆運動學(xué)模型即可得到三次平移后機器人主動臂與水平面的夾角,然后使主動臂驅(qū)動電機轉(zhuǎn)動相應(yīng)角度,帶動機器人主動臂旋轉(zhuǎn)至其工作空間內(nèi)的水平位置,完成三自由度并聯(lián)機器人零點標定工作。

2.根據(jù)權(quán)利要求1所述的一種三自由度并聯(lián)機器人零點標定方法,其特征在于:所述步驟二)建立的直角坐標系O-xyz,以三個主動臂旋轉(zhuǎn)中心的內(nèi)切圓的圓點作為坐標系的原點O,以其中一個主動臂的旋轉(zhuǎn)中心與原點O的連線為y軸,且正方向為原點O到主動臂旋轉(zhuǎn)中心的方向;z軸過原點,且以垂直于靜平臺平面向上的方向為正方向;x軸可由右手定則確定。

3.根據(jù)權(quán)利要求1所述的一種三自由度并聯(lián)機器人零點標定方法,其特征在于:所述步驟三)動平臺移動三次后所處位置的坐標O′為(x+Δx,y+Δy,z+Δz),且有:

<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <msqrt> <mrow> <msup> <mi>x</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> <mo>=</mo> <msub> <mi>H</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>H</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>y</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>y</mi> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> <mo>=</mo> <msub> <mi>H</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>H</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>y</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>z</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>z</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <mi>x</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <mi>y</mi> <mo>+</mo> <mi>&Delta;</mi> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mi>z</mi> <mn>2</mn> </msup> </mrow> </msqrt> <mo>=</mo> <msub> <mi>H</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>H</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>

通過求解上式可獲得三次移動后動平臺的位置參數(shù),繼而可獲得三次移動后機器人主動臂與水平面的夾角:

<mrow> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mo>=</mo> <mn>2</mn> <mi>arctan</mi> <mfrac> <mrow> <mo>-</mo> <msub> <mi>E</mi> <mi>i</mi> </msub> <mo>-</mo> <msqrt> <mrow> <msup> <msub> <mi>E</mi> <mi>i</mi> </msub> <mn>2</mn> </msup> <mo>-</mo> <msup> <msub> <mi>G</mi> <mi>i</mi> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>F</mi> <mi>i</mi> </msub> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> <mrow> <msub> <mi>G</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>F</mi> <mi>i</mi> </msub> </mrow> </mfrac> <mo>,</mo> <mrow> <mo>(</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>~</mo> <mn>3</mn> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

式(1)中:

Ei=2l1(r-ei)Tz

Fi=-2l1(r-ei)T(cosβix+sinβiy)

<mrow> <msub> <mi>G</mi> <mi>i</mi> </msub> <mo>=</mo> <msup> <mrow> <mo>(</mo> <mi>r</mi> <mo>-</mo> <msub> <mi>e</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>r</mi> <mo>-</mo> <msub> <mi>e</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>l</mi> <mn>1</mn> <mn>2</mn> </msubsup> <mo>-</mo> <msubsup> <mi>l</mi> <mn>2</mn> <mn>2</mn> </msubsup> </mrow>

式中,x、y和z分別表示坐標系O-xyz各坐標軸的單位矢量;r表示動平臺參考點O′的位置矢量;ei表示主動臂旋轉(zhuǎn)中心的位置矢量;l1和l2分別為支鏈i主動臂和從動臂的桿長;βi表示靜平臺結(jié)構(gòu)角,且

當前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1