• 
    <ul id="o6k0g"></ul>
    <ul id="o6k0g"></ul>

    空間機械手遙操作指令安全檢測與修正方法技術

    技術編號:8617772 閱讀:231 留言:0更新日期:2013-04-24 22:55
    本發明專利技術涉及一種空間機械手遙操作指令安全檢測與修正方法,對發令端指令分別在笛卡爾空間和關節空間進行速度檢測,如果速度超出限定閾值,在笛卡爾空間進行限幅后再次超限檢測及限幅,直到滿足要求為止。通過限幅可以減小機械手運動引起的振動,保證機械手定位精度。并且保持規劃路徑笛卡爾空間的一致性。本發明專利技術提到的空間機械手為自由飛行機器人,位置和姿態相對于基座安裝坐標系。

    【技術實現步驟摘要】

    本專利技術屬于機械手控制領域,具體涉及一種空間機械手遙操作指令速度超限檢測及修正方法。
    技術介紹
    在未來的空間活動中,將有大量的空間生產、空間加工、空間裝配、空間維護和修理工作進行。這樣大量的工作不可能僅僅依靠宇航員完成,必須充分利用空間機器人。在遙操作遠端機械手過程中,遠端機械手的運動都是由主手發送指令來驅動的。空間機械手遙操作中最主要的問題是空間與地面通訊中的時間延遲以及有限的數據傳輸帶寬。時延對空間機器人最大的影響是使連續遙操作閉環反饋控制系統變得不穩定。同時在存在時延下,即使操作者完成簡單工作也需要比無時延情況下長的多的時間,這是由于操作者為避免系統不穩定,必須采取“運動-等待”的階段工作方式。尤其當回路時延較大時,對操作者影響非常明顯。這種情況下對遙操作指令進行速度檢測和修正顯得尤為必要。另外,搭載在本體上的機械手的運動會對基座航天器產生反作用力和力矩,引起基座航天器位置和姿態發生變化,如果機械手笛卡爾空間或關節空間運動速度較大,這種影響更加明顯,所以對遙操作指令速度進行超限檢測并加以修正是非常必要的。機械手臂的高速運動往往會激勵起彈性結構的振動,而且輕型結構的機械手,彈性變形量大,也會產生低頻振動,這不僅影響了機械臂的末端定位精度,還可能影響整個機器人系統的穩定性,同樣需要對主手發出的指令進行檢測和修正,確保任務可以安全執行。
    技術實現思路
    要解決的技術問題為了避免現有技術的不足之處,本專利技術提出一種,通過反復檢測限幅得到安全的指令,能夠盡量減小時延影響,使機械手運動速度限定在一定范圍、振動較小同時保證操作的安全性。技術方案一種,其特征在于步驟如下步驟1:首先獲取當前時刻指令,如果當前時刻指令為位姿指令(Xt,Yt,Zt,at,i3t,Yt),逆解出相應的關節角指令(θη,θ2 , θ3 , θ4 , θ5 , 06t),如果當前時刻指令為關節角指令,正解出相應的位姿指令;其中(Xt,Yt, Zt)為t時刻笛卡爾空間位置,(a t, β t, Yt)為t時刻歐拉角,β t為t時刻關節角;計算笛卡爾空間位置進動量為本文檔來自技高網...

    【技術保護點】
    一種空間機械手遙操作指令安全檢測與修正方法,其特征在于步驟如下:步驟1:首先獲取當前時刻指令,如果當前時刻指令為位姿指令(Xt,Yt,Zt,αt,βt,γt),逆解出相應的關節角指令(θ1t,θ2t,θ3t,θ4t,θ5t,θ6t),如果當前時刻指令為關節角指令,正解出相應的位姿指令;其中:(Xt,Yt,Zt)為t時刻笛卡爾空間位置,(αt,βt,γt)為t時刻歐拉角,θt為t時刻關節角;計算笛卡爾空間位置進動量為:ΔP=(Xt-Xt-1)2+(Yt-Yt-1)2+(Zt-Zt-1)2;計算笛卡爾空間姿態進動量為:笛卡爾空間姿態進動量采用等效軸角表示法,由歐拉角(α,β,γ)分別計算上一時刻的旋轉矩陣At?1=[nt?1,ot?1,at?1]和當前時刻的旋轉矩陣At=[nt,ot,at],那么末端等效誤差12(nt-1×nt+ot-1×ot+at-1×at)=Ksin(ΔΘ)笛卡爾空間姿態進動量為等效轉角:ΔΘ=arcsin(|e|)其中,等效轉軸步驟2:比較ΔP與VPmaxΔt,如果ΔP>VPmaxΔt,更新當前時刻位置,Xt=Xt-1+vPmaxΔt*Xt-Xt-1ΔPYt=Yt-1+vPmaxΔt*Yt-Yt-1ΔPZt=Zt-1+vPmaxΔt*Zt-Zt-1ΔP否則轉至步驟3;其中VPmax為末端速度閾值,Δt為指令發送間隔;步驟3:比較ΔΘ與ωPmaxΔt,如果ΔΘ>ωPmaxΔt,更新當前時刻姿態:ΔΘ=ωPmaxΔt否則轉至步驟4;由ΔΘ和K計算出等效旋轉矩陣RK,那么當前時刻旋轉矩陣RC=RK*RI,其中RI為上一時刻旋轉矩陣,由RC解出歐拉角(α,β,γ);其中ωPmax為末端角速度閾值;步驟4:對當前時刻位姿進行求逆運算,得到當前時刻關節角θi,計算關節空間進動量:Δθi=θi(t)?θi(t?1);將Δθi與ωJmaxΔt相比較,如果|Δθi|>ωJmaxΔt,在笛卡爾空 間進行限幅,分別更新當前時刻位置和等效轉角Xt=Xt-1+CPv·vPmaxΔt*Xt-Xt-1ΔPYt=Yt-1+CPv·vPmaxΔt*Yt-Yt-1ΔPZt=Zt-1+CPv·vPmaxΔt*Zt-Zt-1ΔPΔΘ=CPω·ωPmaxΔt否則轉至步驟6;依次求出等效旋轉矩陣RK,當前時刻旋轉矩陣RC=RK*RI,解算出歐拉角(α,β,γ);其中ωJmax為關節角速度閾值,CPv和CPω分別為限幅系數;步驟5:對當前時刻位姿進行求逆運算,得到更新后的當前時刻關節角θt,返回步驟4進行關節空間角速度檢測與限幅,否則轉至步驟6;步驟6:生成安全的指令,由發令端發送給遠端空間機械手。FDA00002736155200013.jpg...

    【技術特征摘要】
    1. 一種空間機械手遙操作指令安全檢測與修正方法,其特征在于步驟如下步驟1:首先獲取當前時刻指令,如果當前時刻指令為位姿指令(xt,Yt, zt, at,i3t,Y t),逆解出相應的關節角指令(elt,e2t, e3t...

    【專利技術屬性】
    技術研發人員:黃攀峰齊慶璽劉正雄孟中杰
    申請(專利權)人:西北工業大學
    類型:發明
    國別省市:

    網友詢問留言 已有0條評論
    • 還沒有人留言評論。發表了對其他瀏覽者有用的留言會獲得科技券。

    1
    主站蜘蛛池模板: 免费无码国产V片在线观看| 亚洲熟妇无码一区二区三区导航| 国产精品无码一区二区在线观| 免费无码精品黄AV电影| 天堂Aⅴ无码一区二区三区| 99精品一区二区三区无码吞精| 久久美利坚合众国AV无码| 无码人妻精品中文字幕| 久久无码AV中文出轨人妻| 亚洲中文字幕久久无码| 国产精品无码无卡在线播放 | 无码激情做a爰片毛片AV片| 无码中文人妻视频2019| 久久影院午夜理论片无码| 亚无码乱人伦一区二区| 色欲A∨无码蜜臀AV免费播 | 亚洲精品无码不卡在线播放| 亚洲日韩精品一区二区三区无码 | 狠狠躁天天躁中文字幕无码| 亚洲GV天堂GV无码男同| 久久久久亚洲精品无码蜜桃| 中文字幕乱码人妻无码久久| 国产精品爽爽V在线观看无码| 亚洲一区二区三区无码国产 | 亚洲AV无码一区二区三区久久精品| 亚洲国产精品无码久久久蜜芽| 中文字幕av无码不卡| 日韩少妇无码一区二区三区| 精品久久久久久久无码久中文字幕 | 亚洲av中文无码乱人伦在线播放 | 亚洲AV综合色区无码二区偷拍 | 亚洲av无码不卡久久| 日韩免费无码视频一区二区三区| 亚洲AV无码精品色午夜果冻不卡 | 色综合久久中文字幕无码 | 亚洲熟妇无码久久精品| 亚洲AV无码久久久久网站蜜桃| 精品无码AV一区二区三区不卡| 无码中文字幕av免费放dvd| 无码国产精成人午夜视频一区二区 | 国产在线无码精品电影网|