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

一種抓捕高速旋轉目標后機械臂組合體的姿態穩定方法與流程

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

技術特征:

1.一種抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于,包括如下步驟:

步驟一、機械臂抓捕旋轉的空間碎片,結合動力學模型找出組合體的慣性主軸方向;

步驟二、通過調整機械臂構型使組合體的旋轉軸與慣性主軸方向重合,達到自旋穩定;

步驟三、結合本體執行機構和環境力矩對組合體消旋,實現機械臂組合體的姿態穩定。

2.根據權利要求1所述抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于:所述步驟三中的環境力矩為重力梯度力矩。

3.根據權利要求1所述抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于:

在確定組合體慣性主軸方向時,根據目標空間碎片與機械臂末端相對位姿,結合動量守恒推導組合體角速度表達式;

相對位姿為:

動量守恒:

組合體角速度表達式:

其中,Re是機械臂末端執行器質心矢量,reQ是機械臂末端執行器質心至與目標接觸點Q的矢量,ve和ωe是末段執行器的速度和角速度,Rt是目標質心的位置矢量,rTQ是目標質心至與末端接觸點Q的矢量,vt和ωt是目標的速度和角速度,vC和ωC是組合體質心的速度和角速度,R(qr)為目標姿態與末端姿態的轉換矩陣。

4.根據權利要求3所述抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于:

通過下式計算組合體的慣性主軸方向:

<mrow> <mo>(</mo> <msub> <mi>&lambda;</mi> <mi>i</mi> </msub> <msub> <mi>I</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>I</mi> <mi>C</mi> </msub> <mo>)</mo> <msubsup> <mi>A</mi> <mi>S</mi> <msup> <mi>S</mi> <mrow> <mo>&prime;</mo> <mi>T</mi> </mrow> </msup> </msubsup> <mo>(</mo> <mo>,</mo> <mi>i</mi> <mo>)</mo> <mo>=</mo> <mn>0</mn> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

其中,λi(i=1,2,3)為主慣性矩,I3為3×3單位矩陣,IC為組合體轉動慣量,為轉換矩陣,描述組合體質心坐標系S(C)至慣性主軸坐標系S'(C)的旋轉關系。

5.根據權利要求1所述抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于:按照下式實現組合體自旋穩定以及組合體的姿態穩定:

其中,為期望組合體質心角加速度,ωCe為誤差組合體質心角速度和角加速度,τ本體為組合體基座三軸姿態控制輸出,τ環境為環境力矩。

6.根據權利要求5所述抓捕高速旋轉目標后機械臂組合體的姿態穩定方法,其特征在于,式(5)中為了實現控制目的:

a.針對自旋穩定階段,當時間t→∞時,

b.針對姿態穩定階段,當時間t→∞時,

當前第2頁1 2 3 
網友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
主站蜘蛛池模板: 中卫市| 东台市| 太仆寺旗| 孟连| 大方县| 荣昌县| 仁寿县| 定远县| 徐水县| 秦皇岛市| 黔南| 龙山县| 蕲春县| 宁南县| 高州市| 刚察县| 龙陵县| 友谊县| 平武县| 嘉兴市| 达拉特旗| 乌兰县| 英山县| 普兰店市| 永丰县| 寿阳县| 启东市| 永新县| 武威市| 三都| 潞西市| 孙吴县| 台州市| 博白县| 邵武市| 松江区| 紫金县| 临泽县| 长治县| 镇平县| 察哈|