"atomic bomb" commit. Reorganized OpenCV directory structure
This commit is contained in:
162
3rdparty/lapack/sorg2r.c
vendored
Normal file
162
3rdparty/lapack/sorg2r.c
vendored
Normal file
@@ -0,0 +1,162 @@
|
||||
#include "clapack.h"
|
||||
|
||||
/* Table of constant values */
|
||||
|
||||
static integer c__1 = 1;
|
||||
|
||||
/* Subroutine */ int sorg2r_(integer *m, integer *n, integer *k, real *a,
|
||||
integer *lda, real *tau, real *work, integer *info)
|
||||
{
|
||||
/* System generated locals */
|
||||
integer a_dim1, a_offset, i__1, i__2;
|
||||
real r__1;
|
||||
|
||||
/* Local variables */
|
||||
integer i__, j, l;
|
||||
extern /* Subroutine */ int sscal_(integer *, real *, real *, integer *),
|
||||
slarf_(char *, integer *, integer *, real *, integer *, real *,
|
||||
real *, integer *, real *), xerbla_(char *, integer *);
|
||||
|
||||
|
||||
/* -- LAPACK routine (version 3.1) -- */
|
||||
/* Univ. of Tennessee, Univ. of California Berkeley and NAG Ltd.. */
|
||||
/* November 2006 */
|
||||
|
||||
/* .. Scalar Arguments .. */
|
||||
/* .. */
|
||||
/* .. Array Arguments .. */
|
||||
/* .. */
|
||||
|
||||
/* Purpose */
|
||||
/* ======= */
|
||||
|
||||
/* SORG2R generates an m by n real matrix Q with orthonormal columns, */
|
||||
/* which is defined as the first n columns of a product of k elementary */
|
||||
/* reflectors of order m */
|
||||
|
||||
/* Q = H(1) H(2) . . . H(k) */
|
||||
|
||||
/* as returned by SGEQRF. */
|
||||
|
||||
/* Arguments */
|
||||
/* ========= */
|
||||
|
||||
/* M (input) INTEGER */
|
||||
/* The number of rows of the matrix Q. M >= 0. */
|
||||
|
||||
/* N (input) INTEGER */
|
||||
/* The number of columns of the matrix Q. M >= N >= 0. */
|
||||
|
||||
/* K (input) INTEGER */
|
||||
/* The number of elementary reflectors whose product defines the */
|
||||
/* matrix Q. N >= K >= 0. */
|
||||
|
||||
/* A (input/output) REAL array, dimension (LDA,N) */
|
||||
/* On entry, the i-th column must contain the vector which */
|
||||
/* defines the elementary reflector H(i), for i = 1,2,...,k, as */
|
||||
/* returned by SGEQRF in the first k columns of its array */
|
||||
/* argument A. */
|
||||
/* On exit, the m-by-n matrix Q. */
|
||||
|
||||
/* LDA (input) INTEGER */
|
||||
/* The first dimension of the array A. LDA >= max(1,M). */
|
||||
|
||||
/* TAU (input) REAL array, dimension (K) */
|
||||
/* TAU(i) must contain the scalar factor of the elementary */
|
||||
/* reflector H(i), as returned by SGEQRF. */
|
||||
|
||||
/* WORK (workspace) REAL array, dimension (N) */
|
||||
|
||||
/* INFO (output) INTEGER */
|
||||
/* = 0: successful exit */
|
||||
/* < 0: if INFO = -i, the i-th argument has an illegal value */
|
||||
|
||||
/* ===================================================================== */
|
||||
|
||||
/* .. Parameters .. */
|
||||
/* .. */
|
||||
/* .. Local Scalars .. */
|
||||
/* .. */
|
||||
/* .. External Subroutines .. */
|
||||
/* .. */
|
||||
/* .. Intrinsic Functions .. */
|
||||
/* .. */
|
||||
/* .. Executable Statements .. */
|
||||
|
||||
/* Test the input arguments */
|
||||
|
||||
/* Parameter adjustments */
|
||||
a_dim1 = *lda;
|
||||
a_offset = 1 + a_dim1;
|
||||
a -= a_offset;
|
||||
--tau;
|
||||
--work;
|
||||
|
||||
/* Function Body */
|
||||
*info = 0;
|
||||
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) {
|
||||
i__1 = -(*info);
|
||||
xerbla_("SORG2R", &i__1);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Quick return if possible */
|
||||
|
||||
if (*n <= 0) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Initialise columns k+1:n to columns of the unit matrix */
|
||||
|
||||
i__1 = *n;
|
||||
for (j = *k + 1; j <= i__1; ++j) {
|
||||
i__2 = *m;
|
||||
for (l = 1; l <= i__2; ++l) {
|
||||
a[l + j * a_dim1] = 0.f;
|
||||
/* L10: */
|
||||
}
|
||||
a[j + j * a_dim1] = 1.f;
|
||||
/* L20: */
|
||||
}
|
||||
|
||||
for (i__ = *k; i__ >= 1; --i__) {
|
||||
|
||||
/* Apply H(i) to A(i:m,i:n) from the left */
|
||||
|
||||
if (i__ < *n) {
|
||||
a[i__ + i__ * a_dim1] = 1.f;
|
||||
i__1 = *m - i__ + 1;
|
||||
i__2 = *n - i__;
|
||||
slarf_("Left", &i__1, &i__2, &a[i__ + i__ * a_dim1], &c__1, &tau[
|
||||
i__], &a[i__ + (i__ + 1) * a_dim1], lda, &work[1]);
|
||||
}
|
||||
if (i__ < *m) {
|
||||
i__1 = *m - i__;
|
||||
r__1 = -tau[i__];
|
||||
sscal_(&i__1, &r__1, &a[i__ + 1 + i__ * a_dim1], &c__1);
|
||||
}
|
||||
a[i__ + i__ * a_dim1] = 1.f - tau[i__];
|
||||
|
||||
/* Set A(1:i-1,i) to zero */
|
||||
|
||||
i__1 = i__ - 1;
|
||||
for (l = 1; l <= i__1; ++l) {
|
||||
a[l + i__ * a_dim1] = 0.f;
|
||||
/* L30: */
|
||||
}
|
||||
/* L40: */
|
||||
}
|
||||
return 0;
|
||||
|
||||
/* End of SORG2R */
|
||||
|
||||
} /* sorg2r_ */
|
Reference in New Issue
Block a user