radialmerge.m

大家可以参考的例子滤波源码

function [k,mu,M,aMerge,rMerge] = radialMerge(aMerge,rMerge,k,mu,M,delta,x,y,hyper,t,bFunction,sigStar,walkInt);



if nargin < 12, error('Not enough input arguments.'); end
[N,d] = size(x);      % N = number of data, d = dimension of x.
[N,c] = size(y);      % c = dimension of y, i.e. number of outputs.
insideMerge=1;
uD=rand(1);

% INITIALISE H AND P MATRICES:
% ===========================
invH=zeros(k(t)+1+d,k(t)+1+d,c);
P=zeros(N,N,c);
invHproposal=zeros(k(t)+d,k(t)+d,c);
Pproposal=zeros(N,N,c);
for i=1:c,
  invH(:,:,i) = (M'*M + (1/delta(t,i))*eye(k(t)+1+d));
  P(:,:,i) = eye(N) - M*inv(invH(:,:,i))*M';
end;

% PROPOSE FIRST BASIS FUNCTION:
% ============================
position = unidrnd(length(mu{t}(:,1)),1,1);
mu1 = mu{t}(position,:);
dist = zeros(k(t),1);
for i=1:k(t),
  if i== position,
    dist(i) = inf; 
  else
    dist(i)=norm(mu1-mu{t}(i,:)); % Euclidean distance;
  end;
end; 

% PROPOSE SECOND BASIS FUNCTION:
% =============================
position2 = find(dist == min(dist));
mu2 = mu{t}(position2,:);
mumg = .5*(mu1 + mu2);

% extract components:
proposalPos1 = position + d+1;
if (proposalPos1==d+1+k(t)),
  Mproposal = [M(:,1:proposalPos1-1)];     
else
  Mproposal = [M(:,1:proposalPos1-1) M(:,proposalPos1+1:k(t)+d+1)];      
end;
if position2>position,
  proposalPos2 = position2 + d+1;
  if (proposalPos2==d+1+k(t)),
    Mproposal = [Mproposal(:,1:proposalPos2-2)];     
  else
    Mproposal = [Mproposal(:,1:proposalPos2-2) Mproposal(:,proposalPos2:k(t)+d)];      
  end;
elseif position2<position,
  proposalPos2 = position2 + d+1;
  Mproposal = [Mproposal(:,1:proposalPos2-1) Mproposal(:,proposalPos2+1:k(t)+d)];      
else
  error('Something wrong with merge move');
end;
% add merged component:
Mproposal = [Mproposal feval(bFunction,mumg,x)]; 
for i=1:c,
  invHproposal(:,:,i) = (Mproposal'*Mproposal + inv(delta(t,i))*eye(k(t)+d)); 
  Pproposal(:,:,i) = eye(N) - Mproposal*inv(invHproposal(:,:,i))*Mproposal'; 
end;

% PERFORM A MERGE MOVE:
% ====================
Jacobian = inv(sigStar);
ratio= Jacobian* prod(walkInt) * k(t) * inv(k(t)-1) * sqrt(delta(t,1)) * sqrt((det(invH(:,:,1)))/(det(invHproposal(:,:,1)))) * ((hyper.gamma+y(:,1)'*P(:,:,1)*y(:,1))/(hyper.gamma + y(:,1)'*Pproposal(:,:,1)*y(:,1)))^((hyper.v+N)/2);  
for i=2:c,
  ratio= ratio * sqrt(delta(t,i)) * sqrt((det(invH(:,:,i)))/(det(invHproposal(:,:,i)))) * ((hyper.gamma+y(:,i)'*P(:,:,i)*y(:,i))/(hyper.gamma + y(:,i)'*Pproposal(:,:,i)*y(:,i)))^((hyper.v+N)/2); 
end;
acceptance = min(1,ratio);  
if min(dist)<2*sigStar
  acceptance = 0;   % To ensure reversibility.
end;

% METROPOLIS-HASTINGS STEP:
% ========================
if (uD<acceptance),
  previousMu = mu{t};
  if (proposalPos1==(1+d+1)),
    muTrunc = [previousMu(2:k(t),:)]; 
  elseif (proposalPos1==(1+d+k(t))),
    muTrunc = [previousMu(1:k(t)-1,:)];
  else
    muTrunc = [previousMu(1:proposalPos1-1-d-1,:); previousMu(proposalPos1-d-1+1:k(t),:)];
  end;
  if position2>position,
    if (proposalPos2==(1+d+k(t))),
      muTrunc = [muTrunc(1:k(t)-2,:)];
    else
      muTrunc = [muTrunc(1:proposalPos2-1-d-2,:); muTrunc(proposalPos2-d-1:k(t)-1,:)];
    end;
  elseif position2<position,
    if (proposalPos2==(1+d+1)),
      muTrunc = [muTrunc(2:k(t)-1,:)]; 
    else
      muTrunc = [muTrunc(1:proposalPos2-1-d-1,:); muTrunc(proposalPos2-d-1+1:k(t)-1,:)];
    end;
  else
    error('Something wrong with merge move');
  end;
  mu{t+1} = [muTrunc; mumg];
  k(t+1) = k(t)-1;
  M=Mproposal;
  aMerge=aMerge+1;
else
  mu{t+1} = mu{t};
  k(t+1) = k(t);
  rMerge=rMerge+1;
  M=M;
end;