Instruction Manual
GNAV540UserManual
7430‐0808‐01Rev.B
Page27
VGFunctionadaptivelytunestheEKFfeedbackinordertobestbalancethebiasestimationandattitudecorrection
withdistortionfreeperformanceduringdynamicswhentheobjectisacceleratingeitherlinearly(speedchanges)or
centripetally(falsegravityforcesfromturns).Becausecentripetalandotherdynamicaccelerationsareoften
sfilteredy
associatedwithyawrate,theunitmaintainsalow‐pas awratesignalandcomparesittotheturnSwitch
thresholdfield(useradjustable).
Whentheplatformtheunitisattachedtoexceedsthe
turnSwitchthresholdyawrate,theunitlowersthefeedback
gainsfromtheaccelerometerstoallowtheattitudeestimatetocoastthroughthedynamicsituationwithprimary
relianceonangularratesensors.ThissituationisindicatedbythesoftwareStatus→turnSwitchstatusflag.Usingthe
turnswitchmaintainsbetterattitudeaccuracyduringshort‐termdynamicsituations,butcaremustbetakento
ensurethatthedutycycleoftheturnswitchgenerallystaysbelow10%duringthevehiclemission.Ahighturn
switchdutycycledoesnotallowthesystemtoapplyenoughratesensorbiascorrectionandcouldallowtheattitude
estimatetobecomeunstable.
TheVGFunctionalgorithmhastwomajorphasesofoperation.Thefirstphaseofoperationistheinitialization
phase.Duringtheinitializationphase,theunitisexpectedtobestationaryorquasi‐staticsotheEKFweightsthe
accelerometergravityreferenceheavilyinordertorapidlyestimatetherollandpitchangles,andX,Yratesensor
bias.Theinitializationphaselastsapproximately60seconds,andtheinitializationphasecanbemonitoredinthe
softwareStatusBITtransmittedbydefaultineachmeasurementpacket.Aftertheinitializationphase,theunit
operateswithlowerlevelsoffeedback(alsoreferredtoasEKFgain)fromtheaccelerometerstocontinuously
estimateandcorrectforrollandpitcherrors,aswellastoestimateXandYratesensorbias.Toresetthealgorithm
orre‐entertheinitializationphase,sendingthealgorithmresetcommand, ,willforcethealgorithmintothereset
AR
phase.
InadditiontothescaledsensorpacketsdescribedintheIMUFunctionsection,theVGFunctionhasadditional
measurementoutputpacketsincludingthedefault
A2AnglePacketwhichoutputstherollangle,pitchangle,and
digitalIMUdata.
N0andN1packetsarealsoavailableforusewithanexternalGPSreceiver.Formoreinformation,
referto
Chapter9.CommunicatingwiththeGNAV540UnitandChapter10.ProgrammingGuidelinesforpacket
descriptions.
VGFunctionAdvancedSettings
Inadditiontotheconfigurablebaudrate,packetrate,axisorientation,andsensorlow‐passfiltersettings,VG
unctionprovidesadditionaladvancedsettingsthatareselectablefortailoringtheunittoaspecificapplication
equirements.Thesettingsarelistedin
F
r
Table8below.
Table8VGFunctionAdvancedSettings
Setting DefaultValue Comments
BaudRate 38,400baud 9600,19200,57600alsoavailable
PacketType A2 S1,S2,N0,N1alsoavailable
PacketRate 25Hz ThissettingsetstherateatwhichselectedPacketType,packetsareoutput.
Ifpolledmodeisdesired,thenselect
Quiet.IfQuietisselected,theunitwillonly
sendmeasurementpacketsinresponsetoGPcommands.
Orientation
See
Figure4on
page
24.
Toconfiguretheaxisorientation,selectthedesiredmeasurementforeachaxis:
NAV‐VIEW2.2willshowthecorrespondingimageoftheunit,soiteasyto
visualizethemodeofoperation.Referto
OrientationFieldonpage86forthe
twentyfourpossibleorientationsettings.Thedefaultsettingpointsthe
connectorAFT.