Newer
Older
abgabensammlungSS15 / mr / ub9 / loc_jp / ukf_prediction.m
@Jan-Peter Hohloch Jan-Peter Hohloch on 27 Jun 2015 367 bytes MR: begin 1st exercise - not fully working yet
function [ newmean, newcov ] = ukf_prediction( mean, cov, u, R, motion)
%UKF_PREDICTION Computes the UKF prediction step

% YOUR CODE STARTS HERE:
[S w]=ukf_sigma_points(mean,cov,1/3);
n=size(w,1);
Snew=zeros(size(S));

for i=1:n
    [Snew(:,i), G]=motion(S(:,i),u);
end

[newmean, newcov]=ukf_estimate_normal(Snew,w);
newcov=newcov+R;


% YOUR CODE ENDS HERE:

end