Dynamic-Calibration/utils/YALMIP-master/solvers/callquadprog.m

122 lines
3.5 KiB
Mathematica
Raw Normal View History

2019-12-18 11:25:45 +00:00
function output = callquadprog(interfacedata)
options = interfacedata.options;
model = yalmip2quadprog(interfacedata);
if options.savedebug
save quadprogdebug model
end
if options.showprogress;showprogress(['Calling ' interfacedata.solver.tag],options.showprogress);end
solvertime = tic;
solveroutput = callsolver(model,options);
solvertime = toc(solvertime);
solution = quadprogsol2yalmipsol(solveroutput,model);
% Save all data sent to solver?
if ~options.savesolverinput
model = [];
end
% Save all data from the solver?
if ~options.savesolveroutput
solveroutput = [];
end
% Standard interface
Primal = solution.x(:);
Dual = solution.D_struc;
problem = solution.problem;
infostr = yalmiperror(solution.problem,interfacedata.solver.tag);
if ~options.savesolverinput
solverinput = [];
else
solverinput = model;
end
if ~options.savesolveroutput
solveroutput = [];
else
solveroutput = solveroutput;
end
% Standard interface
output = createOutputStructure(Primal,Dual,[],problem,infostr,solverinput,solveroutput,solvertime);
function solveroutput = callsolver(model,options)
x = [];
fmin = [];
flag = [];
output = [];
lambda = [];
if nnz(model.Q) == 0
% BUG in LIN/QUADPROG, computation of lambda crashes in some rare
% cases. To avoid seeing this when we don't want the lambdas anyway, we
% don't ask for it
if options.saveduals
[x,fmin,flag,output,lambda] = linprog(model.c, model.A, model.b, model.Aeq, model.beq, model.lb, model.ub, model.x0,model.ops);
else
lambda = [];
[x,fmin,flag,output] = linprog(model.c, model.A, model.b, model.Aeq, model.beq, model.lb, model.ub, model.x0,model.ops);
end
else
if options.saveduals
[x,fmin,flag,output,lambda] = quadprog(model.Q, model.c, model.A, model.b, model.Aeq, model.beq, model.lb, model.ub, model.x0,model.ops);
else
lambda = [];
[x,fmin,flag,output] = quadprog(model.Q, model.c, model.A, model.b, model.Aeq, model.beq, model.lb, model.ub, model.x0,model.ops);
end
if flag==5
[x,fmin,flag,output,lambda] = quadprog(model.Q, model.c, model.A, model.b, model.Aeq, model.beq, model.lb, model.ub, [],model.ops);
end
end
if isempty(x)
x = nan(length(model.c),1);
end
solveroutput.x = x;
solveroutput.fmin = fmin;
solveroutput.flag = flag;
solveroutput.output = output;
solveroutput.lambda = lambda;
function solution = quadprogsol2yalmipsol(solveroutput,model)
solution.x = solveroutput.x(:);
% Internal format for duals
if ~isempty(solveroutput.lambda)
solution.D_struc = [solveroutput.lambda.eqlin;solveroutput.lambda.ineqlin];
else
solution.D_struc = [];
end
% Check, currently not exhaustive...
problem = 0;
if solveroutput.flag==0
solution.problem = 3;
else
if solveroutput.flag==-3
solution.problem = 2;
elseif solveroutput.flag==-2
solution.problem = 1;
else
if solveroutput.flag>0
solution.problem = 0;
else
if isempty(solveroutput.x)
solution.x = repmat(nan,length(model.f),1);
end
if any((model.A*solveroutput.x-model.b)>sqrt(eps)) | any( abs(model.Aeq*solveroutput.x-model.beq)>sqrt(eps))
solution.problem = 1; % Likely to be infeasible
else
if model.f'*solveroutput.x<-1e10 % Likely unbounded
solution.problem = 2;
else % Probably convergence issues
solution.problem = 5;
end
end
end
end
end