Dynamic-Calibration/utils/YALMIP-master/extras/derivebounds.m

57 lines
1.4 KiB
Mathematica
Raw Permalink Normal View History

2019-12-18 11:25:45 +00:00
function [M,m,infbound,lowerinf,upperinf] = derivebounds(f,lowerupper)
% Code to compute estimates of max and min
% of the linear vector f
basis = getbase(f);
fvars = getvariables(f);
if nargin == 1
lowerupper = yalmip('getbounds',fvars);
else
lowerupper = lowerupper(fvars,:);
end
if any(any(isinf(lowerupper)))
infbound = 1;
lowerinf = any(isinf(lowerupper(:,1)));
upperinf = any(isinf(lowerupper(:,2)));
else
infbound = 0;
lowerinf = 0;
upperinf = 0;
end
b = basis(:,1);
A = basis(:,2:end);
M = repmat(-inf,size(b,1),1);
m = -M;
if all(all(isinf(lowerupper)))
M = repmat(inf,length(b),1);
m = repmat(-inf,length(b),1);
else
lower = lowerupper(:,1);
upper = lowerupper(:,2);
Apos = (A>0);
Aneg = (A<0);
npA = nnz(Apos);
nnA = nnz(Aneg);
if all(all(~isinf(lowerupper)))
M = A.*Apos*upper+A.*Aneg*lower;
m = A.*Aneg*upper+A.*Apos*lower;
elseif all(isinf(upper)) & nnA==0 & ~any(isinf(lower))
% Speeds up norm(x,1) case
m = A.*Apos*lower;
else
for i = 1:length(b)
ind = A(i,:)>0;
i1 = find(ind);
i2 = find(~ind);
a = A(i,[i1 i2]);
M(i) = a*[upper(i1);lower(i2)];
m(i) = a*[lower(i1);upper(i2)];
end
end
end
M(isnan(M)) = inf;
M(isinf(M)) = 1e4; M = M+b;%+0.01;
m(isnan(m)) = -inf;
m(isinf(m)) = -1e4;m = m+b;%-0.01;