麻豆精品无码国产在线播放,国产亚洲精品成人AA片新蒲金,国模无码大尺度一区二区三区,神马免费午夜福利剧场

存在外界擾動的柔性機械臂擾動觀測控制方法與流程

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

技術特征:

1.一種存在外界擾動的柔性機械臂擾動觀測控制方法,其特征在于包括以下步驟:

步驟一、n自由度柔性機械臂的動力學模型為:

<mrow> <mi>M</mi> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&theta;</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&delta;</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>D</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>D</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>K</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&theta;</mi> </mtd> </mtr> <mtr> <mtd> <mi>&delta;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>u</mi> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>f</mi> <mi>d</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

其中,M為正定對稱慣性矩陣,是與哥氏力和向心力相關的項,D1、D2為阻尼矩陣,K2為剛度矩陣,u為關節輸入力矩,

TT]T=[θ1…θn…δ1,1…δ1,m…δn,1…δn,m]T是由機械臂關節角和柔性模態組成的廣義矢量,θi為第i個關節角變量,δi,j是第i個連桿的第j個模態變量,fd為由關節摩擦以及柔性連桿的振動阻尼引起的外部干擾項;

定義式(1)進一步寫為:

<mrow> <mtable> <mtr> <mtd> <mrow> <mover> <mi>&theta;</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <msub> <mi>H</mi> <mn>11</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>(</mo> <mrow> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>H</mi> <mn>12</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>(</mo> <mrow> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>D</mi> <mn>2</mn> </msub> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> <mi>&delta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>H</mi> <mn>11</mn> </msub> <mi>u</mi> <mo>+</mo> <msub> <mi>H</mi> <mn>11</mn> </msub> <msub> <mi>f</mi> <mi>d</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>&delta;</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <msub> <mi>H</mi> <mn>21</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>(</mo> <mrow> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>H</mi> <mn>22</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>(</mo> <mrow> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>D</mi> <mn>2</mn> </msub> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> <mi>&delta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>H</mi> <mn>21</mn> </msub> <mi>u</mi> <mo>+</mo> <msub> <mi>H</mi> <mn>21</mn> </msub> <msub> <mi>f</mi> <mi>d</mi> </msub> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

針對系統具有的非最小相位特性,進行輸出重定義:

<mrow> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mo>+</mo> <mfrac> <msub> <mi>&alpha;</mi> <mi>i</mi> </msub> <msub> <mi>l</mi> <mi>i</mi> </msub> </mfrac> <munderover> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>m</mi> </munderover> <msub> <mi>&phi;</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>j</mi> </mrow> </msub> <msub> <mi>&delta;</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>j</mi> </mrow> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mo>...</mo> <mi>n</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

其中,φi,j是第i個連桿的第j個模態形函數,li是第i個連桿的長度,α=[α12,…αn]T為跟輸出重定義有關的參數向量,-1<αi<1與輸出重定義有關具體參數由設計者選定;式(3)寫成矩陣形式為:

y=θ+Cδ (4)

其中,

步驟二、結合式(2)-(4)得到:

<mrow> <mover> <mi>y</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>=</mo> <mi>A</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>+</mo> <mi>B</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <mi>u</mi> <mo>+</mo> <mi>d</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

其中,B=H11+CH21,B0為通過系統標稱信息所得標稱值,即B=B0+ΔB,d=(H11+CH21)fd;

定義式(5)改寫為:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>&mu;</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>&mu;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&mu;</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mi>A</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>+</mo> <mi>B</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <msub> <mi>u</mi> <mrow> <mi>e</mi> <mi>x</mi> </mrow> </msub> <mo>+</mo> <mi>d</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&psi;</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>&psi;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&psi;</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mi>E</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>+</mo> <mi>F</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <msub> <mi>u</mi> <mrow> <mi>i</mi> <mi>n</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>H</mi> <mn>21</mn> </msub> <msub> <mi>f</mi> <mi>d</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

輸入輸出子系統為:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>&mu;</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>&mu;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&mu;</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mi>A</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>+</mo> <mi>B</mi> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <msub> <mi>u</mi> <mrow> <mi>e</mi> <mi>x</mi> </mrow> </msub> <mo>+</mo> <mi>d</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

內部動態子系統為:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>&psi;</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>&psi;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&psi;</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mi>E</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>,</mo> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mo>,</mo> <mover> <mi>&delta;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> <mo>+</mo> <mi>F</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <msub> <mi>u</mi> <mrow> <mi>i</mi> <mi>n</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>H</mi> <mn>21</mn> </msub> <msub> <mi>f</mi> <mi>d</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>

其中,uex為輸入輸出子系統的控制輸入,uin為內動態子系統的控制輸入,F(θ,δ)=H21;

步驟三、定義誤差信號e1=μ1-yr,yr為關節角期望值,設計虛擬控制量;

<mrow> <msub> <mi>u</mi> <mrow> <mn>2</mn> <mi>d</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>1</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mover> <mi>y</mi> <mo>&CenterDot;</mo> </mover> <mi>r</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>

其中,k1為正定對稱非奇異矩陣,其具體參數由設計者給定;

定義誤差信號e2=μ2-u2d,定義設計擾動觀測器為:

<mrow> <mover> <mi>D</mi> <mo>^</mo> </mover> <mo>=</mo> <mover> <mi>Z</mi> <mo>^</mo> </mover> <mo>+</mo> <msub> <mi>k</mi> <mi>d</mi> </msub> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>

其中,kd為正數其具體參數由設計者給定,為中間變量,具體形式如下:

<mrow> <mover> <mover> <mi>Z</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>B</mi> <mn>0</mn> </msub> <mo>(</mo> <mrow> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> </mrow> <mo>)</mo> <mi>u</mi> <mo>+</mo> <mover> <mi>Z</mi> <mo>^</mo> </mover> <mo>+</mo> <msub> <mi>k</mi> <mi>d</mi> </msub> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>u</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mn>2</mn> <mi>d</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>

設計控制器:

<mrow> <msub> <mi>u</mi> <mrow> <mi>e</mi> <mi>x</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>B</mi> <mn>0</mn> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mrow> <mo>(</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&theta;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>-</mo> <mover> <mi>D</mi> <mo>^</mo> </mover> <mo>+</mo> <msub> <mover> <mi>u</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mn>2</mn> <mi>d</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>

其中,k2為正定對稱非奇異矩陣由設計者給定;

針對內動態子系統,采用狀態反饋控制器:控制增益kδ采用極點配置得到;

機械臂系統控制器輸入為

u=uex+uin

步驟四、根據得到的關節輸入力矩u,返回柔性機械臂動力學模型(2)和輸出重定義(3),對關節角進行跟蹤控制。

當前第2頁1 2 3 
網友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
主站蜘蛛池模板: 巴林左旗| 建瓯市| 太白县| 黎城县| 大邑县| 木里| 嘉善县| 横山县| 尼勒克县| 镇平县| 伊吾县| 固原市| 印江| 陇川县| 隆德县| 平武县| 平度市| 中阳县| 鄢陵县| 河西区| 宁明县| 莱芜市| 濮阳市| 夏邑县| 巴东县| 崇州市| 永定县| 介休市| 蓬莱市| 湘西| 巴塘县| 阜城县| 加查县| 磐石市| 汤原县| 泾川县| 沁阳市| 铜鼓县| 鹤峰县| 平南县| 苏尼特右旗|