Extented kalman filter implementation
1 Ansicht (letzte 30 Tage)
Ältere Kommentare anzeigen
Hi! I would like to implement the EKF of this system in matlab
the state variable are north and east coordinates, module of velocity, angle with north axis. I tried to write f and F functions. Is this implementation correct? I'm not sure about xnew(3) and xnew(4). I attached the whole code behind. Then..how can I assess the filter performance from a graph? Thanks!
function xnew = f(dT, xold)
xnew = [ xold(1) + dT*xold(3)*cos(xold(4));
xold(2) + dT*xold(3)*sin(xold(4));
xold(3);
atan2(xold(2) + dT*xold(3)*sin(xold(4)), xold(1) + dT*xold(3)*cos(xold(4)));];
end
function jacobian = F(dT, xold)
jacobian = [ 1 0 dT*cos(xold(4)) -dT*xold(3)*sin(xold(4));
0 1 dT*sin(xold(4)) dT*xold(3)*cos(xold(4));
0 0 1 0;
0 0 0 1 ];
end
0 Kommentare
Antworten (0)
Siehe auch
Kategorien
Mehr zu Directed Graphs finden Sie in Help Center und File Exchange
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!