Mercurial > octave-nkf
view libinterp/corefcn/__qp__.cc @ 17787:175b392e91fe
Use GNU style coding conventions for code in libinterp/
* libinterp/corefcn/Cell.h, libinterp/corefcn/__contourc__.cc,
libinterp/corefcn/__dispatch__.cc, libinterp/corefcn/__lin_interpn__.cc,
libinterp/corefcn/__pchip_deriv__.cc, libinterp/corefcn/__qp__.cc,
libinterp/corefcn/balance.cc, libinterp/corefcn/besselj.cc,
libinterp/corefcn/betainc.cc, libinterp/corefcn/bitfcns.cc,
libinterp/corefcn/bsxfun.cc, libinterp/corefcn/c-file-ptr-stream.cc,
libinterp/corefcn/c-file-ptr-stream.h, libinterp/corefcn/cellfun.cc,
libinterp/corefcn/colloc.cc, libinterp/corefcn/comment-list.h,
libinterp/corefcn/conv2.cc, libinterp/corefcn/daspk.cc,
libinterp/corefcn/dasrt.cc, libinterp/corefcn/dassl.cc,
libinterp/corefcn/data.cc, libinterp/corefcn/debug.cc,
libinterp/corefcn/defaults.cc, libinterp/corefcn/defaults.in.h,
libinterp/corefcn/defun-int.h, libinterp/corefcn/defun.cc,
libinterp/corefcn/det.cc, libinterp/corefcn/dirfns.cc,
libinterp/corefcn/display.cc, libinterp/corefcn/dlmread.cc,
libinterp/corefcn/dot.cc, libinterp/corefcn/dynamic-ld.cc,
libinterp/corefcn/dynamic-ld.h, libinterp/corefcn/eig.cc,
libinterp/corefcn/ellipj.cc, libinterp/corefcn/error.cc,
libinterp/corefcn/error.h, libinterp/corefcn/event-queue.h,
libinterp/corefcn/fft.cc, libinterp/corefcn/fft2.cc, libinterp/corefcn/fftn.cc,
libinterp/corefcn/file-io.cc, libinterp/corefcn/filter.cc,
libinterp/corefcn/find.cc, libinterp/corefcn/gammainc.cc,
libinterp/corefcn/gcd.cc, libinterp/corefcn/getgrent.cc,
libinterp/corefcn/getpwent.cc, libinterp/corefcn/getrusage.cc,
libinterp/corefcn/givens.cc, libinterp/corefcn/gl-render.cc,
libinterp/corefcn/gl2ps-renderer.cc, libinterp/corefcn/gl2ps-renderer.h,
libinterp/corefcn/graphics.cc, libinterp/corefcn/graphics.in.h,
libinterp/corefcn/gripes.cc, libinterp/corefcn/gripes.h,
libinterp/corefcn/help.cc, libinterp/corefcn/hess.cc,
libinterp/corefcn/hex2num.cc, libinterp/corefcn/input.cc,
libinterp/corefcn/input.h, libinterp/corefcn/inv.cc,
libinterp/corefcn/jit-ir.h, libinterp/corefcn/jit-typeinfo.cc,
libinterp/corefcn/jit-typeinfo.h, libinterp/corefcn/jit-util.h,
libinterp/corefcn/kron.cc, libinterp/corefcn/load-path.cc,
libinterp/corefcn/load-path.h, libinterp/corefcn/load-save.cc,
libinterp/corefcn/load-save.h, libinterp/corefcn/lookup.cc,
libinterp/corefcn/ls-ascii-helper.cc, libinterp/corefcn/ls-hdf5.cc,
libinterp/corefcn/ls-hdf5.h, libinterp/corefcn/ls-mat-ascii.cc,
libinterp/corefcn/ls-mat-ascii.h, libinterp/corefcn/ls-mat4.cc,
libinterp/corefcn/ls-mat5.cc, libinterp/corefcn/ls-mat5.h,
libinterp/corefcn/ls-oct-ascii.cc, libinterp/corefcn/lsode.cc,
libinterp/corefcn/lu.cc, libinterp/corefcn/luinc.cc,
libinterp/corefcn/mappers.cc, libinterp/corefcn/matrix_type.cc,
libinterp/corefcn/max.cc, libinterp/corefcn/md5sum.cc,
libinterp/corefcn/mex.cc, libinterp/corefcn/mexproto.h,
libinterp/corefcn/mgorth.cc, libinterp/corefcn/mxarray.in.h,
libinterp/corefcn/nproc.cc, libinterp/corefcn/oct-hist.cc,
libinterp/corefcn/oct-lvalue.h, libinterp/corefcn/oct-map.cc,
libinterp/corefcn/oct-map.h, libinterp/corefcn/oct-obj.h,
libinterp/corefcn/oct-prcstrm.h, libinterp/corefcn/oct-stdstrm.h,
libinterp/corefcn/oct-stream.cc, libinterp/corefcn/oct-stream.h,
libinterp/corefcn/octave-link.cc, libinterp/corefcn/octave-link.h,
libinterp/corefcn/pager.cc, libinterp/corefcn/pinv.cc,
libinterp/corefcn/pr-output.cc, libinterp/corefcn/procstream.h,
libinterp/corefcn/profiler.cc, libinterp/corefcn/pt-jit.cc,
libinterp/corefcn/pt-jit.h, libinterp/corefcn/quad.cc,
libinterp/corefcn/quadcc.cc, libinterp/corefcn/qz.cc,
libinterp/corefcn/rand.cc, libinterp/corefcn/rcond.cc,
libinterp/corefcn/regexp.cc, libinterp/corefcn/schur.cc,
libinterp/corefcn/sighandlers.cc, libinterp/corefcn/sighandlers.h,
libinterp/corefcn/sparse-xdiv.cc, libinterp/corefcn/sparse-xdiv.h,
libinterp/corefcn/sparse-xpow.cc, libinterp/corefcn/sparse.cc,
libinterp/corefcn/spparms.cc, libinterp/corefcn/sqrtm.cc,
libinterp/corefcn/str2double.cc, libinterp/corefcn/strfind.cc,
libinterp/corefcn/strfns.cc, libinterp/corefcn/sub2ind.cc,
libinterp/corefcn/svd.cc, libinterp/corefcn/syl.cc,
libinterp/corefcn/symtab.cc, libinterp/corefcn/symtab.h,
libinterp/corefcn/syscalls.cc, libinterp/corefcn/sysdep.cc,
libinterp/corefcn/sysdep.h, libinterp/corefcn/time.cc,
libinterp/corefcn/toplev.cc, libinterp/corefcn/toplev.h,
libinterp/corefcn/tril.cc, libinterp/corefcn/txt-eng-ft.cc,
libinterp/corefcn/txt-eng-ft.h, libinterp/corefcn/txt-eng.h,
libinterp/corefcn/typecast.cc, libinterp/corefcn/urlwrite.cc,
libinterp/corefcn/utils.cc, libinterp/corefcn/variables.cc,
libinterp/corefcn/variables.h, libinterp/corefcn/xdiv.cc,
libinterp/corefcn/xdiv.h, libinterp/corefcn/xnorm.h, libinterp/corefcn/xpow.cc,
libinterp/corefcn/xpow.h, libinterp/corefcn/zfstream.cc,
libinterp/corefcn/zfstream.h, libinterp/dldfcn/__delaunayn__.cc,
libinterp/dldfcn/__dsearchn__.cc, libinterp/dldfcn/__eigs__.cc,
libinterp/dldfcn/__fltk_uigetfile__.cc, libinterp/dldfcn/__glpk__.cc,
libinterp/dldfcn/__init_fltk__.cc, libinterp/dldfcn/__init_gnuplot__.cc,
libinterp/dldfcn/__magick_read__.cc, libinterp/dldfcn/__voronoi__.cc,
libinterp/dldfcn/amd.cc, libinterp/dldfcn/ccolamd.cc, libinterp/dldfcn/chol.cc,
libinterp/dldfcn/colamd.cc, libinterp/dldfcn/convhulln.cc,
libinterp/dldfcn/dmperm.cc, libinterp/dldfcn/fftw.cc, libinterp/dldfcn/qr.cc,
libinterp/dldfcn/symbfact.cc, libinterp/dldfcn/symrcm.cc,
libinterp/dldfcn/tsearch.cc, libinterp/octave-value/ov-base-diag.cc,
libinterp/octave-value/ov-base-diag.h, libinterp/octave-value/ov-base-int.cc,
libinterp/octave-value/ov-base-int.h, libinterp/octave-value/ov-base-mat.h,
libinterp/octave-value/ov-base-scalar.cc,
libinterp/octave-value/ov-base-scalar.h,
libinterp/octave-value/ov-base-sparse.cc,
libinterp/octave-value/ov-base-sparse.h, libinterp/octave-value/ov-base.cc,
libinterp/octave-value/ov-base.h, libinterp/octave-value/ov-bool-mat.cc,
libinterp/octave-value/ov-bool-mat.h, libinterp/octave-value/ov-bool-sparse.cc,
libinterp/octave-value/ov-bool-sparse.h, libinterp/octave-value/ov-bool.cc,
libinterp/octave-value/ov-bool.h, libinterp/octave-value/ov-builtin.cc,
libinterp/octave-value/ov-builtin.h, libinterp/octave-value/ov-cell.cc,
libinterp/octave-value/ov-cell.h, libinterp/octave-value/ov-ch-mat.cc,
libinterp/octave-value/ov-ch-mat.h, libinterp/octave-value/ov-class.cc,
libinterp/octave-value/ov-class.h, libinterp/octave-value/ov-colon.h,
libinterp/octave-value/ov-complex.cc, libinterp/octave-value/ov-complex.h,
libinterp/octave-value/ov-cx-diag.cc, libinterp/octave-value/ov-cx-diag.h,
libinterp/octave-value/ov-cx-mat.cc, libinterp/octave-value/ov-cx-mat.h,
libinterp/octave-value/ov-cx-sparse.cc, libinterp/octave-value/ov-cx-sparse.h,
libinterp/octave-value/ov-dld-fcn.h, libinterp/octave-value/ov-fcn-handle.cc,
libinterp/octave-value/ov-fcn-handle.h,
libinterp/octave-value/ov-fcn-inline.cc,
libinterp/octave-value/ov-fcn-inline.h, libinterp/octave-value/ov-fcn.h,
libinterp/octave-value/ov-float.cc, libinterp/octave-value/ov-float.h,
libinterp/octave-value/ov-flt-complex.cc,
libinterp/octave-value/ov-flt-complex.h,
libinterp/octave-value/ov-flt-cx-diag.cc,
libinterp/octave-value/ov-flt-cx-diag.h,
libinterp/octave-value/ov-flt-cx-mat.cc,
libinterp/octave-value/ov-flt-cx-mat.h,
libinterp/octave-value/ov-flt-re-diag.cc,
libinterp/octave-value/ov-flt-re-diag.h,
libinterp/octave-value/ov-flt-re-mat.cc,
libinterp/octave-value/ov-flt-re-mat.h, libinterp/octave-value/ov-int16.cc,
libinterp/octave-value/ov-int32.cc, libinterp/octave-value/ov-int64.cc,
libinterp/octave-value/ov-int8.cc, libinterp/octave-value/ov-intx.h,
libinterp/octave-value/ov-java.cc, libinterp/octave-value/ov-lazy-idx.h,
libinterp/octave-value/ov-mex-fcn.cc, libinterp/octave-value/ov-mex-fcn.h,
libinterp/octave-value/ov-null-mat.cc, libinterp/octave-value/ov-null-mat.h,
libinterp/octave-value/ov-oncleanup.cc, libinterp/octave-value/ov-perm.cc,
libinterp/octave-value/ov-perm.h, libinterp/octave-value/ov-range.cc,
libinterp/octave-value/ov-range.h, libinterp/octave-value/ov-re-diag.cc,
libinterp/octave-value/ov-re-diag.h, libinterp/octave-value/ov-re-mat.cc,
libinterp/octave-value/ov-re-mat.h, libinterp/octave-value/ov-re-sparse.cc,
libinterp/octave-value/ov-re-sparse.h, libinterp/octave-value/ov-scalar.cc,
libinterp/octave-value/ov-scalar.h, libinterp/octave-value/ov-str-mat.cc,
libinterp/octave-value/ov-str-mat.h, libinterp/octave-value/ov-struct.cc,
libinterp/octave-value/ov-struct.h, libinterp/octave-value/ov-type-conv.h,
libinterp/octave-value/ov-typeinfo.cc, libinterp/octave-value/ov-typeinfo.h,
libinterp/octave-value/ov-uint16.cc, libinterp/octave-value/ov-uint32.cc,
libinterp/octave-value/ov-uint64.cc, libinterp/octave-value/ov-uint8.cc,
libinterp/octave-value/ov-usr-fcn.cc, libinterp/octave-value/ov-usr-fcn.h,
libinterp/octave-value/ov.cc, libinterp/octave-value/ov.h, libinterp/octave.cc,
libinterp/operators/op-b-bm.cc, libinterp/operators/op-b-sbm.cc,
libinterp/operators/op-bm-b.cc, libinterp/operators/op-bm-bm.cc,
libinterp/operators/op-cdm-cdm.cc, libinterp/operators/op-chm.cc,
libinterp/operators/op-class.cc, libinterp/operators/op-cm-cm.cc,
libinterp/operators/op-cm-cs.cc, libinterp/operators/op-cm-s.cc,
libinterp/operators/op-cm-scm.cc, libinterp/operators/op-cm-sm.cc,
libinterp/operators/op-cs-cm.cc, libinterp/operators/op-cs-cs.cc,
libinterp/operators/op-cs-scm.cc, libinterp/operators/op-cs-sm.cc,
libinterp/operators/op-dm-dm.cc, libinterp/operators/op-dm-scm.cc,
libinterp/operators/op-double-conv.cc, libinterp/operators/op-fcdm-fcdm.cc,
libinterp/operators/op-fcm-fcm.cc, libinterp/operators/op-fcm-fcs.cc,
libinterp/operators/op-fcm-fm.cc, libinterp/operators/op-fcm-fs.cc,
libinterp/operators/op-fcs-fcm.cc, libinterp/operators/op-fcs-fcs.cc,
libinterp/operators/op-fcs-fm.cc, libinterp/operators/op-fcs-fs.cc,
libinterp/operators/op-fdm-fdm.cc, libinterp/operators/op-float-conv.cc,
libinterp/operators/op-fm-fcm.cc, libinterp/operators/op-fm-fcs.cc,
libinterp/operators/op-fm-fm.cc, libinterp/operators/op-fm-fs.cc,
libinterp/operators/op-fs-fcm.cc, libinterp/operators/op-fs-fcs.cc,
libinterp/operators/op-fs-fm.cc, libinterp/operators/op-fs-fs.cc,
libinterp/operators/op-m-cm.cc, libinterp/operators/op-m-cs.cc,
libinterp/operators/op-m-m.cc, libinterp/operators/op-m-s.cc,
libinterp/operators/op-m-scm.cc, libinterp/operators/op-m-sm.cc,
libinterp/operators/op-pm-scm.cc, libinterp/operators/op-range.cc,
libinterp/operators/op-s-cm.cc, libinterp/operators/op-s-cs.cc,
libinterp/operators/op-s-scm.cc, libinterp/operators/op-sbm-b.cc,
libinterp/operators/op-sbm-bm.cc, libinterp/operators/op-sbm-sbm.cc,
libinterp/operators/op-scm-cm.cc, libinterp/operators/op-scm-cs.cc,
libinterp/operators/op-scm-m.cc, libinterp/operators/op-scm-s.cc,
libinterp/operators/op-scm-scm.cc, libinterp/operators/op-scm-sm.cc,
libinterp/operators/op-sm-cm.cc, libinterp/operators/op-sm-m.cc,
libinterp/operators/op-sm-s.cc, libinterp/operators/op-sm-scm.cc,
libinterp/operators/op-sm-sm.cc, libinterp/operators/op-str-m.cc,
libinterp/operators/op-str-s.cc, libinterp/operators/op-str-str.cc,
libinterp/operators/ops.h, libinterp/parse-tree/lex.h,
libinterp/parse-tree/parse.h, libinterp/parse-tree/pt-arg-list.cc,
libinterp/parse-tree/pt-arg-list.h, libinterp/parse-tree/pt-assign.cc,
libinterp/parse-tree/pt-assign.h, libinterp/parse-tree/pt-binop.cc,
libinterp/parse-tree/pt-binop.h, libinterp/parse-tree/pt-bp.h,
libinterp/parse-tree/pt-cbinop.cc, libinterp/parse-tree/pt-check.cc,
libinterp/parse-tree/pt-colon.cc, libinterp/parse-tree/pt-colon.h,
libinterp/parse-tree/pt-const.cc, libinterp/parse-tree/pt-decl.cc,
libinterp/parse-tree/pt-decl.h, libinterp/parse-tree/pt-eval.cc,
libinterp/parse-tree/pt-except.h, libinterp/parse-tree/pt-exp.h,
libinterp/parse-tree/pt-fcn-handle.cc, libinterp/parse-tree/pt-id.cc,
libinterp/parse-tree/pt-id.h, libinterp/parse-tree/pt-idx.cc,
libinterp/parse-tree/pt-idx.h, libinterp/parse-tree/pt-loop.h,
libinterp/parse-tree/pt-mat.cc, libinterp/parse-tree/pt-misc.cc,
libinterp/parse-tree/pt-misc.h, libinterp/parse-tree/pt-pr-code.cc,
libinterp/parse-tree/pt-select.h, libinterp/parse-tree/pt-stmt.h,
libinterp/parse-tree/token.h, libinterp/version.cc:
Use GNU style coding conventions for code in libinterp/
author | Rik <rik@octave.org> |
---|---|
date | Mon, 28 Oct 2013 19:51:46 -0700 |
parents | d63878346099 |
children | 4197fc428c7d |
line wrap: on
line source
/* Copyright (C) 2000-2013 Gabriele Pannocchia This file is part of Octave. Octave is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 3 of the License, or (at your option) any later version. Octave is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with Octave; see the file COPYING. If not, see <http://www.gnu.org/licenses/>. */ #ifdef HAVE_CONFIG_H #include <config.h> #endif #include <cfloat> #include "dbleCHOL.h" #include "dbleSVD.h" #include "mx-m-dm.h" #include "EIG.h" #include "defun.h" #include "error.h" #include "gripes.h" #include "oct-obj.h" #include "pr-output.h" #include "utils.h" static Matrix null (const Matrix& A, octave_idx_type& rank) { Matrix retval; rank = 0; if (! A.is_empty ()) { SVD A_svd (A); DiagMatrix S = A_svd.singular_values (); ColumnVector s = S.extract_diag (); Matrix V = A_svd.right_singular_matrix (); octave_idx_type A_nr = A.rows (); octave_idx_type A_nc = A.cols (); octave_idx_type tmp = A_nr > A_nc ? A_nr : A_nc; double tol = tmp * s(0) * std::numeric_limits<double>::epsilon (); octave_idx_type n = s.length (); for (octave_idx_type i = 0; i < n; i++) { if (s(i) > tol) rank++; } if (rank < A_nc) retval = V.extract (0, rank, A_nc-1, A_nc-1); else retval.resize (A_nc, 0); for (octave_idx_type i = 0; i < retval.numel (); i++) if (std::abs (retval(i)) < std::numeric_limits<double>::epsilon ()) retval(i) = 0; } return retval; } static int qp (const Matrix& H, const ColumnVector& q, const Matrix& Aeq, const ColumnVector& beq, const Matrix& Ain, const ColumnVector& bin, int maxit, ColumnVector& x, ColumnVector& lambda, int& iter) { int info = 0; iter = 0; double rtol = sqrt (std::numeric_limits<double>::epsilon ()); // Problem dimension. octave_idx_type n = x.length (); // Dimension of constraints. octave_idx_type n_eq = beq.length (); octave_idx_type n_in = bin.length (); // Filling the current active set. octave_idx_type n_act = n_eq; octave_idx_type n_tot = n_eq + n_in; // Equality constraints come first. We won't check the sign of the // Lagrange multiplier for those. Matrix Aact = Aeq; ColumnVector bact = beq; ColumnVector Wact; if (n_in > 0) { ColumnVector res = Ain*x - bin; for (octave_idx_type i = 0; i < n_in; i++) { res(i) /= (1.0 + std::abs (bin(i))); if (res(i) < rtol) { n_act++; Aact = Aact.stack (Ain.row (i)); bact.resize (n_act, bin(i)); Wact.resize (n_act-n_eq, i); } } } // Computing the ??? EIG eigH (H); if (error_state) { error ("qp: failed to compute eigenvalues of H"); return -1; } ColumnVector eigenvalH = real (eigH.eigenvalues ()); Matrix eigenvecH = real (eigH.eigenvectors ()); double minReal = eigenvalH.min (); octave_idx_type indminR = 0; for (octave_idx_type i = 0; i < n; i++) { if (minReal == eigenvalH(i)) { indminR = i; break; } } bool done = false; double alpha = 0.0; Matrix R; Matrix Y (n, 0, 0.0); ColumnVector g (n, 0.0); ColumnVector p (n, 0.0); ColumnVector lambda_tmp (n_in, 0.0); while (! done) { iter++; // Current Gradient // g = q + H * x; g = q + H * x; if (n_act == 0) { // There are no active constraints. if (minReal > 0.0) { // Inverting the Hessian. Using the Cholesky // factorization since the Hessian is positive // definite. CHOL cholH (H); R = cholH.chol_matrix (); Matrix Hinv = chol2inv (R); // Computing the unconstrained step. // p = -Hinv * g; p = -Hinv * g; info = 0; } else { // Finding the negative curvature of H. p = eigenvecH.column (indminR); // Following the negative curvature of H. if (p.transpose () * g > std::numeric_limits<double>::epsilon ()) p = -p; info = 1; } // Multipliers are zero. lambda_tmp.fill (0.0); } else { // There are active constraints. // Computing the null space. octave_idx_type rank; Matrix Z = null (Aact, rank); octave_idx_type dimZ = n - rank; // FIXME: still remain to handle the case of // non-full rank active set matrix. // Computing the Y matrix (orthogonal to Z) Y = Aact.pseudo_inverse (); // Reduced Hessian Matrix Zt = Z.transpose (); Matrix rH = Zt * H * Z; octave_idx_type pR = 0; if (dimZ > 0) { // Computing the Cholesky factorization (pR = 0 means // that the reduced Hessian was positive definite). CHOL cholrH (rH, pR); Matrix tR = cholrH.chol_matrix (); if (pR == 0) R = tR; } if (pR == 0) { info = 0; // Computing the step pz. if (dimZ > 0) { // Using the Cholesky factorization to invert rH Matrix rHinv = chol2inv (R); ColumnVector pz = -rHinv * Zt * g; // Global step. p = Z * pz; } else { // Global step. p.fill (0.0); } } else { info = 1; // Searching for the most negative curvature. EIG eigrH (rH); if (error_state) { error ("qp: failed to compute eigenvalues of rH"); return -1; } ColumnVector eigenvalrH = real (eigrH.eigenvalues ()); Matrix eigenvecrH = real (eigrH.eigenvectors ()); double mRrH = eigenvalrH.min (); indminR = 0; for (octave_idx_type i = 0; i < n; i++) { if (mRrH == eigenvalH(i)) { indminR = i; break; } } ColumnVector eVrH = eigenvecrH.column (indminR); // Computing the step pz. p = Z * eVrH; if (p.transpose () * g > std::numeric_limits<double>::epsilon ()) p = -p; } } // Checking the step-size. ColumnVector abs_p (n); for (octave_idx_type i = 0; i < n; i++) abs_p(i) = std::abs (p(i)); double max_p = abs_p.max (); if (max_p < rtol) { // The step is null. Checking constraints. if (n_act - n_eq == 0) // Solution is found because no inequality // constraints are active. done = true; else { // Computing the multipliers only for the inequality // constraints that are active. We do NOT compute // multipliers for the equality constraints. Matrix Yt = Y.transpose (); Yt = Yt.extract_n (n_eq, 0, n_act-n_eq, n); lambda_tmp = Yt * (g + H * p); // Checking the multipliers. We remove the most // negative from the set (if any). double min_lambda = lambda_tmp.min (); if (min_lambda >= 0) { // Solution is found. done = true; } else { octave_idx_type which_eig = 0; for (octave_idx_type i = 0; i < n_act; i++) { if (lambda_tmp(i) == min_lambda) { which_eig = i; break; } } // At least one multiplier is negative, we // remove it from the set. n_act--; for (octave_idx_type i = which_eig; i < n_act - n_eq; i++) { Wact(i) = Wact(i+1); for (octave_idx_type j = 0; j < n; j++) Aact(n_eq+i,j) = Aact(n_eq+i+1,j); bact(n_eq+i) = bact(n_eq+i+1); } // Resizing the active set. Wact.resize (n_act-n_eq); bact.resize (n_act); Aact.resize (n_act, n); } } } else { // The step is not null. if (n_act - n_eq == n_in) { // All inequality constraints were active. We can // add the whole step. x += p; } else { // Some constraints were not active. Checking if // there is a blocking constraint. alpha = 1.0; octave_idx_type is_block = -1; for (octave_idx_type i = 0; i < n_in; i++) { bool found = false; for (octave_idx_type j = 0; j < n_act-n_eq; j++) { if (Wact(j) == i) { found = true; break; } } if (! found) { // The i-th constraint was not in the set. Is it a // blocking constraint? RowVector tmp_row = Ain.row (i); double tmp = tmp_row * p; double res = tmp_row * x; if (tmp < 0.0) { double alpha_tmp = (bin(i) - res) / tmp; if (alpha_tmp < alpha) { alpha = alpha_tmp; is_block = i; } } } } // In is_block there is the index of the blocking // constraint (if any). if (is_block >= 0) { // There is a blocking constraint (index in // is_block) which is added to the active set. n_act++; Aact = Aact.stack (Ain.row (is_block)); bact.resize (n_act, bin(is_block)); Wact.resize (n_act-n_eq, is_block); // Adding the reduced step x += alpha * p; } else { // There are no blocking constraints. Adding the // whole step. x += alpha * p; } } } if (iter == maxit) { done = true; // warning ("qp_main: maximum number of iteration reached"); info = 3; } } lambda_tmp = Y.transpose () * (g + H * p); // Reordering the Lagrange multipliers. lambda.resize (n_tot); lambda.fill (0.0); for (octave_idx_type i = 0; i < n_eq; i++) lambda(i) = lambda_tmp(i); for (octave_idx_type i = n_eq; i < n_tot; i++) { for (octave_idx_type j = 0; j < n_act-n_eq; j++) { if (Wact(j) == i - n_eq) { lambda(i) = lambda_tmp(n_eq+j); break; } } } return info; } DEFUN (__qp__, args, , "-*- texinfo -*-\n\ @deftypefn {Built-in Function} {[@var{x}, @var{lambda}, @var{info}, @var{iter}] =} __qp__ (@var{x0}, @var{H}, @var{q}, @var{Aeq}, @var{beq}, @var{Ain}, @var{bin}, @var{maxit})\n\ Undocumented internal function.\n\ @end deftypefn") { octave_value_list retval; if (args.length () == 8) { const ColumnVector x0 (args(0) . vector_value ()); const Matrix H (args(1) . matrix_value ()); const ColumnVector q (args(2) . vector_value ()); const Matrix Aeq (args(3) . matrix_value ()); const ColumnVector beq (args(4) . vector_value ()); const Matrix Ain (args(5) . matrix_value ()); const ColumnVector bin (args(6) . vector_value ()); const int maxit (args(7) . int_value ()); if (! error_state) { int iter = 0; // Copying the initial guess in the working variable ColumnVector x = x0; // Reordering the Lagrange multipliers ColumnVector lambda; int info = qp (H, q, Aeq, beq, Ain, bin, maxit, x, lambda, iter); if (! error_state) { retval(3) = iter; retval(2) = info; retval(1) = lambda; retval(0) = x; } else error ("qp: internal error"); } else error ("__qp__: invalid arguments"); } else print_usage (); return retval; } /* ## No test needed for internal helper function. %!assert (1) */