function xyOut = solver(a, xyIn, wts)
N=size(xyIn,1);
D=min(N,mindist(a));
mD=mean(D,1);
E=D-repmat(mD,[size(D,1),1])-repmat(mD',[1,size(D,2)])+mean(mD);
[x,nill]=svd(E);
xyOut0=x(:,1:2);
beta1=10;
beta2=100;
lambda=.2;
thr=.01;
xyOut=N*xyOut0+randn(size(xyOut0))/1e3;
for ncut=1:2
M=a; M(1:size(M,1)+1:end)=1;
M=bsxfun(@rdivide,M,sum(M,2));
Mbeta=(((1-lambda)*eye(N)+lambda*M)^beta1);
for n1=1:beta2
xyOut=Mbeta*xyOut;
mxyOut=mean(xyOut,1);
cxyOut=cov(xyOut,1);
[c1,d1,c2]=svd(cxyOut);
xyOut=(xyOut-mxyOut(ones(N,1),:))*c1*diag(1./sqrt(.1+diag(d1)))*c2'; %sqrtm(pinv(.1*eye(2)+cxyOut));
end
[i,j]=find(a>thr);
dd=sum((xyOut(i,:)-xyOut(j,:)).^2,2);
k=find(dd>5*mean(dd));
if isempty(k), break; end
a(i(k)+N*(j(k)-1))=thr;
end
xyOut0=xyOut;
xyOut0=sqrt(N)*detrend(xyOut0,'constant')*diag(1./max(eps,std(xyOut0,1,1)));
K=10;
k=1;
[sxyOut0,idxequal]=sortrows(round(K*xyOut0)/K);
idxequal=idxequal(all(~diff(sxyOut0,1,1),2));
xyOut=round(xyOut0*k);
while size(unique(xyOut,'rows'),1)~=N
k=k*2;
xyOut=xyOut0*k;
xyOut(idxequal,:)=(xyOut0(idxequal,:)+randn(numel(idxequal),2)/K)*k;
xyOut=round(xyOut);
end
xyOut=bsxfun(@plus,xyOut,round(median(xyIn,1)-median(xyOut,1)));
end
function D=mindist(C)
N=size(C,1);
X=logical(speye(N));
D=inf(N,N);
D(X)=0;
for n=1:N,
X=(C*X)>0;
X=X&(D>n);
if ~any(X(:)),break;end
D(X)=n;
end
end
|