47 lines
1.7 KiB
Mathematica
47 lines
1.7 KiB
Mathematica
|
%%******************************************************************
|
||
|
|
%% HSDHKMdirfun: compute (dX,dZ), given dy, for the HKM direction.
|
||
|
|
%%*****************************************************************
|
||
|
|
%% SDPT3: version 4.0
|
||
|
|
%% Copyright (c) 1997 by
|
||
|
|
%% Kim-Chuan Toh, Michael J. Todd, Reha H. Tutuncu
|
||
|
|
%% Last Modified: 16 Sep 2004
|
||
|
|
%%*****************************************************************
|
||
|
|
|
||
|
|
function [par,dX,dy,dZ] = HSDHKMdirfun(blk,At,par,Rd,EinvRc,X,xx);
|
||
|
|
|
||
|
|
global solve_ok
|
||
|
|
|
||
|
|
dX = cell(size(blk,1),1); dZ = cell(size(blk,1),1); dy = [];
|
||
|
|
if (any(isnan(xx)) | any(isinf(xx)))
|
||
|
|
solve_ok = 0;
|
||
|
|
fprintf('\n HSDHKMdirfun: solution contains NaN or inf.');
|
||
|
|
return;
|
||
|
|
end
|
||
|
|
%%
|
||
|
|
m = par.m;
|
||
|
|
dy2 = xx(1:m+2);
|
||
|
|
%%
|
||
|
|
for p=1:size(blk,1)
|
||
|
|
pblk = blk(p,:);
|
||
|
|
if strcmp(pblk{1},'l')
|
||
|
|
dZ(p) = ops(Rd(p),'-',Atyfun(pblk,At(p,:),[],[],dy2));
|
||
|
|
dX{p} = EinvRc{p} - par.dd{p}.*dZ{p};
|
||
|
|
elseif strcmp(pblk{1},'q')
|
||
|
|
dZ(p) = ops(Rd(p),'-',Atyfun(pblk,At(p,:),[],[],dy2));
|
||
|
|
tmp = par.dd{p}.*dZ{p} ...
|
||
|
|
+ qops(pblk,qops(pblk,dZ{p},par.Zinv{p},1),X{p},3) ...
|
||
|
|
+ qops(pblk,qops(pblk,dZ{p},X{p},1),par.Zinv{p},3);
|
||
|
|
dX{p} = EinvRc{p} - tmp;
|
||
|
|
elseif strcmp(pblk{1},'s')
|
||
|
|
dZ(p) = ops(Rd(p),'-',Atyfun(pblk,At(p,:),par.permA(p,:),par.isspAy(p),dy2));
|
||
|
|
tmp = Prod3(pblk,X{p},dZ{p},par.Zinv{p},0);
|
||
|
|
tmp = 0.5*(tmp+tmp');
|
||
|
|
dX{p} = EinvRc{p}-tmp;
|
||
|
|
end
|
||
|
|
end
|
||
|
|
dy = dy2(1:m);
|
||
|
|
par.dtau = dy2(m+1);
|
||
|
|
par.dtheta = dy2(m+2);
|
||
|
|
par.dkap = (par.mu./par.tau - par.kap) - par.kap*(par.dtau/par.tau);
|
||
|
|
%%*******************************************************************
|