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

一種噴水推進無人艇自主區(qū)域保持的仿人智能控制方法與流程

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

技術(shù)特征:

1.一種噴水推進無人艇自主區(qū)域保持的仿人智能控制方法,其特征是:對控制邊界的位姿傳感器測得的參數(shù)進行關(guān)鍵參數(shù)的分析與計算,區(qū)域保持判斷系統(tǒng)根據(jù)關(guān)鍵參數(shù)的計算值和實際值比較,判斷是否需要進行區(qū)域保持,如果需要進行區(qū)域保持則對欠驅(qū)動噴水推進無人艇運動方程與區(qū)域保持停止位置軌跡方程的偏差方程進行求解,并將數(shù)據(jù)信息傳遞給仿人智能算法控制器,仿人智能控制器根據(jù)被調(diào)量、偏差以及偏差的變化趨勢確定區(qū)域保持控制策略并通過執(zhí)行機構(gòu)實施。

2.根據(jù)權(quán)利要求1所述的噴水推進無人艇自主區(qū)域保持的仿人智能控制方法,其特征是所述關(guān)鍵參數(shù)的分析與計算具體包括:

(1)航跡是否在區(qū)域保持的區(qū)域內(nèi),即區(qū)域中心O至無人艇航跡的距離的最大值rmax,計算公式為:

其中,(XO,YO)為區(qū)域中心O的坐標(biāo),(X,Y)為無人艇運動航跡坐標(biāo),

(2)極限運動距離k,即無人艇采取控制措施的極限范圍r′max,計算公式為:

其中,R為區(qū)域半徑,δ為干擾力作用的方向角,

(3)推進裝置復(fù)位角θF,即當(dāng)艏向角ψ等于復(fù)位角時推進裝置復(fù)位,計算公式為:

R′為內(nèi)圓半徑,

(4)推進裝置停止位置,如果海況未知時將O作為停止位置,如果海況已知且為四級海況及以下時則將O′作為停止位置,

其中O′為干擾力方向過圓心且與內(nèi)圓交點。

3.根據(jù)權(quán)利要求2所述的噴水推進無人艇自主區(qū)域保持的仿人智能控制方法,其特征是所述對欠驅(qū)動噴水推進無人艇運動方程與區(qū)域保持停止位置軌跡方程的偏差方程進行求解具體包括:

無人艇水平面3自由度的運動方程為:

其中,η=[x,y,ψ]T、vT=[u,v,r]、τ=[τ1,0,τ3]T分別為位置、速度和推進力,τ1和τ3分別為水面無人艇的縱向推進力和轉(zhuǎn)艏力矩,m11,m22,m33為包含附加質(zhì)量的系統(tǒng)慣性矩陣參數(shù),其余為水動力系數(shù);

啟動區(qū)域保持控制邊界的參考軌跡(xd,ydd,ud,vd,rd)和參考控制輸入(τ1d3d)滿足

對無人艇水平面3自由度的運動方程進行微分同胚變換,令

z1=x cosψ-y sinψ

z3=ψ

z5=v

z6=r

和控制輸入變換

整理后新的狀態(tài)方程為

同理求得區(qū)域保持控制邊界參考軌跡的微分同胚變換方程定義偏差

e=[e1,e2,e3,e4,e5,e6]T=[z1-z1d,z2-z2d,z3-z3d,z4-z4d,z5-z5d,z6-z6d]T

由下式消去z1,z2,z3,z4,z5,z6,

z4z6-z4dz6d

=z4z6-z4z6d+z4z6d-z4dz6d

=z4e6-z4de6+z4de6+z6de4

=e4e6+z4de6+z6de4

得偏差方程

其中,

4.根據(jù)權(quán)利要求3所述的噴水推進無人艇自主區(qū)域保持的仿人智能控制方法,其特征是所述判斷是否需要進行區(qū)域保持具體包括:當(dāng)r≤rmax時,不需要啟動區(qū)域保持;當(dāng)rmax<r≤r′max零時,啟動區(qū)域保持;當(dāng)r>r′max時,區(qū)域保持失敗。

5.根據(jù)權(quán)利要求4所述的噴水推進無人艇自主區(qū)域保持的仿人智能控制方法,其特征是所述確定區(qū)域保持控制策略具體包括:

仿人智能積分算法如下:

其中,u為控制量,e為偏差,為偏差導(dǎo)數(shù),Kp為比例增益,Ki為積分增益,Kd為微分增益;

(1)、運行控制級

理想誤差目標(biāo)軌跡為為偏差和偏差變化率的閾值,,人艇運行控制級的特征基元集合為:Q1={q1,q2,q3,q4,q5,q6,q7},

其中:q2:|en|≥e1,q3:|en|≥e2,q4:|en|≥e3,

無人艇運行控制級的模型為Φ1={φ111213141516171819110}

其中:

無人艇運行控制級的控制模態(tài)級Ψ1={ψ11,ψ12,ψ13,ψ14,ψ15,ψ16}

其中:

式中符號un,un-1控制器的第n,n-1次輸出;Umax控制器輸出的最大值;控制系統(tǒng)第n次的偏差、偏差變化率;emi控制系統(tǒng)偏差的第i次極值;Kp,Kd,Ki,Sp,k控制器的比例系數(shù)、微分系數(shù)、積分系數(shù)、比例系數(shù)的符號、增益抑制因子;

無人艇運行控制級的推理規(guī)則集Ω1={ω111213141516}

其中:

(2)、參數(shù)校正級

無人艇參數(shù)校正級的特征基元集合Q2={q1,q2,q3,q4,q5,q6,q7,q8,q9}

其中:

無人艇參數(shù)校正級的特征模型Φ2={Φ21,Φ22},

其中Φ21={φ212,φ2141,φ215,φ2171,φ2172,φ218}為2、4象限的特征模型,

Φ22={φ22101,φ22102,φ22103,φ22104}為1、3象限的特征模型,式中:

無人艇參數(shù)校正級的決策模態(tài)級Ψ2={Ψ21,Ψ22},其中:Ψ21={ψ21i},i=2,41,5,71,72,8Ψ22={ψ22i},i=101,102,103,104式中:

ψ212={Kd=Kd+kd12141={Kp=Kp+kp1}

ψ215={Kp=Kp-kp12171={Kd=Kd+kd1,Sp=-1}

ψ2172={Kd=Kd+kd1,Kp=Kp-kp1218={Kd=Kd+kd1}

ψ22101={Kd=Kd+kd2,Kp=Kp-kp222102={Kp=Kp+kp2}

ψ22103={Kd=Kd+kd2,Kp=Kp+kp222104={Kd=Kd+kd2,Kp=Kp-kp2}

式中的符號意義如下:kp1,kd1,kp2,kd2:2、4象限的比例或微分的增加或減小系數(shù),l、3象限的或微分的增加或減小系數(shù),

無人艇參數(shù)校正級的推理規(guī)則集Ω2={Ω2122},其中:Ω21={ω21i},i=2,41,5,71,72,8,Ω22={ω22i},i=101,102,103,104,

式中:

(3)、任務(wù)適應(yīng)級

無人艇任務(wù)適應(yīng)級的特征模型Φ3={φ3132},其中:φ31為輸入歸一化的控制特征模型,φ32為輸出反歸一化的控制特征模型;

無人艇任務(wù)適應(yīng)級的控制模態(tài)集Ψ3={ψ3132},其中:

ψ32={un=Umax·un,0,if|un,0|>1thenun,0=sgn(un,0)},式中的符號意義如下:

偏差和偏差變化率歸一化的輸入;控制系統(tǒng)的偏差和偏差變化率;Dmax,Vmax:被控制量的最大牽引距離,被控制量的最大牽引速度;un,un,0,Umax:實際控制器的輸出,歸一化的控制器輸出,控制執(zhí)行機構(gòu)的最大輸入;

無人艇任務(wù)適應(yīng)級的推理規(guī)則集Ω3={ω3132},其中:

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