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,yd,ψd,ud,vd,rd)和參考控制輸入(τ1d,τ3d)滿足
對無人艇水平面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={φ11,φ12,φ13,φ14,φ15,φ16,φ17,φ18,φ19,φ110}
其中:
無人艇運行控制級的控制模態(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={ω11,ω12,ω13,ω14,ω15,ω16}
其中:
(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+kd1}ψ2141={Kp=Kp+kp1}
ψ215={Kp=Kp-kp1}ψ2171={Kd=Kd+kd1,Sp=-1}
ψ2172={Kd=Kd+kd1,Kp=Kp-kp1}ψ218={Kd=Kd+kd1}
ψ22101={Kd=Kd+kd2,Kp=Kp-kp2}ψ22102={Kp=Kp+kp2}
ψ22103={Kd=Kd+kd2,Kp=Kp+kp2}ψ22104={Kd=Kd+kd2,Kp=Kp-kp2}
式中的符號意義如下:kp1,kd1,kp2,kd2:2、4象限的比例或微分的增加或減小系數(shù),l、3象限的或微分的增加或減小系數(shù),
無人艇參數(shù)校正級的推理規(guī)則集Ω2={Ω21,Ω22},其中:Ω21={ω21i},i=2,41,5,71,72,8,Ω22={ω22i},i=101,102,103,104,
式中:
(3)、任務(wù)適應(yīng)級
無人艇任務(wù)適應(yīng)級的特征模型Φ3={φ31,φ32},其中:φ31為輸入歸一化的控制特征模型,φ32為輸出反歸一化的控制特征模型;
無人艇任務(wù)適應(yīng)級的控制模態(tài)集Ψ3={ψ31,ψ32},其中:
ψ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={ω31,ω32},其中: