git.maemo.org Git - opencv/blob - 3rdparty/lapack/dorgqr.c

   1 #include "clapack.h"
   2
   3 /* Table of constant values */
   4
   5 static integer c__1 = 1;
   6 static integer c_n1 = -1;
   7 static integer c__3 = 3;
   8 static integer c__2 = 2;
   9
  10 /* Subroutine */ int dorgqr_(integer *m, integer *n, integer *k, doublereal *
  11         a, integer *lda, doublereal *tau, doublereal *work, integer *lwork,
  12         integer *info)
  13 {
  14     /* System generated locals */
  15     integer a_dim1, a_offset, i__1, i__2, i__3;
  16
  17     /* Local variables */
  18     integer i__, j, l, ib, nb, ki, kk, nx, iws, nbmin, iinfo;
  19     extern /* Subroutine */ int dorg2r_(integer *, integer *, integer *,
  20             doublereal *, integer *, doublereal *, doublereal *, integer *),
  21             dlarfb_(char *, char *, char *, char *, integer *, integer *,
  22             integer *, doublereal *, integer *, doublereal *, integer *,
  23             doublereal *, integer *, doublereal *, integer *), dlarft_(char *, char *, integer *, integer *,
  24             doublereal *, integer *, doublereal *, doublereal *, integer *), xerbla_(char *, integer *);
  25     extern integer ilaenv_(integer *, char *, char *, integer *, integer *,
  26             integer *, integer *);
  27     integer ldwork, lwkopt;
  28     logical lquery;
  29
  30
  31 /*  -- LAPACK routine (version 3.1) -- */
  32 /*     Univ. of Tennessee, Univ. of California Berkeley and NAG Ltd.. */
  33 /*     November 2006 */
  34
  35 /*     .. Scalar Arguments .. */
  36 /*     .. */
  37 /*     .. Array Arguments .. */
  38 /*     .. */
  39
  40 /*  Purpose */
  41 /*  ======= */
  42
  43 /*  DORGQR generates an M-by-N real matrix Q with orthonormal columns, */
  44 /*  which is defined as the first N columns of a product of K elementary */
  45 /*  reflectors of order M */
  46
  47 /*        Q  =  H(1) H(2) . . . H(k) */
  48
  49 /*  as returned by DGEQRF. */
  50
  51 /*  Arguments */
  52 /*  ========= */
  53
  54 /*  M       (input) INTEGER */
  55 /*          The number of rows of the matrix Q. M >= 0. */
  56
  57 /*  N       (input) INTEGER */
  58 /*          The number of columns of the matrix Q. M >= N >= 0. */
  59
  60 /*  K       (input) INTEGER */
  61 /*          The number of elementary reflectors whose product defines the */
  62 /*          matrix Q. N >= K >= 0. */
  63
  64 /*  A       (input/output) DOUBLE PRECISION array, dimension (LDA,N) */
  65 /*          On entry, the i-th column must contain the vector which */
  66 /*          defines the elementary reflector H(i), for i = 1,2,...,k, as */
  67 /*          returned by DGEQRF in the first k columns of its array */
  68 /*          argument A. */
  69 /*          On exit, the M-by-N matrix Q. */
  70
  71 /*  LDA     (input) INTEGER */
  72 /*          The first dimension of the array A. LDA >= max(1,M). */
  73
  74 /*  TAU     (input) DOUBLE PRECISION array, dimension (K) */
  75 /*          TAU(i) must contain the scalar factor of the elementary */
  76 /*          reflector H(i), as returned by DGEQRF. */
  77
  78 /*  WORK    (workspace/output) DOUBLE PRECISION array, dimension (MAX(1,LWORK)) */
  79 /*          On exit, if INFO = 0, WORK(1) returns the optimal LWORK. */
  80
  81 /*  LWORK   (input) INTEGER */
  82 /*          The dimension of the array WORK. LWORK >= max(1,N). */
  83 /*          For optimum performance LWORK >= N*NB, where NB is the */
  84 /*          optimal blocksize. */
  85
  86 /*          If LWORK = -1, then a workspace query is assumed; the routine */
  87 /*          only calculates the optimal size of the WORK array, returns */
  88 /*          this value as the first entry of the WORK array, and no error */
  89 /*          message related to LWORK is issued by XERBLA. */
  90
  91 /*  INFO    (output) INTEGER */
  92 /*          = 0:  successful exit */
  93 /*          < 0:  if INFO = -i, the i-th argument has an illegal value */
  94
  95 /*  ===================================================================== */
  96
  97 /*     .. Parameters .. */
  98 /*     .. */
  99 /*     .. Local Scalars .. */
 100 /*     .. */
 101 /*     .. External Subroutines .. */
 102 /*     .. */
 103 /*     .. Intrinsic Functions .. */
 104 /*     .. */
 105 /*     .. External Functions .. */
 106 /*     .. */
 107 /*     .. Executable Statements .. */
 108
 109 /*     Test the input arguments */
 110
 111     /* Parameter adjustments */
 112     a_dim1 = *lda;
 113     a_offset = 1 + a_dim1;
 114     a -= a_offset;
 115     --tau;
 116     --work;
 117
 118     /* Function Body */
 119     *info = 0;
 120     nb = ilaenv_(&c__1, "DORGQR", " ", m, n, k, &c_n1);
 121     lwkopt = max(1,*n) * nb;
 122     work[1] = (doublereal) lwkopt;
 123     lquery = *lwork == -1;
 124     if (*m < 0) {
 125         *info = -1;
 126     } else if (*n < 0 || *n > *m) {
 127         *info = -2;
 128     } else if (*k < 0 || *k > *n) {
 129         *info = -3;
 130     } else if (*lda < max(1,*m)) {
 131         *info = -5;
 132     } else if (*lwork < max(1,*n) && ! lquery) {
 133         *info = -8;
 134     }
 135     if (*info != 0) {
 136         i__1 = -(*info);
 137         xerbla_("DORGQR", &i__1);
 138         return 0;
 139     } else if (lquery) {
 140         return 0;
 141     }
 142
 143 /*     Quick return if possible */
 144
 145     if (*n <= 0) {
 146         work[1] = 1.;
 147         return 0;
 148     }
 149
 150     nbmin = 2;
 151     nx = 0;
 152     iws = *n;
 153     if (nb > 1 && nb < *k) {
 154
 155 /*        Determine when to cross over from blocked to unblocked code. */
 156
 157 /* Computing MAX */
 158         i__1 = 0, i__2 = ilaenv_(&c__3, "DORGQR", " ", m, n, k, &c_n1);
 159         nx = max(i__1,i__2);
 160         if (nx < *k) {
 161
 162 /*           Determine if workspace is large enough for blocked code. */
 163
 164             ldwork = *n;
 165             iws = ldwork * nb;
 166             if (*lwork < iws) {
 167
 168 /*              Not enough workspace to use optimal NB:  reduce NB and */
 169 /*              determine the minimum value of NB. */
 170
 171                 nb = *lwork / ldwork;
 172 /* Computing MAX */
 173                 i__1 = 2, i__2 = ilaenv_(&c__2, "DORGQR", " ", m, n, k, &c_n1);
 174                 nbmin = max(i__1,i__2);
 175             }
 176         }
 177     }
 178
 179     if (nb >= nbmin && nb < *k && nx < *k) {
 180
 181 /*        Use blocked code after the last block. */
 182 /*        The first kk columns are handled by the block method. */
 183
 184         ki = (*k - nx - 1) / nb * nb;
 185 /* Computing MIN */
 186         i__1 = *k, i__2 = ki + nb;
 187         kk = min(i__1,i__2);
 188
 189 /*        Set A(1:kk,kk+1:n) to zero. */
 190
 191         i__1 = *n;
 192         for (j = kk + 1; j <= i__1; ++j) {
 193             i__2 = kk;
 194             for (i__ = 1; i__ <= i__2; ++i__) {
 195                 a[i__ + j * a_dim1] = 0.;
 196 /* L10: */
 197             }
 198 /* L20: */
 199         }
 200     } else {
 201         kk = 0;
 202     }
 203
 204 /*     Use unblocked code for the last or only block. */
 205
 206     if (kk < *n) {
 207         i__1 = *m - kk;
 208         i__2 = *n - kk;
 209         i__3 = *k - kk;
 210         dorg2r_(&i__1, &i__2, &i__3, &a[kk + 1 + (kk + 1) * a_dim1], lda, &
 211                 tau[kk + 1], &work[1], &iinfo);
 212     }
 213
 214     if (kk > 0) {
 215
 216 /*        Use blocked code */
 217
 218         i__1 = -nb;
 219         for (i__ = ki + 1; i__1 < 0 ? i__ >= 1 : i__ <= 1; i__ += i__1) {
 220 /* Computing MIN */
 221             i__2 = nb, i__3 = *k - i__ + 1;
 222             ib = min(i__2,i__3);
 223             if (i__ + ib <= *n) {
 224
 225 /*              Form the triangular factor of the block reflector */
 226 /*              H = H(i) H(i+1) . . . H(i+ib-1) */
 227
 228                 i__2 = *m - i__ + 1;
 229                 dlarft_("Forward", "Columnwise", &i__2, &ib, &a[i__ + i__ *
 230                         a_dim1], lda, &tau[i__], &work[1], &ldwork);
 231
 232 /*              Apply H to A(i:m,i+ib:n) from the left */
 233
 234                 i__2 = *m - i__ + 1;
 235                 i__3 = *n - i__ - ib + 1;
 236                 dlarfb_("Left", "No transpose", "Forward", "Columnwise", &
 237                         i__2, &i__3, &ib, &a[i__ + i__ * a_dim1], lda, &work[
 238                         1], &ldwork, &a[i__ + (i__ + ib) * a_dim1], lda, &
 239                         work[ib + 1], &ldwork);
 240             }
 241
 242 /*           Apply H to rows i:m of current block */
 243
 244             i__2 = *m - i__ + 1;
 245             dorg2r_(&i__2, &ib, &ib, &a[i__ + i__ * a_dim1], lda, &tau[i__], &
 246                     work[1], &iinfo);
 247
 248 /*           Set rows 1:i-1 of current block to zero */
 249
 250             i__2 = i__ + ib - 1;
 251             for (j = i__; j <= i__2; ++j) {
 252                 i__3 = i__ - 1;
 253                 for (l = 1; l <= i__3; ++l) {
 254                     a[l + j * a_dim1] = 0.;
 255 /* L30: */
 256                 }
 257 /* L40: */
 258             }
 259 /* L50: */
 260         }
 261     }
 262
 263     work[1] = (doublereal) iws;
 264     return 0;
 265
 266 /*     End of DORGQR */
 267
 268 } /* dorgqr_ */