文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > Identification of an Underactuated Unmanned Surface Vehicle
侵权投诉

Identification of an Underactuated Unmanned Surface Vehicle

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

·7

Identification of an Underactuated Unmanned Surface Vehicle

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=Xuu+Xuu+X|u|u|u|u+τ1(22)Y=Yvv+Yrr+Yvv+Yrr+

Y|v|v|v|v+Y|r|r|r|r(23)

N=Nvv+Nrr+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 u1

u1|u1|u1n0,1 X2

Xu ε1 u2u2|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-

上一页第4页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email