- #1
shtuceron
- 3
- 0
Hello all.
I have some problem with realisation Kalman filtering in INS/GPS integration system.
I use equation from "Strapdown Inertial Navigaation" chapter 12. and trying programming Kalman filtering (discret), but have some trouble, estimate error have very small value on graphic, but error graphic have best result, why is it?
for example:
(if i zoom it is really good)Kalman filtering algorithm:
S = F*P*transpose(F) + G*Q*transpose(G);
K = S*transpose(H)*(H*S*transpose(H) + R)^-1;
Pout = (eye(15,15) - K*H)*S;
EXout = F*EX + K*(Z - H*F*EX);
I have some problem with realisation Kalman filtering in INS/GPS integration system.
I use equation from "Strapdown Inertial Navigaation" chapter 12. and trying programming Kalman filtering (discret), but have some trouble, estimate error have very small value on graphic, but error graphic have best result, why is it?
for example:
S = F*P*transpose(F) + G*Q*transpose(G);
K = S*transpose(H)*(H*S*transpose(H) + R)^-1;
Pout = (eye(15,15) - K*H)*S;
EXout = F*EX + K*(Z - H*F*EX);