Identification of an Underactuated Unmanned Surface Vehicle 欠驱动无人船流体动力参数辨识 USV
·7

02·西北工业大学学报第30卷
tively,ω1k∈Rnandω2k∈Rparezero-meanprocess
noisesequences.
Togetherwiththemeasurementequation,theaug-mentedstate-spacemodelcanbeexpressedinformas:
xνk+1
k+1=
[θ+
+
ω1k
k+1
]
[
f(νk,θk)θk][ω(12)2k
]
yk=h(xk)+ω3k
(13)
wherexk∈Rn+pandyk∈Rmarethestatevectorandthemeasurementvector,respectively,ω3kisazero-meanmeasurementnoisesequence.
Usingtheabovesystem,thediscrete-timeEKFtechniquecanbeappliedtoestimatethevectorofun-knownsθ.TheKalmanfilterforequations(5)~(12)
issummarizedasfollows:
Timeupdate:
^x
k+1/k=f(x^k)(14)Pk+1/k=FkPkFTk+Qk
(15)
Measurementupdate:
KTk+1=Pk+1/kH
k+1
(H1/kHTk+1
+R1
k+1Pk+k+1)
-(16)
^x
k+1=x^k+1/k+Kk+1[yk+1-h(^xk+1/k)](17)Pk+1=(I-Kk+1Hk+1)Pk+1/k
(18)
wherePandKaretheerrorcovarianceandthegainmatrix,respectively,QandRaretheprocessnoisecovarianceandthemeasurementnoisecovariance,re-spectively.
Onconditionthatthesystemisobservableatanytk>0,andQandRintheequations(14)~(15)arebothpositivedefinite,theparametersvectorθcanbe
estimatedbyextendedKalmanfilterequations(13)~(17).Thestatevariablecanyieldtox=[u,v,r,Xu,YT
v,Yr,Nv,Nr,…,N|v|v,N|r|r].Theoutputvariablesarechosenasvelocitymeasurementssuchasy=[u,v,r]T
,whileaccelerationmeasurementsalsocanbeused.3.2
LSmethod
Anotherdescriptionofdynamicsequation(1)isasfollows
[6]
:
m(u-vr-x2
Gr)=X(19)m(v+uv+xGr=Y(20)Izr+mxG(v+ur)=N
(21)
whereX,Y,andNrepresentthetotalsurgeforce,
swayforce,andyawmoment,respectively,whichtakesintoaccounttheforcesexertedontheUSVbythepropulsionsystem,andthehydrodynamiceffectsfromhullmovements.
Theuncoupledmodelstructurefortheforcetermscanbedescribedas[5]:
X=Xuu+Xuu+X|u|u|u|u+τ1(22)Y=Yvv+Yrr+Yvv+Yrr+
Y|v|v|v|v+Y|r|r|r|r(23)
N=Nvv+Nrr+Nvv+Nrr+
N|v|v|v|v+N|r|r|r|r+τ2(24)
andifanexperimenttakessamples,replacingτ1bye-quation(7)andmarkingn1|n1|+n2|n2|asn0,e-quation(21)willexpandtorowsas: X1 u1
u1|u1|u1n0,1 X2
Xu ε1 u2u2|u2|u2
n 0,2 … X ………… Xu ·
+ ε2 u{
i
i
ui
|ui|ui
n X|u|u … 0,i
G τ εy
H
{
{
i θ
ε
(25)
wheretheoutputyisdeterminedviaequations(18),εisameasurementnoiseterm.Hence,anequation
linearinthevectorofunknownsisobtained.Usinge-quations(24),theLSmethodcanbeappliedtoesti-matethecoefficientsvectorθ=[
XT
u,Xu,X|u|u,Cτ]inthesurgemodelthroughtheequationsasfollows:
θ
^LS=(HTH)-1HTy(26)andthesimilarstructurescanbeobtainedinthesway
andyawmodel.
4Systemintegrationandsimulation
Thissectionisdevotedtothedescriptionofthe
systemintegrationandsimulationresultswhicharepre-paredforfieldexperiments.Tosupportthetheoryde-velopmentandalgorithmvalidation,anUSVprototypehasbeendevelopedbyNWPUin2010,asshowninFig2.4.1
Mechatronicsystem
TheUSVsystemisdesignedwiththefollowingre-quirementsinmind:
·Thegeneralizedposition,velocity,accelera-
THE NAVY UNMANNED SURFACE VEHICLE (USV) MASTER PLAN(美国无人船(USV)发展...Current doctrine specifies visual identification by a diver or camera, but ...
Robust Leader-Follower Formation Tracking Control of Multiple Underactuated Surface Vessels_专业资料。ChnOcanEg.Vo.6,iaen,t2No.P51—543,P.23 ◎22Chns ...
Global k_exponential asymptotic stabilization of underactuated surface vessels_交通运输_工程科技_专业资料。Systems & Control Letters 58 (2009) 194–201 ...
Identification and Contr... 6页 1财富值 Nonlinear control of a h... ...contains 12 variables, the aerial vehicle is an underactuated system with 4...
Path following of underactuated marine surface vessels using line-of-sight ...However, traditional guidance and control schemes used to steer the vehicle ...
Underactuated Vehicle Systems HE Yu-Qing1, 2 HAN Jian-Da1 Abstract In ...c control, and the U×Vs in battle?eld (unmanned ground/surface/air ...
stabilize a class of cascaded underactuated systems...autonomous unmanned aerial vehicle research ([1]-...d1 d2 ? 0 (17) A surface is then de?ned...
Identification and Contr... 6页 1财富值 Nonlinear control of a h... ...contains 12 variables, the aerial vehicle is an underactuated system with 4...
热门文档