???未定义的函数或方法'det'用于输入参数类型'double'和属性'full 3d real

Question

for j=1:length(idf) 
    dx = xf(1,j)- xv(1); 
    dy = xf(2,j)- xv(2); 
    d2 = dx^2 + dy^2; 
    d = sqrt(d2); 
    Z_est(:,j) = [d;atan2(dy,dx)-xv(3)]; 
    S(:,:,j) = Hf(:,:,j) * pf(:,:,j) * Hf(:,:,j)' + R 
end  

    v = zf - Z_est; %innovation 
    v(2,:) = pi_to_pi(v(2,:)); 
    w= 1; 
for n = 1:size(zf,2) 
    den = 2*pi*sqrt(det(S)); 
    neu = exp(-0.5 * v(:,n)' * inv(S) * v(:,n)); 
    w = w*(neu/den); 
end 

我的程序是根据粒子滤波计算我的状态粒子的权重，在开始运行时计算W， BT之后它显示错误??? Undefined function or method 'det' for input arguments of type 'double' and attributes 'full 3d real''。 我不知道这个问题。

Answer 1

您需要给det一个方形矩阵而不是一个3d矩阵（S是一个3d数组）。 我假设你的意思是不是写：

den = 2*pi*sqrt(det(S(:,:,n)); 

因此，在给定的循环迭代S的切片的det被计算。