diff --git a/src/gaussian_densities.m b/src/gaussian_densities.m index 4f2b21438d7f8172e4af4b4ad345e165d14774cd..73a73140356bd279ad92bb997c95b1ca8202646f 100644 --- a/src/gaussian_densities.m +++ b/src/gaussian_densities.m @@ -43,9 +43,6 @@ prior = probability2(st_t_1,sqr_Pss_t_t_1,particles) ; % likelihood yt_t_1_i = measurement_equations(particles,ReducedForm,ThreadsOptions) ; eta_t_i = bsxfun(@minus,obs,yt_t_1_i)' ; -%yt_t_1 = sum(yt_t_1_i*weigths1,2) ; -%tmp = bsxfun(@minus,yt_t_1_i,yt_t_1) ; -%Pyy = bsxfun(@times,weigths2',tmp)*tmp' + H ; Pyy = H ; sqr_det = sqrt(det(Pyy)) ; foo = (eta_t_i/Pyy).*eta_t_i ; diff --git a/src/probability2.m b/src/probability2.m index 57ab65f8fb353b81e5ce5375520e265a0bfb3365..a7486d1b8eb84c8c369bc2a563813993dd6e7188 100644 --- a/src/probability2.m +++ b/src/probability2.m @@ -34,5 +34,4 @@ function [density] = probability2(mu,S,X) dim = size(X,1) ; normfact = bsxfun(@power,(2*pi),(dim/2)) ; foo = S\(bsxfun(@minus,X,mu)) ; -density = exp(-0.5*sum(foo.*foo)')./abs((normfact*prod(diag(S)))) + 1e-99 ; - +density = exp(-0.5*sum(foo.*foo)')./abs((normfact*prod(diag(S)))) + 1e-99 ; \ No newline at end of file