RSRC LVARLBVW\ <">>"@  J B&*">>"`PP``LL`440<ψȈfofofo     P\ P_\ _U U++++++++++++++++++++++++++++++++++++++++++++++++  K_step.vi@ z@ Q@ R@ Residual @ ^x(old) @ ^x(new) @ ^P(old) @ ^P(new)@ u@ A@ B@ H@ Kalman_gainL      1D_navigation_NXT.vi,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gainٛ11ك1ٛ1A2xx@T"/""#UU*몪着*着着*+ꫯ+Ȍ  3 ̌̈  ̌̈  ̌̈  Č̈  ̌  ̌Ό  ̈<?g<=;>??|x|ϟ?s=x<8B#?08¸#?08¸=||<?<w{;??3DD@1LDD3DD@1LDD3DD@1LDD3DD@1LDD3DD@1LDD3DD@1??8<<<3O<<?𨪪XuE}ݙO >胀>胀>胀胀>胀@T"/""?( Ȍ̈Ȉ̌Ȉ̈̌̈̈̈ȈȌȌȌ d H  `  HHĠd ` d  dH HĠ ?  ?HHHL ?H䠎  O H   HĿHĿHĿHįHĿH H  H  H H ? H|  ̈( ̈,΢b...,,0( ̈,΢b...,,<, L̈,΢b...,,0, ̈,΢b...,,0h, ̈,΢b...,,<h, ̈,΢b...,,<h L̈,΢b...,,0h, ̈,΢b...,,<h, ̈,΢b...,,<h, ̈,΢b...,,<h, ̈,΢b..!,,<h, ̈,΢b...,,<h, ̈,΢b...,,<  < 0T0Qt11EݟEEݟ333333̌ < H̎ ̌̌Ȍ̌`̌Œ` ̌̌Ȍ̌`̌Œ`oooooooooo ̌̌Ȍ̌`̌ƌ` ̌̌Ȍ̌Œ`̌` ̌̌Ȍ̌Œ`̌` ̌̌Ȍ̌`̌Œ` ̌̌Ȍp̌`̌ƌ`(̈̈Ȉ̈Ȉ̈(Ȉ ̌̌Ȍ̌`̌Œ`Ȉ(̈̈Ȉ̈Ȉ̈hȈ ̌̌Ȍ̌`̌Œ` ̌̌Ȍ̌`̌Œ`ḦȞȈ( ̌b,,̼̂̃B̻ˈ,̼B̻ˈ,̼B̪J,̬B̺ˈ,̼BΈ,Bψ,B Ȍ ̈(Ȍ (/ 𨠏̈ ((*Ȍ  ̈*(/򨂏Ȍ  ꈈ̈Ȉ̀Ȍ (.̈( ̈Ȍ̈13 /(*̈ 0Ȉ(Ȍ  ̈Ȉ̈̀̌̌Ȉ ̀ ̌ EEE EE  ̌Ȉ(̌̌ȌČ̈̈ Ȉ̀̌̌ E  Ȟ̌Ȉ̌̌Ȉ ( ( LȈ̈,Ȉ, h Ḧ Ȍ` ̌Ḧ̌ `Ȉ̈̈,(,,0,<̈̈(HȈȈ0̌̌̌Ȉ  ̈,̈Ĉ Ȉ,̂̌b̀Č̈Ȉ ̌̌ȈḦŒ`( Œ`,΢̂ ̈̃̌̌  (̌`Œ`Ȟ̈̈. ΢.,( , ̀ 0Q̌̃(/(* 򨠏 /(* *(*𨢏 / / ⨢ * Ȍ`(ਂ*(Č̈(  ,,̂b ,<`Œ`/(  /* ̀ (Ȉ̈ḦḦ*(`Œ`̌H ̈,Ȉ  𨠏   ̈  * /*(*(/(  𨠏 ( ̌(/𨢯𨠏* 𨂯𨢏,Ȉ̌ČH ̈,, 𨠏ČȈH ̈ .Ȟ̃ ̀b,̌ČHČ̌H ̈HȈḦHȈḦHĄȈḦHȈ̌Č,̂̃Č̈ *𨠏*   ̌G}|lll\lό  @@RSRC LVINLBVWl L` <u4{PFďz }I<iBڣ:+ ُ B~Uy"NX**PQ(LVIN K_step.viLVINCoerceValue.vi: x @ Numeric Out @Min (0)@ Max (100) @NumericPTH0Gaddons NXTToolkit Library VIs Block SupportCoerceValue.vi   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gain^^PH cP P d-` c\P"@P@flg@oRt@eofudfP100*Kalman_gainxdfdPtxdPoldPext P cTP"@P@flg@oRt@eofudf P^P(new)xdfdPtxdPoldPext P cTP"@P@flg@oRt@eofudf P^x(new)xdfdPtxdPoldPext P cVP"@P@flg@oRt@eofudfPResidualxdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPRxdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPuxdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPzxdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPBpdfdPtxdPoldPext P cTP"@P@flg@oRt@eofudf P^x(old)pdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPApdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPQxdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPHpdfdPtxdPoldPext P cTP"@P@flg@oRt@eofudf P^P(old)pdfdPtxdPoldPext P`x`y`y`y`y`y` Max (100) hMin (0) c c @z @H@ Numeric Out @B @^P(old) c c|@H @R @^x(old) @u @A @Q c` c d P``` d dP0( T (pJ 4 X h (^ 'd'd'd'$R08$~ dpx$08 :  dfpx$08   dpx $208 P@$H@ @@@@ >@@@z\XT`dhl@$H@@ >@ >@ >ppppll@*(T(T@@ @ @ @ @@@PVIDS K_step.viVIDSCoerceValue.vi PTH0ti386@code `EwdE\EPPUEd$=|=u ÐYӀ}YELXCT${XP$R4ZXPRZXC$C|CD{HPR4ZX P RZXC{ PRZXCdC,CL}E$EEƅ$ƅƅƅdƅ$ƅƅƅdƅ$QRhP$yd$ZYƅ$hhUEPƅE=,RZ)ʃ(1Ӄ-ƅfx2ƅd0ETE\EP .UR@␐}v}vƅ}$ ƅ$hh UEP8d$ fx6ƅ(RZ(ƅfx:ƅ\(E=,RZ)ʃ(1Ӄ-(ƅfx>Vƅ()ȉƅPRQ YZX}$ ƅhh UEP8d$ fxBƅ RZƅ fxF#ƅP)ȉƅfxJ,ƅ$RZƅfxN1ƅ`E=,RZ)ʃ(1Ӄ-ƅ}$ ƅdhh UEP8d$ fxRƅRZƅfxVƅ TE=,RZ)ʃ(1Ӄ-ƅ fxZ{ƅ$ ȉƅ$}$ ƅhh UEP8d$ fx^W} }P}}+QRPE@$9id$ZY=f= p h搐ÐEw YE\EPPUEd$===u=tEw Ew‰ppVL@'PUEd$=Ðpp @'PUEd$=ÐP@ P VWP P P" P >oP x5P"  P  P  &P  `MP  0P'  P^ P HePT  +P !P "P #0}P $jCP % PS &P '_^ZY[]Ð =,PEP$PP$ $@ $Ðd$.Ul$SQRVWT$ QRPE@$RGgd$ZY=_^ZY[]ÐDž4  @ 4DžhlDžhDžDžDž<Dž@ DžDPTABx80xQRu{d$ZY,Ul$SQRVW}#QRU d$ZY_^ZY[]ÐUl$SQRVWuF FF@FDQRhU옼d$ZY_^ZY[]ÐX uBs@ ! sQG 9[  i / % 7CODE upO`%7.1Oldest compatible LabVIEW.ON NMhpPPP @^P(old)@H@Q@A @^x(old)@B@z@u@R@Residual @^x(new) @^P(new)@100*Kalman_gain"   ٛ11ك1ٛ1,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,,LDTHPDXN88DK~D@A @^x(old)@Q @^P(old)@H@y@z@R@ Numeric Out@x@u@B @100*Kalman_gain @^P(new) @^x(new)@Residual@ Max (100)v x @ Numeric Out @Min (0)@ Max (100) @Numeric @Numeric @Min (0) | $8PdxPxP88PP$$  x00HHddPPdddddddddddddd44444444d [D]^100*Kalman_gainHNacSDj]wj^w^P(new)HԝN}a}c}SD;]H;^H^x(new)H`NNa[NcNTD ] ^ResidualHTNa+cMDkxkxRHN~~MD.[;b.\;buH@NA_NAaNMD[ a\ azHpN_aMD[b\bBHlgM_aSD][j]\j^x(old)H(Np_}pa}MD[c\cAHN_ŋaŊMD;H;HQHNN[N[MD[c\cHHHN _ aSD  ^P(old)HPnMDJJJA, B, H and K are 100 times the real values All values now are integer!!!DѵdѶd%%Bsingle Kalman filter step (25/1/2009) author: Claude Baumann 2009^D) )external influence\D҃҅ influence scalarfDg>ug@uinitialized state estimateXD  state scalar^Dmeasurement scalar`D measurement variancebDWeeWgeprocess noise variancekD&(initial state estimate varianceD,,Mnew state estimate ^ ^- ^- x(k)=x (k)+K(k)*(z(k)-H*x (k))D/1"";new state variance - P(k)=(1-H*K(k))*P (k)\Dmeasurement z(k)D$$?new Kalman gain - - K(k)=H*P (k)/(H*H*P (k)+R)uD** )a priori state variance - P (k)=P(k-1)+QhD24 old estimate variance P(k-1)DHzHy555new a priori estimate ^- ^ x (k)=A*x(k-1)+B*u(k)aD:,d:.dold estimate ^ x(k-1)MD41A:43A9xHDkMDQ9DQ8HDN،؍HDphMHDhM-:-:HDNHD`iM9F9FHDNHD̞NivivHD4NHD iMĈѐĉѐHD@N00HD4mM11HD0N 0 0HDdN MDGCTLGETKyMDyHDNHDNW6dKW8dJMDyHDkMnpHDlkMboboMDR_R_yHDXkMMDp}p}yZDMLCoerceValue.viUD Max (100)HD,kMSD Min (0)HD(eM%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0fFPHP K_step.vi)FPHPDN8C'e)`~ (ːiMNXN-On}#04'XL@)l&%D "$T4 d 40:$2|@P\;D,4h4 F \O8 2 `tOOxp : 0Q]cQ]cQ]cp : Q]bQ]bQ]bL : `f0u0/.-0  \d8hBR 0d?xd|(@PC4i\E,P0|4 Fx i\xTO8 2x |`O 3p :x 0wQ]cwQ]cwQ]cp :x Q]bQ]bQ]bL :x |`f0u0/.-0 x x\d8hxBR ||04@H|@PC:\`Bn,  L |4 FH :\I3 8 2H M`\ҐOOp :H 0HQT]cHQT]cHQT]cp :H TQ`]bTQ`]bTQ`]bL :H M`\f0u0/.-0 H I\`d8 hHBR 0  C  |`@ PC \0 8D,  d @ ,4 F   \O8  2 `,hOOp :  0Q$]cQ$]cQ$]cp :  $Q0]b$Q0]b$Q0]bL :  `,f0u0/.-0  \0d8 h BR 0  A $ |@ P djِ 8DJ,   H `4 F  jy 8 2 }OOxp 6  0xلcxل弼cxل喖cp 2  ِbِ弼bِ喖bL :  }0u0/.-0  yd8h B$R ||0d9xdf |@P4-OSF,P0|4 Fx -ZH|4@PO# , L|4 FH Z b|O8 2H ^OO p 6H 0 O[c O[c O[cp 2H O#[bO#[bO#[bL :H ^d0u0/.-0 H Z#d8hHBR 0=: |@PO8<,d@,4 F Zcxn 8 2 ^̉ Op 6 0O[cO[cO[cp 2 O[bO[bO[bL : ^d0u0/.-0  Zd8hBdtR ||07$|l@P\O6D,4h4 F \ZkxO8 2 o^~ OOp 6 0jOv[cjOv[cjOv[cp 2 vO[bvO[bvO[bL : o^~d0u0/.-0  kZd8hB4DR ||05d |@PTOʐ4b,8pP4 F Zd3 8 2 ^ƌ3 OHp 6 0O[cO[cO[cp 2 O[bO[bO[bL : ^d0u0/.-0  Zʐd8hBR ||0T3h~|@P$:`2,@ l4 Fh :IO8  2h M\3 Opp" 6h 0HTcHT弼cHT喖cp" 2h T`bT`弼bT`喖bL" :h M\00/.-0" h I`d8"hhBR "|"|0" $1 8"|@@"PO x06," !!!"<"l4" F 8 Zd3 8# 2 8  ^XOOp% 6 8 0O[cO[cO[cp% 2 8 O[bO[bO[bL% : 8  ^d0u0/.-0%  8 Zd8%h 8B""R %|%|0%"/#$R%|@%P"Ě#H.D,%#t##$P$% %<4% F#  O8& 2# OOp( 6# 0ٴcٴ弼cٴ喖cp( 2# b弼b喖bL( :# 0u0/.-0( # d8(h#B%t%R (|(|(7( $ d     " 4  4  T    ( );i  1;i  x*Dd;1;i  1;i  1;i,4  4( $OL)< < | L#4) дe OL*)8(4 d4T$" PBDHP K_step.viLVINCoerceValue.viUPTH0oBDHPD`N8z(,uo*~ ; N"d 02 -M"d 02 ,LG"d 02 I*iZ"d 42 jt 43 .j׷t 44/@ndi4\ , 4 34| ,440 %tt~yi4\ 4 @440 &~jtoi4 4 C\ L ,440 'tj~tyoi4 ,44/ 5eUi4 L 4 0 @440 8";uPEzi4 4 * l@440 #EkPuJpi4 L 4 * 440 $;kEu@pi4 44/ P?E_eh4 l < 4 * @440  EUZ`OZh4 l 4 AT @440  (OKZUTPh4 4 + \440  EKOUJPh4 <44/ Nng4 \ 4 ' L440 HTi^g4 4 C\ |440 ^icg4 \ 4 4 L440 T^Yg4 44/`)Ii4|L 4,5L440,/D 9i4| 4,Zb4440,89D>i4 4,'lL440,/94i4L44 jt 45/9Yh58 5'X4450?TIh58 5. ,450ITNh5 5&$(4450\?IDh545 jנt 46/g6\ 6,1d460Hg6 6 @|460g6\ 6>1d460g66/46/t,Li6` 6@,`460@<GAi6 6@ @460@L2<7i6 6@*`460@ 2<7i6`46 +jלt 47/0 ,g7L 7*l470 'g7L 7!\470' !g7 7"h<470p g747 1jפt 48 I{j׬t 49/ \|i9< 9)P\l490bwli9< 9#L490lwqi9 9$,l490`blgi9 49 9+ejרt 0:l :@+,:$ 8P:@:PBS;x!$:T4: J8 30B;jt 8; 28 CR: t tL= :8 DP00/.-0= 38 BS;8=h8B=|=|0=@"h"  4= B׋j O0>@ @p4> B@jdO0?@!\$;aN4? B,;jO0@@#LT84@ Bj3 0A@$lGmZ4A Bl8GjO0B@%зݨʕ4B Bj3 0C@&$4wd4C B4hwj3 0D@$4#4D BjܽO0E@ @ d҇,4E BÇґjO0F@' 4,4F B`1jO0G@'L9+&4G B2jO0H@'H4@!G*4X4H B(!1jO0I@Zb44I BjO4J $PJA4J tZ J\4JN_ J2d-?|?\4J/2z l4J0 3 lJ2d4J"P!J!\  NPN ! ! ZP Z " "J4J#4"J"hJ4J##pJ#LqqJ4J$$<J$\\ZgbbJl 4J%%  pJ$Q''J4J& M,J/J ?J\4J&&XpJ&$DDJ44J/,$<\ l4J'|K 4JFR$J8L`4J( Hl'4J0&5\LWQl J/057hJ -)Dr,\sJ|B\J04J)8(pJ(_[_J4J))\J)PlilJ<l1-@;iH)P1  J0PJ1D4J/;8Uui4J0*P;Sepji4J;I4J++ "pJ*OZJpOfJfJ l L4J+WJ:XJ <JS J,D,d7? J&'H'@ J&80,dJ,dJ74JF|\J24J<@]J0P1D1d-;ib)j1  1;iHSP[  1;ibSj[   J16-a1x;iH>PF  1;iU)]1  4J.Y 4J5d<J48B<4J,KD J:xR\P `J1d4J//1EQe l J/HB/| J//|B6<1dJ-J?| J2288 J .! , J 72J2J24J3IL4J/-0 @iJ\8@JP>l9dI,J4X<D9:J48 J@.\0$484J J7 FBUMjOK=4K J@ jPO4L1(G&L,DL|4L03h/4L&0+iL0P;t L:x,PT1d4L(dG%4L/:8\| l4L012Nl4L01!HMl4L03h*(H0;5i4L03h*8d= L 3490 ,0L 37 U4fM4L0 8Gl,L>9==98L 23  |OO8Nh3B8Nh7B85 N:X;>l=4P J3 jOQ=8,Q4J3\4Q>PV QG4Q?4Q6[t4Q012Ol Q11?1d Q10p?(7Q?\ Q&0@l@QD4Q01?Pl@QP28l7_ALFlLQ :@ hn00/.-8Q 2@ m OO0S 3@ l4S,^! S5LS|8Sh@BA@XS|4S0/H1W6UA`;Zl S/H.\:48 S/H5D,LS1j4S05+blwql4SDQ4S0*P;T[e`i S*P*C4S0*PDU[e`iSC4S0/H;Y6JAU;Ol,S?`F`S:X \ , S@ID`DS|LS :7 W0c600/.-,SFHETEEGT8S 2F ap DOOpLU :F bn00/.-0U 3F `q@UPD``qE(a4U JF Q`jOV7hV,D(VD71o;ib>jF  4V05=Xdlwql V@OMG48VhFBDA\V5;O99OpV4YFZFYV|V'4^&4^4VFXPV34~y~LV*7  7 @h5h 5@p  ` m  mS  SV.NPPV'  4I I    6     64V05:calfl4V05=lealflV%ʕQJJV|,V>fNd@VPM~NXg,VOdNNO4O,V@1d1DUl8V 2N  OOLX :N 00/.-0X 3N ~4X JN o~jO4YOVLYG4Z+J(JPZIhQQ̬Z0p~~@Z Uaab4bdehgghXi(Z.\]@FOF@4Z^4k`Z @嚬Z>@ZPj \{Z|Z|,Zff8j0j|jZ,AZ|Z|Z,,Zb4S@ZPe0allZ^ Z@ee0^ZATH<TPTHZ 4 7   ,,o,4  +      ++ +  2,  ,Zabdbe\4Z J^` j3 [Ufa [UbTa[a[b4 [UZgTb44[3Ub w! [Ufb0[ 3^` 8[ 2^`  3 3]R\4]3UV$y!]b]d ]Ug d]eL] :^` 00/.-,]^z^`h8]h^`B]t]`4]ed8]^hX ]Uhxe4] J\   j3 8^ 2\   O 3`f `@kjf4`3UV8x!4`3Ucu4`3Udt`e4`3Ub v! `Ugg4`3Ugq `g `Ukhf4`3UhDp  `g `Uei^4`3Ug@s   `Uhh4`3Uir  `h`hX `UR\iH`4`3Ui|n  `i(l`<53h*P1@:xU SX  &,/H 4`3Uio  L` :\  00/.-0` 3\  8`h\ B\t\`,`fp|\ l4`kDnD`fgL`Z   |  | 2 > >    '  'l`@l4`(=748DG4^f,`Ef^USX:xG45D&48/H*P713h= (`4H|lL@<$TDt   ,p@t`k`'keZR\AT 0C\O'HI45>1..\*0p.>34, @!\"h#L$$%&$''()P*+, NI.LV.ALL.VILastSavedTarget0DfltNI.LV.ALL.goodSyntaxTargets&@0Dflt( [8  й?  йF  йM йOTahomaTahomaTahoma0 Courier NewRSRC LVINLBVWl L 4 RSIDl 6>D* 7?\! 8? 9@Dɾ :@̼ ;A4@[ AԌ۾ ?B H @BlP3 ABDϾ BC CCP DC@( EC(a FD4 $ GD4v HD̜# IE| JEdľ KE LFþ MFX1 OFa QF- RGD< TGB VG܋ WH0@ YH|0 ZHh [I0 \I0 ^ID _J0U J|־ J,< Jc J% JL J$ JԾ J`Ѿ Jܰ J "J􈅾 %K (K H =K̾ NK$<\ PK0 SK<4 UKHT XKT\ ]K` `Kl Kx< KP uLm u.

P #```x```Pę a@ę @!ę YY?2<2ϟ?|\axyy胀>>胀>胀UUjj)胀> !π̌̌̈̌̈̈̌̈̌   ࠊ` 8  ` 8 d H   o  H8 ?H  H ொ䯊 ?H H  H  Hࠊ H H|   πȠ 0 AǓ  b  b̌Ȉ  ̌b<,<Ȉb,,,,,:,,BbbbbB,̺:̢̂̃̌Baddons NXTToolkit Library VIs Block SupportNXT_InputPort.ctlLVINextract_IR_US_beacon_data.vi x  @!Error@gPs_distance [cm]@gPs_time [1/100th]2@+jSequenceBoolean.ctl!Sequence Flow outV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow inPTH07IR_US_beacon_v2.llbextract_IR_US_beacon_data.viLVIN K_step.viW   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gainPTH0 K_step.viLVIN NXT_Wait.vif x @millisecond timer value2@+jSequenceBoolean.ctl!Sequence Flow out@ Wait (ms)2@+jSequenceBoolean.ctl!Sequence Flow inPTH0;addons NXTToolkit Library VIsWait NXT_Wait.viRRP cP P d-` j Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@j Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@ cTP"@P@flg@oRt@eofudf P!Booleanx!dfdP!txdP!oldP!extb P         @P b P         @P  c#NP"@P@flg@oRt@eofudfPxpdfdPtxdPoldPextb P         @P b P         @P  c NP"@P@flg@oRt@eofudfPPpdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPQpdfdPtxdPoldPextj Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@b P         @P b P         @P  c\P"@P@flg@oRt@eofudfPsensor readingspdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPRpdfdPtxdPoldPext*hNXT_InputPort.ctl Input Port" P@@Z P$@P@0P`y" P@@Vh Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#  Z P$@P@0P((  `A(!` Wait (ms)hB c$ c` c2@+jSequenceBoolean.ctl!Sequence Flow out c@gPs_distance [cm] @!Error@gPs_time [1/100th] @H!2@+jSequenceBoolean.ctl!Sequence Flow in c@millisecond timer value@R @^x(old)@z @^x(new)@B@R2@+jSequenceBoolean.ctl!Sequence Flow in c!2@+jSequenceBoolean.ctl!Sequence Flow out c @R@sensor readings @Q@millisecond timer value! c@millisecond timer value@100*Kalman_gain c<@ Wait (ms)2@+jSequenceBoolean.ctl!Sequence Flow in2@+jSequenceBoolean.ctl!Sequence Flow out c@millisecond timer value c c c c| c c| c c| c\ c dP```B P dn c c c  lL7 `* `$   0 V^ ~Plot 0ffݎّՓѕ͗ɚŜžܧةիЮͰɲŴ߿   !#%(*,.13579<>@BDGIKMPRTVXz[w]s_oakdgfch\j Time AmplitudexGYPlot 0beg Time Amplitudev)uXV @y 6xu@ 6xu@@4@?g@` @`@@` ???_@x)5@)5@@4@?j@@i@I?NPlot 0ffR "$&)+-02469;=@BDFIKMORTVY[]_bdfikmortvy{}ĥƥȥ˥ͥϥѥԥ֥إۥݥߥ Time Amplitude K@QZEh@ZEh@T@4@?@`@`@@`???RB@ B@dZ$ 608"d pxR| 0$     $            @ 6 6   @ @ Z   6   6 @ 0  : `@ 0 `6    6  :@  VIDSconstant_Kalman.viVIDS NXT_Wait.viPTH0VIDS K_step.viPTH0VIDSinit_IR_US_beacon.viPTH0VIDSextract_IR_US_beacon_data.viPTH0fi386ScodeNEwSE\EPPUEd$=9=i ÐYӀ}}E$EEɍt HHƅp ƅp PXPXPXPXPXfx ƅt QR[XZYƅt fx , ƅx s4$ std ETOUE\EP.UR@␐}v}v ƅx fx ƅ| ɍ HHH HHHƅ hhUEPÐzƅ x+> <2ƅ ƅ fx6E PXɍ HHH HHƅ ƅ fx:1 ƅ QRUWXZYƅ fx>= ƅ  s4$ std X Z`T.UR@␐zzƅ }$ ƅhhUEP8d$ fxBƅ 9ȸƅ fxFƅ <5ƅ fxJƅ <ɀ Ȉƅ fxNqƅ <2ƅ ƅ fxVqPXoƅ dhhUEPP@x@P @!Boolean@Q@sensor readings@R99ݽwp1 1`p     ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ DTHPDN88 ~ 0!>.@NXT_InputPort.ctlInput Port DupB2@+jSequenceBoolean.ctl!Sequence Flow out:*@NXT_InputPort.ctl Input PortB2@+jSequenceBoolean.ctl!Sequence Flow in x .@NXT_InputPort.ctlInput Port Dup2@+jSequenceBoolean.ctl!Sequence Flow out*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow in(@millisecond timer value@y\P x  @!Error@gPs_distance [cm]@gPs_time [1/100th]2@+jSequenceBoolean.ctl!Sequence Flow outV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow infV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#$@gPs_time [1/100th]&@gPs_distance [cm] @!Error@z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H @100*Kalman_gain   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gain@ Wait (ms)fVP P@    P@@x@P @!Booleanރ x @millisecond timer value2@+jSequenceBoolean.ctl!Sequence Flow out@ Wait (ms)2@+jSequenceBoolean.ctl!Sequence Flow in @sensor readingslT $$$L$$\Lp\\T0Tx0H\p0TTTtt\\000$$$$pp$Tt4   SDBooleanMDEBRIECRIxPD$((TimeH$ԐN w xU D$WdFu AmplitudeHDNh {i {N0.MD4EAL4FALPPD$  TimeH$NU D$ZgIx AmplitudeHDN]kj]ljN0.MDN[N[QHNanan[D8E'8E'sensor readingsPD$TimeH$PN ( (U D$ޫ  AmplitudeHDNN|~0.MD~~RH$N`D9@F9BFinit_IR_US_beacon.viVDb+o_b-o^ Input PortNDb+o4b-o3 LDYb[aHD N2;4:HDNr3Sr5RLD U^ W]LDiv iv LDRE True LD  HDTNĺļMDyVDa*nia,nh Beacon_ID#HD8NrmvrouHD\Nq ~]q"~\hD-,:-.:extract_IR_US_beacon_data.viHD@N  UD2?2? K_step.viHDDNV&_X&^HDĈNZc\bMDpzryRHDhNXgZfRE True HDNrrMDuuAHDN  HDHNUD^` Wait (ms)HDNHDNHDNabHDNJWLVMDRu_~Rw_}BLDW`Y_HDNbto}bvo|LDIRKQWD NXT_Wait.viHDNirjrHDĽNHDN%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f%.0f   | ~   cc   KK  "FPHPconstant_Kalman.viFPHPD܏N829 `~NNN8N+vrN04XLTdVh||7,  $||81;iT8\@    X p p^D /<wx(0 4g0 C /"D>p^D T@9, ur\|R 4 4g0 k! ,> 0`|X<Odz,0l|  4 G O0{8hBT@R||?|4 F DASJO0 C @U>@ :J!(ff]@ :L!(vvo@ :K!(nngD`00v)u`vuO|0 J& ->4 3,^)O4 2, vO|Oh0 2,( 0 2,- 0 2 $(| 0 2 $-~ 4 3 $^Ve OD O@4XV !hXg O0  ^i 0  U9,>8 hBT  @p  4 6 $g |O0 v4 $OL <l0, $ h 4 F  3DBMO0 k ! >@ : J!ff]0 J & -@ : L!vvo@ : K!nng0 2 ( 0 2 - vD`0 0x" xOtDO@4 GY $Gj Op0 2 (cd 4 3 ^ O4 2  O4 3 ^YhO4 6 \jkȯO0   Ml 0 2 - ~8h BpT4 $ O0y 0  D<> lKKKKlddlKKlddl 7WeffeeeeL  h  8 @<1;i%8-@  @P4MsXF>, |d||4 F M\lB 0  \sd8 2 `o\B O0EZ8hBR p 6 0[gc[gc[gcp 2 gsbgsbgsbL : `o0u0/.-8;iTy\  1;i%y-  1;iT\  1;i8@  p^D3$ @d4g 4 F 7F( 0 k! r>0 C 3H>@ :J! Pdff]0 J&  1|@ :L! &:vvo@ :K! ;Onng0 2( 0 2-KL ?D `00 Ph  O`D!O@4KKOH "4h"|P4" 3^ . 4# 2 )$ 4$ 3T^O4% 6THp 0&  Q 0& 2T( B0' 2T- A8(hBT4( $|DO0)$ 60)  H>L) |0pLT,;iyā  1;i%-  =(XDt@)P} YD ,)L|\D4) F } 0*  d8* 2  B B0,Xd ,, T d48,hBR p, 6 0cccp, 2 bbbL, : 0u0/.-,,4d T Port 1Port 2Port 3Port 4T Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#FBDHPconstant_Kalman.viLVINinit_IR_US_beacon.viPTH0LVCCNXT_InputPort.ctl PTH0LVINextract_IR_US_beacon_data.viPTH0LVIN K_step.vi-PTH0LVIN NXT_Wait.viuPTH0BDHPDN8p9 ,~NRT NNN+72@G 4,,,,p0,菜,,g4,jd, ,P2,T,,(|,`,!BsFHy@g(XT4,/d(h ,dSYV E1 E-22`4E3-4 ?Y`\ E-{1o E-XL2WT4E3-3(@P`X E2 E-q3\3<4E3-3AP`X E3< E-XL334E3-3BP`XE3E4E2`4E3-4 CY`\E445\E^D5|4E0&XJ1e<o6jp4E@'E!-4E@]T]p*4E0&5K'e1o,jp4E@6F!+E6:AE49 EB=|>ԊE| E,5:4E1) Oh EBB 7* E,8A E5|;>E7h0E-7L$ E7H:p< XE,@lz4ABD (E)H4E@7J|!,4E;&p14E Ip$ E,6lAT41@;ie?mG  4E0*OU^fi]c4Ed9D EC< E (|XE0D+?4E@xBK(4E= EBl,`7*4Ed|}`4E0,Ԋ,E8 ~|:\,ED4M< ,Et=$=\;= E@D<;D;0E 3< T(a EB@>>D; E@@97*E|4EIWEWT23 E@D<@A<4E胠@EP;DT(a;pN8E 2< U'` ܍OOLG :< P%V00/.-8GhD>0G-8 6V? HC,G?dVLAHG?D G@D-`>?D8G 2E Yd OO4I do{jOJ^(0J@N T0DǦH JB@:(*@ J@XBpD JB8K@X,J8 >tW$1F(;i  0J@x J;@x4J0,R:B>^4J0,%S2:6^0J 3E XeJ>Bp J@@8 B>Ԋ,JD(gI 4J BT_J7HY@ JBlLKBpJ@:4J@LTLp.0J.8 CT4@: JB=B4 JB@B48J 2I Wh OO L9)C4LdWts0 LCC0C L@@8 5B4Xe?eHM5::=|pH&<9@M D MBlBDT84M@FpH)MDFH`M6l61t1|6|@MP& '_0M 3G  HMFOOG M@@LDT80M 3L 8MhEBNNp4M B?qǀjO@NPAViNDhN|NR@XN<*pN|N&<W&W/w&w?N|N8>]c]z>zpN:(OCCO8NhGB''|0N-@<[! *%4Ndć  NMpQoNAFHNBCC%4N@AU/@NPUtM,l,NMXTU(HO04N JL tjOOD.LO :G  00/.-4O/dN(hOPL4Z ,OmCPPlNOO|O|4Od: bX0O 3I Vi4OdMY8OhLBRRp0O@R 3T,OTTZE|b8OhIBJhI\4Od?~O|ORO|LO :I RX00/.-O| OM{VoOL4OZ ,OPDbR 4O;4u(2O^<^[ OB=Q@V< OQXY4O0MPjh4Od7, OuvR4O dO|O| O@8QR@OPQRc,OHSS$SpSLO :R  00/.-0O 3R 8OhRBPPX8O 2R  OO4Q BOhjxO@RPc(}Oa4R JTD ]jO8S 2TD ~ OO88U 2L  OOLW :L 00/.-,WW@mL WL%LW :E TZ00/.-4W0M+li­hW|W|0W-8 Qn1 :5W\h>:(WWT W@XLUtWT,W,/Z nȬW<@__4WdY\[hpb|CCbXh,b*@>>DV[^\Lb8j),`[l6LBF586l&<%`pb84 455b80b@@>8/'̏h4b B8j4B ,c ;?D'' NI.LV.ALL.VILastSavedTarget0DfltNI.LV.ALL.goodSyntaxTargets&@0Dflt( qX  й_  йf  йm йo йTahomaTahomaTahoma01RSRC LVINLBVW   4 RSIDHLVSR\BDPWpLIviCPTMDSTMDFDSLIdsVICDversDLDRFPTD$CPMp8ICONLicl8`DTHPtTRec?STRGPICC LIfp FPHP CPST 0LIbd XBDHP lVITS HIST FTAB ' 1 l T 3  # # $|% >Ĩ >0& ? ?lH ?t ?h Ch O O PD P Pl Q@l Q Q R4 R" RԸ S0 S| S$ T$d Tp #TЌ $U$ %Up@ &U\3 )V *Vl +V & -W p .Wp /W| 0X  1Xpl 4X\ 5Y(" 6YX 7Y- 8Y\ 9ZPx, :ZD [% A[t* B\4/ C\ E\= F]H(. H]`/ J], K^44 M^; N^@C O_$@ P_x, R_T S`d T`lt$ V`8 Xa4 YaP [a \a( ]b@ _bD `b, ac8L% bc3 ccx d d(? d4 d@* dL$ !dXT/ "dd ,dp 2d| ;d ?d/ DdB Gd@ IdB LdĀ0 Qd Ud. Wd 5 Zdx) ^e e - e e,`) e?=gqQ<<?9$QRRVhh媁d$ZY=6 6ɍHHH HHƅƅfxjƅۅۅݝƅfxqƅ݅݅ݝƅfxxƅ݅ݝƅfxƅ݅ݝƅfx"ƅ݅ۅݝƅfx&ƅ݅ۅݝƅfx*EhxVW_^9 Wƅfx zƅ=ǃ Dž=9>QRP$hh蓩d$ZY=Z=邐Whh$X h$X؉X_ƅ}$ ƅ$ hhUEP8d$ =}$ ƅd hhUEP8d$ =efx} }P}}+QRPE@$\d$ZY=/= p h搐ÐEw E\EPPUEd$===u=tEw Ew‰ppVL@'PUEd$=ÐP^ P,x P }P c Ðx&mp p @'PUEd$=ÐP PK WP P  P$  PQ  3 oP  m 5P   P P _^ZY[]ÐQRu鷔d$ZY,Ul$SQRVW}#QRU(d$ZY_^ZY[]ÐUl$SQRVWuw F F@ FDQRhUd$ZY_^ZY[]ÐX Y  pX69 A I %Q #=GdCODE u %7.1Oldest compatible LabVIEW. .NNNhVVpPPP4 F [j. 0 k! D\>@ :J!HXff]0 J& DVU|@ :L!HXvvo@ :K!HXnng0 2L(# \0 2L- ! DO`40@01  (\DO@4o#o# (X|4 3L^1@@YܥO4 6L"1O4 3^O4 6 . 0  u 0 2(ӏ U0 2-ո [8 hBXT4 $;o 0 $`0  lC>mD;i</D7  =l@pT L  Tl(L $H R M{ !D,  @ 0  | 4 F  M\xO8 r `o$O @P r B4Ys Tp 2  0esbesbesb8h BTh,  8 h  p 6  0YgcYgcYgc0 w \sd8h BTi0 W  Ysó0 s  `w0 U \{d 4 J Q`4 0  `wd@PC `w"Tp : 0_kc_kżc_kŖc8hBR 82 ds @p : kwbkwżbkwŖbL : ds0u0/.-, X8 0 d: BDHPgenerate_way.vi!tBDHPDN8!l !s~ LNNN+<Ø 4,   ,0  )a ;iWl_t  1;i`lht  `;iW_  1;i`h  1;iW_  1;ilt  1;i  xH4T4 4|  `T XmgYnb8L4/(i , T(  4 44  ,\80$\4m}u0 Hx @\ @x @H80&\Xmh}`u,H ,0 @H ,$||| X(40 Ǘђi@P XRie4x  `(, \ $8 2 YShd ĭ. .8hBL : ZNfT00/.-0 3 XRie,D @D @ d4  ,H    8( @H t  `X 4  x(4/ }gXhd0 3 _8N tt4t  h4 $T  4H   @`[`u ,(H4/ j(H  X|(  40 j  84d40 j8 2 *A  .  ,@|40 h j0@DlXXt4,  4/p?_i4 < (,x |t < ,0||h ( < 8(8uu40<`EOJi (40 Ѣܗi4/ЇI0 3 )B`u`40 Ǣќi8hB@P$)BP  $(X40 g4 B{4j8O40<lOZTip40<EOJi  d(< , 8X8L : %+00/.-4//-'40 lg "H t40 4*$'4"` \ɡ  @\8t,H  < 40 g,#@t<  |<  p T40I40 I 4 Ĭ40 H'4 P  p 8$J,, ,5J55~~m!l;i`h  =,\`4/̱v8 ,8 ,l40,$Чܡ840,ܧ8D\,`4 4  l8 @H8 0@Dl ! P4 B  jO  , , \l NI.LV.ALL.VILastSavedTarget0DfltNI.LV.ALL.goodSyntaxTargets&@0Dflt( qX  й_  йf  йm йo йTahomaTahomaTahoma01RSRC LVINLBVWS, S 4RSIDvώ?yy>c<qg?<<8¸x?{g8|w?~{xy<~O8 G??~ G;p3=yyǎysx;#axϟ8N<{vysx='|<{<1|='|>vώ?x;?#c`g`1LDD3DD@1LDD3DD@1LDD3@3LDD?3DD@3LDD?3DD@31LDD?3DD@3LDD?3DD@D3LDD?3DDD31LDD?3@11LDD3?O8O8O8O8O8O8 GħOy>x>='xxO|||yxO|gxyyyxygxy||gxyyxyxyxyxyyyӟ||yyx'yq Z'??胀>胀胀>胀>^QuP?>胀> ! U!9À|/"9菀?A""釀πAQ'9ʀ̌̌̌̈̈Ȍ̌̌̈Ȍ̌̌   ࠊ` 8 ` 8 d H   ` 8 d H L ` 8H   ` 8?䠊    ?  H䯊 ?H H  H  䠊 H? H     8  8  8 H     8H O   䠊ࠊ < (  ̌  b  b̌Ȉ  ̌b<,<Ȉb,,,,,:,,BbbbbB,̺:̢̂̃̌Baddons NXTToolkit Library VIs Block SupportNXT_InputPort.ctlLVINextract_IR_US_beacon_data.vi x  @!Error@gPs_distance [cm]@gPs_time [1/100th]2@+jSequenceBoolean.ctl!Sequence Flow outV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow inPTH07IR_US_beacon_v2.llbextract_IR_US_beacon_data.viLVIN K_step.viW   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gainPTH0 K_step.viLVINNXT_SyncUnlimited.vi x 0@NXT_OutputPort.ctlRight Motor dup0@NXT_OutputPort.ctlLeft Motor dup2@+jSequenceBoolean.ctl!Sequence Flow out@ Steering (0)@!Direction (T: Fwd)@ Power (75)6@NXT_OutputPort.ctlRight Motor (Port B)4@NXT_OutputPort.ctlLeft Motor (Port C)2@+jSequenceBoolean.ctl!Sequence Flow inPTH0Daddons NXTToolkit Library VIsMoveNXT_SyncUnlimited.viLVCCNXT_OutputPort.ctlNXT_OutputPort.ctl@ Output PortPTH0Kaddons NXTToolkit Library VIs Block SupportNXT_OutputPort.ctlLVINNXT_SyncStop.vi x  0@NXT_OutputPort.ctlRight Motor dup0@NXT_OutputPort.ctlLeft Motor dup2@+jSequenceBoolean.ctl!Sequence Flow out>@ŲKNXT_Motor.BreakNextAction.ctlNext Action (Brake)6@NXT_OutputPort.ctlRight Motor (Port B)4@NXT_OutputPort.ctlLeft Motor (Port C)2@+jSequenceBoolean.ctl!Sequence Flow inPTH0?addons NXTToolkit Library VIsMoveNXT_SyncStop.viLVIN NXT_Wait.vif x @millisecond timer value2@+jSequenceBoolean.ctl!Sequence Flow out@ Wait (ms)2@+jSequenceBoolean.ctl!Sequence Flow inPTH0;addons NXTToolkit Library VIsWait NXT_Wait.viLVINNXT_DeleteFile.vi x  .@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow out.@NXT_FileStatusCodes.ctlError in@0Filename2@+jSequenceBoolean.ctl!Sequence Flow inPTH0Haddons NXTToolkit Library VIs File AccessNXT_DeleteFile.viLVINNXT_EasyWriteFile.vi x  .@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow out @Number@0Text$@NXT_FileType.ctlType.@NXT_FileStatusCodes.ctlError in@File Size (256)@0Filename2@+jSequenceBoolean.ctl!Sequence Flow inPTH0Kaddons NXTToolkit Library VIs File AccessNXT_EasyWriteFile.viLVCCNXT_FileType.ctlNXT_FileType.ctl @TypePTH0Gaddons NXTToolkit Library VIs File AccessNXT_FileType.ctlLVINNXT_EasyCloseFile.vi x  .@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow out.@NXT_FileStatusCodes.ctlError in@0Filename2@+jSequenceBoolean.ctl!Sequence Flow inPTH0Kaddons NXTToolkit Library VIs File AccessNXT_EasyCloseFile.vi^^P cP P d-` j Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@j Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@ cRP"@P@flg@oRt@eofudf P!Errorx!dfdP!txdP!oldP!extb P         @P b P         @P  c#NP"@P@flg@oRt@eofudfPxpdfdPtxdPoldPextb P         @P b P         @P  c NP"@P@flg@oRt@eofudfPPpdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPQpdfdPtxdPoldPextj Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@b P         @P b P         @P  cNP"@P@flg@oRt@eofudfPzpdfdPtxdPoldPext P cNP"@P@flg@oRt@eofudfPRpdfdPtxdPoldPextj Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPb P         @P b P         @P P"@P@flg@oRt@eofudfP@ Planned wayx@dfdP@txdP@oldP@extb P         @P b P         @P  c PP"@P@flg@oRt@eofudfPWayxdfdPtxdPoldPextj Pp@fP0@PP!!!!l@bP0   !!!$@P0!!!B@8PPVP P@000 P@*hNXT_InputPort.ctl Input Port" P@@Z P$@P@0P`y" P@@Vh Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID# Z P$@P@0P(`starting point$`Initial state variance estimate `A` Wait (ms)hB`y 0" P@@4`NXT_OutputPort.ctlLeft Motor (Port C)" P@@6hNXT_OutputPort.ctlRight Motor (Port B)" P@@6hNXT_OutputPort.ctlRight Motor (Port B)( `0Filename" P@@$hNXT_FileType.ctlType`y c c$ c` c$>@ŲKNXT_Motor.BreakNextAction.ctlNext Action (Brake)2@+jSequenceBoolean.ctl!Sequence Flow out c@ Wait (ms)@starting point!2@+jSequenceBoolean.ctl!Sequence Flow out c@millisecond timer value2@+jSequenceBoolean.ctl!Sequence Flow out2@+jSequenceBoolean.ctl!Sequence Flow in c@0Filename@ Steering (0).@NXT_FileStatusCodes.ctlError in c@0Filename2@+jSequenceBoolean.ctl!Sequence Flow out2@+jSequenceBoolean.ctl!Sequence Flow out c @z @Q.@NXT_FileStatusCodes.ctlError in c@millisecond timer value.@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow in4@NXT_OutputPort.ctlLeft Motor (Port C)@millisecond timer value@starting point! c2@+jSequenceBoolean.ctl!Sequence Flow out c.@NXT_FileStatusCodes.ctl Error out c..@NXT_FileStatusCodes.ctlError in c @Number$@NXT_FileType.ctlType c@B @H@100*Kalman_gain @^x(new)2@+jSequenceBoolean.ctl!Sequence Flow out! c@z@File Size (256) c0 c0@millisecond timer value@@ Planned way @R@R2@+jSequenceBoolean.ctl!Sequence Flow in! c @!Error@R2@+jSequenceBoolean.ctl!Sequence Flow out c@gPs_time [1/100th].@NXT_FileStatusCodes.ctl Error out c@gPs_distance [cm] c$@Initial state variance estimate@starting point! c c| c c| c c| c c| c c c c| c c| c c| c c| c c dP```V P d c c c c%:Y,N  ` D^~Plot 0xwu Time AmplitudeG}Plot 0_c_e_g Time Amplitudey)uXV @+C7@C7@@@4@?g@W@Y@W@??_@+]aC@]aC@|@9@?@@i@I?NPlot 0ee "$&)+-02469;=?BDFIKMORTVY[]_bdfikmortvx{}^^^^^^^^^^^^^^^^^^^^^^^^zzzzzzzzzzzzzzzzzzz Time Amplitude(W @,0]e@0]e@@@4@?@W@Z@W@??^Plot 0<<}zwurpnlkjiiiiijklnpruwz}    "$% Time Amplitudef3/f3S@N@4@?'@y@i@I?Z@f^5@m^5@f@4@?w@$@4@$@??ZPlot 0==wy{|~ZZZZZZZZZZZZZZZZZZ Time AmplitudemSauB@ B@d<;data.txt 6) w) X d$ 408 `)d px d px  d rpx )|R|0h$' , + / 3 i< jr rz l \$ H, 2>( @F Dj X ;D l CX ?J@ d x | G^ W ` H~ rz  t t L < @ 8 x , X l | H~ @ >@  A H, X 7@ l x | H~ P X x@  | H~ nv ~ rz Dj Kd    @   H~@ v (   d@ v d x  X  X x ( @ &:VIDS1D_navigation_NXT.vi VIDS NXT_Wait.vi $PTH0VIDSNXT_SyncUnlimited.vi PTH0VIDSNXT_SyncStop.vi (PTH0VIDSNXT_EasyWriteFile.vi PTH0VIDSNXT_EasyCloseFile.vi ,PTH0VIDSNXT_DeleteFile.vi PTH0VIDS K_step.vi PTH0VIDSinit_IR_US_beacon.vi PTH0VIDSextract_IR_US_beacon_data.vi PTH0,`=*i386* code@- L,Ew E\EPPUEd$=9=sÐYӀ}}E$EEɍHHH HHƅƅP+ XP+ x XP/ D XP/ | XP3 @ XPj H XQRPX $r M:gd$ZY=QRPL $r %:gd$ZY=fx_ƅQReZYl ƅfx kƅ ss\stpET E\EP .UR@␐}v}vƅfxƅ s4$ET E\EP .UR@␐}v}vƅfxƅɍHHH HHHHH H$H(ƅ hhUEP{ ƅ,H G 9ȸ ƅ,P XfxBd ƅ0d t    P *  .UR@␐  nƅ0}$ ƅhhUEP8d$ }$ ƅhhUEP8d$ fxF QRP $hhPEP$od$ZY=Ð Gƅ4xGg sL stD .UR@␐  ƅ4fxJ ƅ8$ s,| P  $ .UR@␐  ƅ8fxN QRP $hhPEP$Ind$ZY=Ð}vxO P RD ZXP R@ ZX lƅfxx ƅ( s< sl< ETW E\EP( .UR@␐}v}vƅfx ƅ, sl s4 s\ P ET E\EP, .UR@␐}v}vƅfx } }P}}+QRPE@$ad$ZY=h= p h搐ÐEw E\EPPUEd$===u=tEw Ew‰ppVL@'PUEd$=ÐPƾ% P־? 2Y } 2s c 2t I 2 / Ðx&p p @'PUEd$=ÐP] PpF WP7  P  Ph  P . oP  h 5P ! PM" P#  P$P M 2  20 U26  2B8 e 2Cr + e2D 2E &2F } 2GZ C 2Hp 2I 2M  2N B [ m 2O !| ! 2S###  2V$$$ J 2P!!"" * s 2 2""d 9 2% $2+P 22,  L Q 4.P  / P Pl  4 iP P n /P _^ZY[]Ð =,PEP$PP# $ $@ $Ðd$ =,PEP$PP` $ $@ $Ðd$ =/P $PP $ $@ $Ðd$ =/P $PP $ $@ $Ðd$ =/P $PP $ $@ $Ðd$ =/P $PP` $ $@ $Ðd$$ =/P $PP $$ $@ $Ðd$( =,PEP$PP $( $@ $Ðd$, =,PEP$PP $, $@ $Ðd$.Ul$SQRVWT$ QRPE@$RYd$ZY=_^ZY[]ÐƅDžfDžfDžQRhh|Ud$ ZY=ƅDž@fDžFfDžDQRhh0Ud$ ZY=:=/=$ƅ-Dž4fDž:fDž8QRhh$U@d$ ZY===ƅmDžfDžfDžQRhhUd$ ZY=Džt  @ tDž \ DžDžX DžDž@Dž|DžDžPTAB xp Dž  @ Dž( \Dž`\ dDžhDžDžDžPTAB  Džt  @ tDž( Dž Dž Dž DžDžDž@Dž|DžDžPTAB xp Dž   @ Dž Dž( Dž0@ <Dž@ DDžHDžPDžX@r \Dž` dDžhDž Dž"DžPTAB DžT   @ T l Džp Džx | Dž Dž D Dž Dž @ Dž < Dž ; Dž Dž Dž Dž Dž\ Dž` Džd PTAB X P Dž  @ Dž Dž A  Dž Dž @@ $ Dž( 8 , Dž0 ` 4 Dž8 W < Dž@ DžH @Dž Dž Dž PTAB DžT $ $ @ T Dž H Dž 4 Dž A Dž Dž\ Dž` Džd PTAB X P Dž ( ( @ Dž Dž 2  Dž Dž i 4 Dž8 Dž@ @H D DžH Dž Dž Dž PTAB DžT , , @ T Džp Dž Dž L Dž 2 Dž Dž\ Dž` Džd PTAB X P QRumzd$ZY,Ul$SQRVW}#QRU謖d$ZY:_^ZY[]ÐQRhh|U7d$ ZYQRhh0Ud$ ZYQRhh$Ud$ ZYQRhhU︂d$ ZYUl$SQRVWQRU]d$ZYy_^ZY[]ÐUl$SQRVWt$ hƺQRh|RVUd$ZYhUl$SQRVWt$ lƺQRh0RVU蹸d$ZYl}Ul$SQRVWt$ pƺQRh$RVUxd$ZYp.@NXT_InputPort.ctlInput Port DupB2@+jSequenceBoolean.ctl!Sequence Flow out:*@NXT_InputPort.ctl Input PortB2@+jSequenceBoolean.ctl!Sequence Flow in x .@NXT_InputPort.ctlInput Port Dup2@+jSequenceBoolean.ctl!Sequence Flow out*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow in(@millisecond timer value@y\P x  @!Error@gPs_distance [cm]@gPs_time [1/100th]2@+jSequenceBoolean.ctl!Sequence Flow outV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#*@NXT_InputPort.ctl Input Port2@+jSequenceBoolean.ctl!Sequence Flow infV@ Master (#0)Slave#1Slave#2Slave#3Slave#4Slave#5Slave#6Slave#7 Beacon_ID#$@gPs_time [1/100th]&@gPs_distance [cm] @!Error0$@Initial state variance estimate @starting point@z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H @100*Kalman_gain   @z@Q@R@Residual @^x(old) @^x(new) @^P(old) @^P(new)@u@A@B@H@100*Kalman_gain@ Wait (ms)fVP P@    P@@y@x@Pރ x @millisecond timer value2@+jSequenceBoolean.ctl!Sequence Flow out@ Wait (ms)2@+jSequenceBoolean.ctl!Sequence Flow in*@@ Planned way<0@NXT_OutputPort.ctlRight Motor dup<0@NXT_OutputPort.ctlLeft Motor dup"@ Steering (0)$@!Direction (T: Fwd)@ Power (75)F6@NXT_OutputPort.ctlRight Motor (Port B)@4@NXT_OutputPort.ctlLeft Motor (Port C) x 0@NXT_OutputPort.ctlRight Motor dup0@NXT_OutputPort.ctlLeft Motor dup2@+jSequenceBoolean.ctl!Sequence Flow out@ Steering (0)@!Direction (T: Fwd)@ Power (75)6@NXT_OutputPort.ctlRight Motor (Port B)4@NXT_OutputPort.ctlLeft Motor (Port C)2@+jSequenceBoolean.ctl!Sequence Flow inN>@ŲKNXT_Motor.BreakNextAction.ctlNext Action (Brake) x  0@NXT_OutputPort.ctlRight Motor dup0@NXT_OutputPort.ctlLeft Motor dup2@+jSequenceBoolean.ctl!Sequence Flow out>@ŲKNXT_Motor.BreakNextAction.ctlNext Action (Brake)6@NXT_OutputPort.ctlRight Motor (Port B)4@NXT_OutputPort.ctlLeft Motor (Port C)2@+jSequenceBoolean.ctl!Sequence Flow in@Way>.@NXT_FileStatusCodes.ctl Error out>.@NXT_FileStatusCodes.ctlError in"@0Filename x  .@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow out.@NXT_FileStatusCodes.ctlError in@0Filename2@+jSequenceBoolean.ctl!Sequence Flow in @Number@0Text0$@NXT_FileType.ctlType @File Size (256)\P x  .@NXT_FileStatusCodes.ctl Error out2@+jSequenceBoolean.ctl!Sequence Flow out @Number@0Text$@NXT_FileType.ctlType.@NXT_FileStatusCodes.ctlError in@File Size (256)@0Filename2@+jSequenceBoolean.ctl!Sequence Flow in0lT $$$L$$\Lp\\T0Tx8Ph0TTT000DXXllxx$$$$$T \ \ \DD T  @ \    \ \ \ T \ \T  DDxxT$T@Xt tt0D0D0000000T$D QDErrorMDEBRIECRIxPD$((TimeH$N w xU D$WdFu AmplitudeHDēNzh{zi{N0.MD4iAp4jApPPD$TimeH$p^D D9, tur\|Rb @4g0 k|! ,> p|T<O z,(P| L| 4 GP. 0<{P8hPBT@R||>|4 F| DASJ, 0 K| @U>@ :|J!(ff]@ :|L!(vvo@ :|K!(nngD`0|0y)uyuO|0 J|& ->4 3^) eB 4 2 v |LT0 2( h0 2- n0 2(| T0 2-~ g4 3^Ve֩ D O@4|XV !fXg O0 | ^i 0 | U9,>8 h|BT  , 4 6yg| 0 v|4 $|@OL (h@ $ T 4 F 3hBqDe 0 k!  z>@ :J!Xlff]0 J&  @ :L!.Bvvo@ :K!CWnng0 2 t( U0 2 t- SD`00 ODO@4G} $G}O0 2 (`a 4 ; t^| 4 2 t. 4 ; ^Yl{H 4 6 Y}h 0  M  0 2 - 8hB,T4 $O0y0  D` > PlKKKKlddlKKlddl 7PWeffeeeeL L $ d t \@PN9tzF<,$(X|q4 F ND]O` 0  ]Dtzd8 2 aHpvT O@0EX8hBR p 6 0\9hEc\9hEc\9hEcp 2 h9tEbh9tEbh9tEbL : aHpN0u0/.-|p^DxC+ؒ$D4g 4 Fh CR. 0 kh! +i>0 Kh ?T>@ :hJ!G'[ff]0 Jh& ,=|@ :hL!'1vvo@ :hK!2'Fnng0 2(  o0 2-B C D `0h0(PfOD!O@4hW xW O "H"|v4" 3^x(`O4# 2  4$ 34^ 4% 64s  0& h ] 0& 24(z { 0' 24-  8(hhBT4( $h|ХO0)h$ 40) h T+>L) \P,4| @)P,~9zdYD ,)t\4) F$ ~DN 0* $ Dzd8* 2$ HvXB O0,X$d 8,h$BR p, 6$ 09Ec9Ec9Ecp, 2$ 9Eb9Eb9EbL, :$ HN0u0/.-0, K' ;P>,|,|p,^u!\?@  !40, k! > ,X|,| , !(L, X< L 4, F ?NO0- K ;P@>@- :J!ff]@- :L!vvo@- :K!nng4- ;^dO4. 6  0/ J& @D/O`40/ V/ .|00 2( 01 2- 02 2 L( 03 2 L- D44 ; L^epOD5O@4S SO06  Y) 06  P@>86hBT46 6 Lxe 07ؙd 47 $ . 1"D,= );|*8 '1';iT8\@  48 F'  ?ZNs 09 k' ! R>@9 :' J!ff]09 J' & |9|@9 :' L!`tvvo@9 :' K!unng09 2$(0: 2$-D;`4' 0m$H m eh <##$%D 6$g. 4? ;$h^eP_y 4@ 6$hxapB 0A '  Yv 0A 2$h(pu0B 2$h-ru8Ch' B#TT4C $'   0D$' d r0D ' PR>pD^D&?R'| ,&x4gLD "<"#$#d"p"$$h%&&@]);i%8-@  1;iTy\  1;i%y-  1;iT\  1;i8@  1;iyā  1;i%-   )D0DdD D@{ D@DD , D@0D%@B'R7J/DD1,G?g_ xY4D3LWW__[[D4D0hD4Dd]D4D &K8?G \O@E l\L P < H El4E3_Wg_c[El EE\ E(4E38GWO_K[ E| 4E3OWW_S[ E4E3WOgW_SE E E ElL4E3 WGgO_KEL E4E3 4 GGWOOK4E3 <GOWWOSE E p P4E3 _?gGcCE P E 4E3 W?_G[C E E <E EԺ hP4E3 G?OGKC E H,ErD4,ED  E  E@D  E \ 4E3 O?WGSC 4E N J\,kb P 8Fh B  SF|F|PFW Jk3|b t,F  p 4F J $ \,k7jO@G 2 $O lV{a@Gd$ k3|b TH?G $0G 3 $ k3|b8Gh $B G|G|G54GHG  <4Gddel4G BC apdjn 8Hj $ }3> .8B4[,Z[L8 [Ԁ*p+H [@@,*p+h4[0)dPUTf^]Y[-TD[1d,,h@` D P 4[^p [+H- ,H4[ &K+1@ OP\,H,-T.X..x./H/1<001\12,3< \+8-q\.X4\3+&4@GC \+K-tBl4\3++6@PH4\3+)5@PH4\3+- 7@PH \+/,H\.\.x \+-.X \+Ѐ.+h4\3+.D9GMJ \+K0.\.\/H4\3+.08@GC \+C/h)$4\3+/;MSP \+N/2,4\3+/<MSP\/4\3+.:GMJ4\3+0l=SYV \1< \+004\3+0>SYV \0 \+104\3+2?Y`\ \+px08VL \+T1|T84\3+1@P`X \1\ \+h114\3+2AP`X \1 \+T2L2,4\3+2BP`X\2,\3<\04\3+2CY`\\3\3|3\ZxN|\9 \+23< \%p433\ \%p44$\34\0%p0I'o<z1tp \%p+4:\ \B<07<<44\0%pDJ1e<o6jp4\,&XC!O4\,YYK4\0%p3K'e1o,jp4\,5DD!M\5`9H?\3\7 \B<0p=${\| \*4X93\\/'LT \B@ 6H) \*7? \4:<=\50\-6xL$ \58:\X\,,}Pz~>@B \'4\,6, !N4\9h%TvDS4\ Gr1 \*4?@3\\<4\0)dOU^fi]c4\d8@B\At:\\'0T4\>@|HV\<0 \BX+6H)4\dpq|4\0*8x=${,\6r(8w #,\D3(M;4 +,\t;t;: ; \@D;990\ 3;4 T(a \B><`<:< \@@8 6H)\|4\G8X\T81\2, \@D:?:4\u|u@\P9T(a9N8\ 2;4 U'` OOL^ :;4 P%V00/.-8^h;4B:|50^9h|4^>~X0^-66Z ^>,^D=dC / ^@@6I<=0^-65(V? HC,^=S0?tF\^= ^@D,<=8^ 2C q 1 P O`ZX'p0`@K .̭F `B>8x(`>t@\Bl `B7pH>t,`6~D~`9h>4`0*R:B>^4`0*$S2:6^0` 3C p2`=@\ `@@6@=${,`D'gF 34` @@[0`5U `BXIH@\`>89H4`,I@I\P0`.6AT4@: `B<0@3\ `B>@3\8` 2F " h O b8 (lAt0bE cskb@AA b@@64X@3\jP @dP?jK0hd|dO|>td:)$d% W&W/w&w?d|pd8xOCCO8dhETB&D&00d->X[! *%4ddxy % dJN+hd?D8Hd@CC%4d,?RQ@dPRXxJl,dJDQR F,L4d JI ixjOeBl-TLe :ET  00/.-4e/dKcƒheMI VL,efAXS:\4n BT]|ljd. o@@6WS:\oXHXhX oB@ U)0o-Vp1!:*5%\oK%H oBXWU) oJ(VlVL4o0JMkisnhoUV,ZXoV o@pD]DVLo :Q( t00/.-4o,0?o8oLl4o,WZRoUDV, o@@6+Z:\0o-6UdoCLG oB<0X oB>XXoXhT4o>XXW o@@64XpoX5GG5o|o^o3|Xجo4GYGG6Y6jG o@@LU) oB<0N,Z:\0o-6N`q$o83WHoW5%5 oB>Z:\o+X ,X,jpo@ 5% 5 oB\0o-_蜩"+& oBX\4od]p)8ohQ(BSS,oV`Q( ?Jo؅o8o(@^|6F:^o=+h o@ha^o`o^_|o_, oax^8o`_4o'@_}s^8o^1 o@@^8,o`fLgPb4f o@@_,o\h\ od_,o_4o/,^HoI o`@caD`4o Ja Qt`jO4p,|:4p0`@4pdb(@pPa`rq_,pY|a CXpc c`c@0p 3a `rq0p-b~!*%p`c`ppax:%33 pBcbd_ p@@axbd_ pBXcbd_4p,bxBpp4p dd20p-d pBcd_ pBXd_ p@@dd_pdHdhdpdHc p`dppc% pd 4p BF jjO8q 2a asp~ 8O .hP8shaBYhM4s ,!TjפO0t-g tTtDLt :a bnnt00/.-ti`t.>*4td4td_`i4t/di&F Onti`tti`4t0hh,A6n th{ i,i`thhxXhtN,533Dt1dk(jn( $ PЍ4t &Kj_nH @u O k|kllmmmnToo$ouO ujl$k|4u3jkh ($ ujkk4u3jlv ~(z$4u3jlX~ ($uk|4u3jln v(r$ul ujmluluk uj8lll ujmwp{wN:PP""",wF ,HtvLwH C% C 4: Cs  ;s  ;3 43   ; 4w {|P30w-z094 w{`{@{4wd{|4wdg!+ wBX}zu@ wBzXzu@ w@@zzu@w{`Bwu { w@@6}wp{w\h<`,~`/'~4w B~`j x~`:<8Xh[,x~`9H:]c]u>u4{,X<;4{0tt|,{L\w4{ JT (7j ,|ԁT G^ |@@܃(\4|d|KJJ:4| (5 |h$\|| |t|8|\|8| l||8,|X, Kd |@XЋ܌|||||1DtD|1d,l и |4| &K]l O@} ؍ԏ X(} }(4}3l }4}3t|x4}3\|}4}3ltp} }}} }xp }@ 4}3tl|t} }}4}3ؤ| }4}3Dl|t} }|x84}3䨄4}3|4}3| } }(H4}3|t|x }( }4}3Lltp }X }4}XX! }@}d$\\Cms`"- }Г,,84 dej,O4'@s& ,)&^8&t( @@x  @Ȯ4 tX,DL jr,<` @Dx`8 2 ['f  y y@PZ(g 0 3 Z(g|L : V%\00/.-|`8hB( 4,cX0G D4誜x` 4dĭH @@ܬH   ,u   uk ]] @ȷ @80?HL%d4 [cjjre ,zXc@ 7p\%   %1;i*?2G  4 J Zejke 0@X&Hװ4 Bj  H4,|F4/,gT HH H hHH40Hg H䲰H40Hg040Hg4,,DHPH @X |H|,XP nv|\{{8 2P { @ @P|z,ԴT0 3P zHL :P v|00/.-8hPBh,P4t40tPdtl @P4,L= $1|;i\?dG  4 JP zj\ 0?0?4/dMum^ |L |pxVL40|Sh]40|S{h]4d0!#0-W X4@T! 1;i*2   d40 )914 &K O40tdtl콨4hT! D1DH , P@ D0͌ͬϤѼҸ Ȼ4 &KF O4QHpDzz P HD1,Ȼ  @ 𹸽04hLȴ 8hB<(͌4  2  xO @t B8pAr$p2r2434343  00434 43 ِ 43J KCK&J&43P 4D1\Ff$ pP 434 Ljh T<4 &KT7F] O@ <8Pp@ŨHx TÌ43T7^f$b TX843T<NV$R 43TV^$Z 43TFN$J P T 8 TP TĐp43TFVNp T43T(Vf^ T`@43TŔF VN@ TŨ43T4^f b43TV f^43TdV^ Z H TˀƘx43TNV R x T43TǼFN J Ũ T0H h434,0Aͬ43( W\85O|Uc dHB{`\hd̜>t1&&,,x\lZZ,+H.xI XLx:\F BlZXc@d{؉ীlX4 i-jn L$6HBT8J+@lXX8V,TdhD8{@\,HLX@\c`T\(L)$*+h'P)_|_uu@hإ(||ltHHf`@T6*)d%pȬW< ߬AA40@9IA40T)91 ؉14;iCrKz  ܨx0~Z~(d[xxvdv]t]4/dtii T|8 TXx840Ty~i Tpx840ToytiL @J|Th+Ќj40TӍoyti@PZgL,Hx8 2 [f xB O8h BL :  V\00/.-0 3 Zg @x4 J  \gjtOx,x 4d4 Vj n 4d$尐X`t4dX!.|~o\H,T`:=9 @pxr ppr1;iC?KG  4 J jzB =;i\d   }4 44 ddj. 4 dJYjy ,x((ee(,M1<8?;;?4 d}jpOsJSCS7s7pAp{ J/66%J%$ :%3 311L  J K S KS  x   x Z Z   Z(ne&fe&f&n8hbssTXX:px  Vs  s( V:  X X( l  l t ] :  (#x|pxx$8((\{ KzHpDhdaxNLTCK8 8d')D*4+H'pAtT8>LT^`^Vqtu vH xˀ  R  w ,A,AR,    &  &{  {Lh ?G  ?Q  Q      NI.LV.ALL.VILastSavedTarget0DfltNI.LV.ALL.goodSyntaxTargets&@0Dflt( qX  й_  йf  йm йo йTahomaTahomaTahoma01RSRC LVINLBVWސ p 4RSIDHLVSR\BDPWpLIviCPTMDSTMDFDSLIdsVICDversDLDRFPTD$CPMp8ICONLicl8`DTHPtTRecsSTRG PICCLIfpFPHPCPSTLIbd4BDHPHVITS\HISTpFTABԖlؿ e0$-ȥ?`{Ann0nP0nrn|oL@RsPphh\r@ \ ulXtdT}L~wHT#<|$%\u&8;)~*m+,-x./((j5t7X849p<>İ? P@dAXpD E`FxnG HtIhL еMlNܑO PdQdS$TTHUrXhYH|Z\`Y]\,_Ďac@d̕ehf88hniФj,xlxvn o$ppqXr4tu@v<wxy S{l|l} X~pRԼ~ (lox$Xpi`p\ lv,xD4$}pԁ ~p lvܔ(r|Th$,xhtԐ td,nԟT `lpxUP!@X"i,T0`6<`= JxRV0[o^ Q` b,(:g8ykDmPs\(zhftlh4Z\c؄b P k(x8H X'hW(x12`34:u;ԙB\CX0K WLHh݈ݨݼDoHqĠ1D_navigation_NXT.vi99ݽwp1 1`p     adirLVINŢ6vš K_step.viLVINŢXš1D_navigation_NXT.viLVINŢF0 constant_Kalman.viLVINŢUŢHgenerate_way.viRSRC LVARLBVW\ < 40 ADir|PLM2CPSTICONicl4Xicl8STR#CONPHCPTM\CPRFXlz(Auh4A,f@DZ԰ FP<L   X $L(ow8ԙ*BLd (Tn Ѕ A 8<,w$DDo:B8d{