• 
    <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
    主站蜘蛛池模板: 啊灬啊别停灬用力啊无码视频| 久久午夜夜伦鲁鲁片免费无码影视| 亚洲精品无码久久久影院相关影片| 中文字幕无码av激情不卡久久| 无码人妻精品一区二区三区东京热 | 色综合久久久无码中文字幕波多| 亚洲熟妇少妇任你躁在线观看无码| 亚洲精品午夜无码电影网| 久久久久久久无码高潮| 免费无码婬片aaa直播表情| 亚洲∧v久久久无码精品| 特级无码毛片免费视频| 高清无码中文字幕在线观看视频| 久久久久久国产精品无码下载 | 亚洲一本到无码av中文字幕| 惠民福利中文字幕人妻无码乱精品| 无码国产精品一区二区免费虚拟VR | 日日麻批免费40分钟无码| 无码h黄肉3d动漫在线观看| 精品无码AV一区二区三区不卡| 亚洲精品无码久久千人斩| 无码不卡亚洲成?人片| 蜜色欲多人AV久久无码| 无码丰满熟妇一区二区| 精品人妻无码区二区三区| 日韩国产成人无码av毛片| 无码中文字幕日韩专区| 无码专区—VA亚洲V天堂| 亚洲精品无码久久千人斩| 亚洲av无码av制服另类专区| 在线观看免费无码专区| 国产色爽免费无码视频| 国产成人无码AV一区二区| 中文字幕丰满伦子无码| av无码人妻一区二区三区牛牛| heyzo高无码国产精品| 中文精品无码中文字幕无码专区| 国精品无码A区一区二区| 日韩人妻无码一区二区三区久久99| 久久伊人中文无码| 亚洲熟妇无码AV在线播放|