132 lines
4.5 KiB
C++
132 lines
4.5 KiB
C++
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
#include "lmp_f2c.h"
|
|
static integer c__1 = 1;
|
|
static integer c_n1 = -1;
|
|
static integer c__3 = 3;
|
|
static integer c__2 = 2;
|
|
int dorgql_(integer *m, integer *n, integer *k, doublereal *a, integer *lda, doublereal *tau,
|
|
doublereal *work, integer *lwork, integer *info)
|
|
{
|
|
integer a_dim1, a_offset, i__1, i__2, i__3, i__4;
|
|
integer i__, j, l, ib, nb, kk, nx, iws, nbmin, iinfo;
|
|
extern int dorg2l_(integer *, integer *, integer *, doublereal *, integer *, doublereal *,
|
|
doublereal *, integer *),
|
|
dlarfb_(char *, char *, char *, char *, integer *, integer *, integer *, doublereal *,
|
|
integer *, doublereal *, integer *, doublereal *, integer *, doublereal *,
|
|
integer *, ftnlen, ftnlen, ftnlen, ftnlen),
|
|
dlarft_(char *, char *, integer *, integer *, doublereal *, integer *, doublereal *,
|
|
doublereal *, integer *, ftnlen, ftnlen),
|
|
xerbla_(char *, integer *, ftnlen);
|
|
extern integer ilaenv_(integer *, char *, char *, integer *, integer *, integer *, integer *,
|
|
ftnlen, ftnlen);
|
|
integer ldwork, lwkopt;
|
|
logical lquery;
|
|
a_dim1 = *lda;
|
|
a_offset = 1 + a_dim1;
|
|
a -= a_offset;
|
|
--tau;
|
|
--work;
|
|
*info = 0;
|
|
lquery = *lwork == -1;
|
|
if (*m < 0) {
|
|
*info = -1;
|
|
} else if (*n < 0 || *n > *m) {
|
|
*info = -2;
|
|
} else if (*k < 0 || *k > *n) {
|
|
*info = -3;
|
|
} else if (*lda < max(1, *m)) {
|
|
*info = -5;
|
|
}
|
|
if (*info == 0) {
|
|
if (*n == 0) {
|
|
lwkopt = 1;
|
|
} else {
|
|
nb = ilaenv_(&c__1, (char *)"DORGQL", (char *)" ", m, n, k, &c_n1, (ftnlen)6, (ftnlen)1);
|
|
lwkopt = *n * nb;
|
|
}
|
|
work[1] = (doublereal)lwkopt;
|
|
if (*lwork < max(1, *n) && !lquery) {
|
|
*info = -8;
|
|
}
|
|
}
|
|
if (*info != 0) {
|
|
i__1 = -(*info);
|
|
xerbla_((char *)"DORGQL", &i__1, (ftnlen)6);
|
|
return 0;
|
|
} else if (lquery) {
|
|
return 0;
|
|
}
|
|
if (*n <= 0) {
|
|
return 0;
|
|
}
|
|
nbmin = 2;
|
|
nx = 0;
|
|
iws = *n;
|
|
if (nb > 1 && nb < *k) {
|
|
i__1 = 0, i__2 = ilaenv_(&c__3, (char *)"DORGQL", (char *)" ", m, n, k, &c_n1, (ftnlen)6, (ftnlen)1);
|
|
nx = max(i__1, i__2);
|
|
if (nx < *k) {
|
|
ldwork = *n;
|
|
iws = ldwork * nb;
|
|
if (*lwork < iws) {
|
|
nb = *lwork / ldwork;
|
|
i__1 = 2,
|
|
i__2 = ilaenv_(&c__2, (char *)"DORGQL", (char *)" ", m, n, k, &c_n1, (ftnlen)6, (ftnlen)1);
|
|
nbmin = max(i__1, i__2);
|
|
}
|
|
}
|
|
}
|
|
if (nb >= nbmin && nb < *k && nx < *k) {
|
|
i__1 = *k, i__2 = (*k - nx + nb - 1) / nb * nb;
|
|
kk = min(i__1, i__2);
|
|
i__1 = *n - kk;
|
|
for (j = 1; j <= i__1; ++j) {
|
|
i__2 = *m;
|
|
for (i__ = *m - kk + 1; i__ <= i__2; ++i__) {
|
|
a[i__ + j * a_dim1] = 0.;
|
|
}
|
|
}
|
|
} else {
|
|
kk = 0;
|
|
}
|
|
i__1 = *m - kk;
|
|
i__2 = *n - kk;
|
|
i__3 = *k - kk;
|
|
dorg2l_(&i__1, &i__2, &i__3, &a[a_offset], lda, &tau[1], &work[1], &iinfo);
|
|
if (kk > 0) {
|
|
i__1 = *k;
|
|
i__2 = nb;
|
|
for (i__ = *k - kk + 1; i__2 < 0 ? i__ >= i__1 : i__ <= i__1; i__ += i__2) {
|
|
i__3 = nb, i__4 = *k - i__ + 1;
|
|
ib = min(i__3, i__4);
|
|
if (*n - *k + i__ > 1) {
|
|
i__3 = *m - *k + i__ + ib - 1;
|
|
dlarft_((char *)"Backward", (char *)"Columnwise", &i__3, &ib, &a[(*n - *k + i__) * a_dim1 + 1], lda,
|
|
&tau[i__], &work[1], &ldwork, (ftnlen)8, (ftnlen)10);
|
|
i__3 = *m - *k + i__ + ib - 1;
|
|
i__4 = *n - *k + i__ - 1;
|
|
dlarfb_((char *)"Left", (char *)"No transpose", (char *)"Backward", (char *)"Columnwise", &i__3, &i__4, &ib,
|
|
&a[(*n - *k + i__) * a_dim1 + 1], lda, &work[1], &ldwork, &a[a_offset], lda,
|
|
&work[ib + 1], &ldwork, (ftnlen)4, (ftnlen)12, (ftnlen)8, (ftnlen)10);
|
|
}
|
|
i__3 = *m - *k + i__ + ib - 1;
|
|
dorg2l_(&i__3, &ib, &ib, &a[(*n - *k + i__) * a_dim1 + 1], lda, &tau[i__], &work[1],
|
|
&iinfo);
|
|
i__3 = *n - *k + i__ + ib - 1;
|
|
for (j = *n - *k + i__; j <= i__3; ++j) {
|
|
i__4 = *m;
|
|
for (l = *m - *k + i__ + ib; l <= i__4; ++l) {
|
|
a[l + j * a_dim1] = 0.;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
work[1] = (doublereal)iws;
|
|
return 0;
|
|
}
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|