mirror of
https://gitlab.com/libeigen/eigen.git
synced 2026-04-10 11:34:33 +08:00
Vectorize BLAS level 1/2 routines with Eigen expressions
libeigen/eigen!2404 Co-authored-by: Rasmus Munk Larsen <rmlarsen@gmail.com>
This commit is contained in:
@@ -25,15 +25,19 @@ struct functor_traits<scalar_norm1_op> {
|
|||||||
// computes the sum of magnitudes of all vector elements or, for a complex vector x, the sum
|
// computes the sum of magnitudes of all vector elements or, for a complex vector x, the sum
|
||||||
// res = |Rex1| + |Imx1| + |Rex2| + |Imx2| + ... + |Rexn| + |Imxn|, where x is a vector of order n
|
// res = |Rex1| + |Imx1| + |Rex2| + |Imx2| + ... + |Rexn| + |Imxn|, where x is a vector of order n
|
||||||
extern "C" RealScalar EIGEN_CAT(REAL_SCALAR_SUFFIX, EIGEN_BLAS_FUNC_NAME(asum))(int *n, RealScalar *px, int *incx) {
|
extern "C" RealScalar EIGEN_CAT(REAL_SCALAR_SUFFIX, EIGEN_BLAS_FUNC_NAME(asum))(int *n, RealScalar *px, int *incx) {
|
||||||
// std::cerr << "__asum " << *n << " " << *incx << "\n";
|
|
||||||
Complex *x = reinterpret_cast<Complex *>(px);
|
|
||||||
|
|
||||||
if (*n <= 0) return 0;
|
if (*n <= 0) return 0;
|
||||||
|
|
||||||
|
// std::complex<T> is layout-compatible with T[2], so we can reinterpret
|
||||||
|
// a complex vector of length n as a real vector of length 2*n and use
|
||||||
|
// the fully vectorized cwiseAbs().sum() path.
|
||||||
if (*incx == 1)
|
if (*incx == 1)
|
||||||
return make_vector(x, *n).unaryExpr<scalar_norm1_op>().sum();
|
return make_vector(px, 2 * *n).cwiseAbs().sum();
|
||||||
else
|
else {
|
||||||
|
// For non-unit stride, fall back to the scalar_norm1_op approach since
|
||||||
|
// the real components are not contiguous across complex elements.
|
||||||
|
Complex *x = reinterpret_cast<Complex *>(px);
|
||||||
return make_vector(x, *n, std::abs(*incx)).unaryExpr<scalar_norm1_op>().sum();
|
return make_vector(x, *n, std::abs(*incx)).unaryExpr<scalar_norm1_op>().sum();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
extern "C" int EIGEN_CAT(i, EIGEN_BLAS_FUNC_NAME(amax))(int *n, RealScalar *px, int *incx) {
|
extern "C" int EIGEN_CAT(i, EIGEN_BLAS_FUNC_NAME(amax))(int *n, RealScalar *px, int *incx) {
|
||||||
|
|||||||
@@ -69,15 +69,21 @@ EIGEN_BLAS_FUNC(copy)(int *n, RealScalar *px, int *incx, RealScalar *py, int *in
|
|||||||
// be careful, *incx==0 is allowed !!
|
// be careful, *incx==0 is allowed !!
|
||||||
if (*incx == 1 && *incy == 1)
|
if (*incx == 1 && *incy == 1)
|
||||||
make_vector(y, *n) = make_vector(x, *n);
|
make_vector(y, *n) = make_vector(x, *n);
|
||||||
else {
|
else if (*incx == 0) {
|
||||||
if (*incx < 0) x = x - (*n - 1) * (*incx);
|
// Broadcast: copy x[0] to all elements of y.
|
||||||
if (*incy < 0) y = y - (*n - 1) * (*incy);
|
if (*incy < 0) y = y - (*n - 1) * (*incy);
|
||||||
for (int i = 0; i < *n; ++i) {
|
for (int i = 0; i < *n; ++i) {
|
||||||
*y = *x;
|
*y = *x;
|
||||||
x += *incx;
|
|
||||||
y += *incy;
|
y += *incy;
|
||||||
}
|
}
|
||||||
}
|
} else if (*incx > 0 && *incy > 0)
|
||||||
|
make_vector(y, *n, *incy) = make_vector(x, *n, *incx);
|
||||||
|
else if (*incx > 0 && *incy < 0)
|
||||||
|
make_vector(y, *n, -*incy).reverse() = make_vector(x, *n, *incx);
|
||||||
|
else if (*incx < 0 && *incy > 0)
|
||||||
|
make_vector(y, *n, *incy) = make_vector(x, *n, -*incx).reverse();
|
||||||
|
else if (*incx < 0 && *incy < 0)
|
||||||
|
make_vector(y, *n, -*incy) = make_vector(x, *n, -*incx);
|
||||||
}
|
}
|
||||||
|
|
||||||
EIGEN_BLAS_FUNC(rotg)(RealScalar *pa, RealScalar *pb, RealScalar *pc, RealScalar *ps) {
|
EIGEN_BLAS_FUNC(rotg)(RealScalar *pa, RealScalar *pb, RealScalar *pc, RealScalar *ps) {
|
||||||
|
|||||||
@@ -58,23 +58,21 @@ extern "C" Scalar EIGEN_BLAS_FUNC_NAME(dot)(int *n, Scalar *px, int *incx, Scala
|
|||||||
Scalar *y = reinterpret_cast<Scalar *>(py);
|
Scalar *y = reinterpret_cast<Scalar *>(py);
|
||||||
|
|
||||||
if (*incx == 1 && *incy == 1)
|
if (*incx == 1 && *incy == 1)
|
||||||
return (make_vector(x, *n).cwiseProduct(make_vector(y, *n))).sum();
|
return make_vector(x, *n).dot(make_vector(y, *n));
|
||||||
else if (*incx > 0 && *incy > 0)
|
else if (*incx > 0 && *incy > 0)
|
||||||
return (make_vector(x, *n, *incx).cwiseProduct(make_vector(y, *n, *incy))).sum();
|
return make_vector(x, *n, *incx).dot(make_vector(y, *n, *incy));
|
||||||
else if (*incx < 0 && *incy > 0)
|
else if (*incx < 0 && *incy > 0)
|
||||||
return (make_vector(x, *n, -*incx).reverse().cwiseProduct(make_vector(y, *n, *incy))).sum();
|
return make_vector(x, *n, -*incx).reverse().dot(make_vector(y, *n, *incy));
|
||||||
else if (*incx > 0 && *incy < 0)
|
else if (*incx > 0 && *incy < 0)
|
||||||
return (make_vector(x, *n, *incx).cwiseProduct(make_vector(y, *n, -*incy).reverse())).sum();
|
return make_vector(x, *n, *incx).dot(make_vector(y, *n, -*incy).reverse());
|
||||||
else if (*incx < 0 && *incy < 0)
|
else if (*incx < 0 && *incy < 0)
|
||||||
return (make_vector(x, *n, -*incx).reverse().cwiseProduct(make_vector(y, *n, -*incy).reverse())).sum();
|
return make_vector(x, *n, -*incx).reverse().dot(make_vector(y, *n, -*incy).reverse());
|
||||||
else
|
else
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
// computes the Euclidean norm of a vector.
|
// computes the Euclidean norm of a vector.
|
||||||
// FIXME
|
|
||||||
extern "C" Scalar EIGEN_BLAS_FUNC_NAME(nrm2)(int *n, Scalar *px, int *incx) {
|
extern "C" Scalar EIGEN_BLAS_FUNC_NAME(nrm2)(int *n, Scalar *px, int *incx) {
|
||||||
// std::cerr << "_nrm2 " << *n << " " << *incx << "\n";
|
|
||||||
if (*n <= 0) return 0;
|
if (*n <= 0) return 0;
|
||||||
|
|
||||||
Scalar *x = reinterpret_cast<Scalar *>(px);
|
Scalar *x = reinterpret_cast<Scalar *>(px);
|
||||||
|
|||||||
@@ -106,64 +106,79 @@ EIGEN_BLAS_FUNC(hbmv)
|
|||||||
|
|
||||||
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
||||||
|
|
||||||
int kx = *incx > 0 ? 0 : (1 - *n) * *incx;
|
const Scalar *actual_x = get_compact_vector(x, *n, *incx);
|
||||||
int ky = *incy > 0 ? 0 : (1 - *n) * *incy;
|
Scalar *actual_y = get_compact_vector(y, *n, *incy);
|
||||||
|
|
||||||
// First form y := beta*y.
|
// First form y := beta*y.
|
||||||
if (beta != Scalar(1)) {
|
if (beta != Scalar(1)) {
|
||||||
int iy = ky;
|
if (beta == Scalar(0))
|
||||||
for (int i = 0; i < *n; ++i) {
|
make_vector(actual_y, *n).setZero();
|
||||||
y[iy] = (beta == Scalar(0)) ? Scalar(0) : beta * y[iy];
|
else
|
||||||
iy += *incy;
|
make_vector(actual_y, *n) *= beta;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (alpha == Scalar(0)) return;
|
if (alpha == Scalar(0)) {
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (UPLO(*uplo) == UP) {
|
if (*k >= 8) {
|
||||||
// Upper triangle: A[i,j] at a[(k+i-j) + j*lda], diagonal at row k.
|
// Vectorized path: use Eigen Map segments for the inner band operations.
|
||||||
int jx = kx, jy = ky;
|
ConstMatrixType band(a, *k + 1, *n, *lda);
|
||||||
for (int j = 0; j < *n; ++j) {
|
if (UPLO(*uplo) == UP) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp2 = Scalar(0);
|
int start = std::max(0, j - *k);
|
||||||
int ix = kx, iy = ky;
|
int len = j - start;
|
||||||
for (int i = std::max(0, j - *k); i < j; ++i) {
|
int offset = *k - (j - start);
|
||||||
Scalar aij = a[(*k + i - j) + j * *lda];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
y[iy] += temp1 * aij;
|
actual_y[j] += Scalar(Eigen::numext::real(band(*k, j))) * temp1;
|
||||||
temp2 += Eigen::numext::conj(aij) * x[ix];
|
if (len > 0) {
|
||||||
ix += *incx;
|
make_vector(actual_y + start, len) += temp1 * band.col(j).segment(offset, len);
|
||||||
iy += *incy;
|
actual_y[j] += alpha * band.col(j).segment(offset, len).dot(make_vector(actual_x + start, len));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
// Diagonal is real.
|
} else {
|
||||||
y[jy] += Scalar(Eigen::numext::real(a[*k + j * *lda])) * temp1 + alpha * temp2;
|
for (int j = 0; j < *n; ++j) {
|
||||||
jx += *incx;
|
int len = std::min(*n - 1, j + *k) - j;
|
||||||
jy += *incy;
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
if (j >= *k) {
|
actual_y[j] += Scalar(Eigen::numext::real(band(0, j))) * temp1;
|
||||||
kx += *incx;
|
if (len > 0) {
|
||||||
ky += *incy;
|
make_vector(actual_y + j + 1, len) += temp1 * band.col(j).segment(1, len);
|
||||||
|
actual_y[j] += alpha * band.col(j).segment(1, len).dot(make_vector(actual_x + j + 1, len));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Lower triangle: A[i,j] at a[(i-j) + j*lda], diagonal at row 0.
|
// Scalar path: for narrow bandwidth, avoid Map overhead.
|
||||||
int jx = kx, jy = ky;
|
if (UPLO(*uplo) == UP) {
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
Scalar temp2 = Scalar(0);
|
Scalar temp2 = Scalar(0);
|
||||||
// Diagonal is real.
|
for (int i = std::max(0, j - *k); i < j; ++i) {
|
||||||
y[jy] += Scalar(Eigen::numext::real(a[j * *lda])) * temp1;
|
Scalar aij = a[(*k + i - j) + j * *lda];
|
||||||
int ix = jx, iy = jy;
|
actual_y[i] += temp1 * aij;
|
||||||
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) {
|
temp2 += Eigen::numext::conj(aij) * actual_x[i];
|
||||||
ix += *incx;
|
}
|
||||||
iy += *incy;
|
actual_y[j] += Scalar(Eigen::numext::real(a[*k + j * *lda])) * temp1 + alpha * temp2;
|
||||||
Scalar aij = a[(i - j) + j * *lda];
|
}
|
||||||
y[iy] += temp1 * aij;
|
} else {
|
||||||
temp2 += Eigen::numext::conj(aij) * x[ix];
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
|
Scalar temp2 = Scalar(0);
|
||||||
|
actual_y[j] += Scalar(Eigen::numext::real(a[j * *lda])) * temp1;
|
||||||
|
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) {
|
||||||
|
Scalar aij = a[(i - j) + j * *lda];
|
||||||
|
actual_y[i] += temp1 * aij;
|
||||||
|
temp2 += Eigen::numext::conj(aij) * actual_x[i];
|
||||||
|
}
|
||||||
|
actual_y[j] += alpha * temp2;
|
||||||
}
|
}
|
||||||
y[jy] += alpha * temp2;
|
|
||||||
jx += *incx;
|
|
||||||
jy += *incy;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
}
|
}
|
||||||
|
|
||||||
/** HPMV performs the matrix-vector operation
|
/** HPMV performs the matrix-vector operation
|
||||||
@@ -196,61 +211,53 @@ EIGEN_BLAS_FUNC(hpmv)
|
|||||||
|
|
||||||
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
||||||
|
|
||||||
int kx = *incx > 0 ? 0 : (1 - *n) * *incx;
|
const Scalar *actual_x = get_compact_vector(x, *n, *incx);
|
||||||
int ky = *incy > 0 ? 0 : (1 - *n) * *incy;
|
Scalar *actual_y = get_compact_vector(y, *n, *incy);
|
||||||
|
|
||||||
// First form y := beta*y.
|
// First form y := beta*y.
|
||||||
if (beta != Scalar(1)) {
|
if (beta != Scalar(1)) {
|
||||||
int iy = ky;
|
if (beta == Scalar(0))
|
||||||
for (int i = 0; i < *n; ++i) {
|
make_vector(actual_y, *n).setZero();
|
||||||
y[iy] = (beta == Scalar(0)) ? Scalar(0) : beta * y[iy];
|
else
|
||||||
iy += *incy;
|
make_vector(actual_y, *n) *= beta;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (alpha == Scalar(0)) return;
|
if (alpha == Scalar(0)) {
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
int kk = 0;
|
int kk = 0;
|
||||||
if (UPLO(*uplo) == UP) {
|
if (UPLO(*uplo) == UP) {
|
||||||
// Upper triangle packed.
|
// Upper triangle packed: column j occupies ap[kk..kk+j].
|
||||||
int jx = kx, jy = ky;
|
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
Scalar temp2 = Scalar(0);
|
|
||||||
int ix = kx, iy = ky;
|
|
||||||
for (int i = 0; i < j; ++i) {
|
|
||||||
y[iy] += temp1 * ap[kk + i];
|
|
||||||
temp2 += Eigen::numext::conj(ap[kk + i]) * x[ix];
|
|
||||||
ix += *incx;
|
|
||||||
iy += *incy;
|
|
||||||
}
|
|
||||||
// Diagonal is real.
|
// Diagonal is real.
|
||||||
y[jy] += Scalar(Eigen::numext::real(ap[kk + j])) * temp1 + alpha * temp2;
|
actual_y[j] += Scalar(Eigen::numext::real(ap[kk + j])) * temp1;
|
||||||
jx += *incx;
|
if (j > 0) {
|
||||||
jy += *incy;
|
make_vector(actual_y, j) += temp1 * make_vector(ap + kk, j);
|
||||||
|
actual_y[j] += alpha * make_vector(ap + kk, j).dot(make_vector(actual_x, j));
|
||||||
|
}
|
||||||
kk += j + 1;
|
kk += j + 1;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Lower triangle packed.
|
// Lower triangle packed: column j occupies ap[kk..kk+(n-j-1)].
|
||||||
int jx = kx, jy = ky;
|
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
int len = *n - j - 1;
|
||||||
Scalar temp2 = Scalar(0);
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
// Diagonal is real.
|
// Diagonal is real.
|
||||||
y[jy] += Scalar(Eigen::numext::real(ap[kk])) * temp1;
|
actual_y[j] += Scalar(Eigen::numext::real(ap[kk])) * temp1;
|
||||||
int ix = jx, iy = jy;
|
if (len > 0) {
|
||||||
for (int i = 1; i < *n - j; ++i) {
|
make_vector(actual_y + j + 1, len) += temp1 * make_vector(ap + kk + 1, len);
|
||||||
ix += *incx;
|
actual_y[j] += alpha * make_vector(ap + kk + 1, len).dot(make_vector(actual_x + j + 1, len));
|
||||||
iy += *incy;
|
|
||||||
y[iy] += temp1 * ap[kk + i];
|
|
||||||
temp2 += Eigen::numext::conj(ap[kk + i]) * x[ix];
|
|
||||||
}
|
}
|
||||||
y[jy] += alpha * temp2;
|
|
||||||
jx += *incx;
|
|
||||||
jy += *incy;
|
|
||||||
kk += *n - j;
|
kk += *n - j;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
}
|
}
|
||||||
|
|
||||||
/** ZHPR performs the hermitian rank 1 operation
|
/** ZHPR performs the hermitian rank 1 operation
|
||||||
|
|||||||
@@ -343,46 +343,112 @@ EIGEN_BLAS_FUNC(tbmv)
|
|||||||
int op = OP(*opa);
|
int op = OP(*opa);
|
||||||
bool unit = (DIAG(*diag) == UNIT);
|
bool unit = (DIAG(*diag) == UNIT);
|
||||||
|
|
||||||
if (op == NOTR) {
|
if (*k >= 8) {
|
||||||
if (upper) {
|
// Vectorized path: use Eigen Map segments for the inner band operations.
|
||||||
// x := A*x, upper band. Process columns left to right.
|
ConstMatrixType band(a, *k + 1, *n, *lda);
|
||||||
for (int j = 0; j < *n; ++j) {
|
if (op == NOTR) {
|
||||||
if (actual_x[j] != Scalar(0)) {
|
if (upper) {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
if (actual_x[j] != Scalar(0)) {
|
||||||
|
int start = std::max(0, j - *k);
|
||||||
|
int len = j - start;
|
||||||
|
int offset = *k - (j - start);
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
if (len > 0) make_vector(actual_x + start, len) += temp * band.col(j).segment(offset, len);
|
||||||
|
if (!unit) actual_x[j] = temp * band(*k, j);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
for (int j = *n - 1; j >= 0; --j) {
|
||||||
|
if (actual_x[j] != Scalar(0)) {
|
||||||
|
int len = std::min(*n - 1, j + *k) - j;
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
if (len > 0) make_vector(actual_x + j + 1, len) += temp * band.col(j).segment(1, len);
|
||||||
|
if (!unit) actual_x[j] = temp * band(0, j);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else if (op == TR) {
|
||||||
|
if (upper) {
|
||||||
|
for (int j = *n - 1; j >= 0; --j) {
|
||||||
|
int start = std::max(0, j - *k);
|
||||||
|
int len = j - start;
|
||||||
|
int offset = *k - (j - start);
|
||||||
Scalar temp = actual_x[j];
|
Scalar temp = actual_x[j];
|
||||||
for (int i = std::max(0, j - *k); i < j; ++i) actual_x[i] += temp * a[(*k + i - j) + j * *lda];
|
if (!unit) temp *= band(*k, j);
|
||||||
if (!unit) actual_x[j] = temp * a[*k + j * *lda];
|
if (len > 0)
|
||||||
|
temp += (band.col(j).segment(offset, len).cwiseProduct(make_vector(actual_x + start, len))).sum();
|
||||||
|
actual_x[j] = temp;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
int len = std::min(*n - 1, j + *k) - j;
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
if (!unit) temp *= band(0, j);
|
||||||
|
if (len > 0) temp += (band.col(j).segment(1, len).cwiseProduct(make_vector(actual_x + j + 1, len))).sum();
|
||||||
|
actual_x[j] = temp;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// x := A*x, lower band. Process columns right to left.
|
// Conjugate transpose: .dot() computes conj(lhs) . rhs.
|
||||||
for (int j = *n - 1; j >= 0; --j) {
|
if (upper) {
|
||||||
if (actual_x[j] != Scalar(0)) {
|
for (int j = *n - 1; j >= 0; --j) {
|
||||||
|
int start = std::max(0, j - *k);
|
||||||
|
int len = j - start;
|
||||||
|
int offset = *k - (j - start);
|
||||||
Scalar temp = actual_x[j];
|
Scalar temp = actual_x[j];
|
||||||
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) actual_x[i] += temp * a[(i - j) + j * *lda];
|
if (!unit) temp *= Eigen::numext::conj(band(*k, j));
|
||||||
if (!unit) actual_x[j] = temp * a[j * *lda];
|
if (len > 0) temp += band.col(j).segment(offset, len).dot(make_vector(actual_x + start, len));
|
||||||
|
actual_x[j] = temp;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
int len = std::min(*n - 1, j + *k) - j;
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
if (!unit) temp *= Eigen::numext::conj(band(0, j));
|
||||||
|
if (len > 0) temp += band.col(j).segment(1, len).dot(make_vector(actual_x + j + 1, len));
|
||||||
|
actual_x[j] = temp;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Transpose or conjugate transpose.
|
// Scalar path: for narrow bandwidth, avoid Map overhead.
|
||||||
bool do_conj = (op == ADJ);
|
if (op == NOTR) {
|
||||||
auto maybe_conj = [do_conj](Scalar val) -> Scalar { return do_conj ? Eigen::numext::conj(val) : val; };
|
if (upper) {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
if (upper) {
|
if (actual_x[j] != Scalar(0)) {
|
||||||
// x := op(A)*x, upper band. Process columns right to left.
|
Scalar temp = actual_x[j];
|
||||||
for (int j = *n - 1; j >= 0; --j) {
|
for (int i = std::max(0, j - *k); i < j; ++i) actual_x[i] += temp * a[(*k + i - j) + j * *lda];
|
||||||
Scalar temp = actual_x[j];
|
if (!unit) actual_x[j] = temp * a[*k + j * *lda];
|
||||||
if (!unit) temp *= maybe_conj(a[*k + j * *lda]);
|
}
|
||||||
for (int i = std::max(0, j - *k); i < j; ++i) temp += maybe_conj(a[(*k + i - j) + j * *lda]) * actual_x[i];
|
}
|
||||||
actual_x[j] = temp;
|
} else {
|
||||||
|
for (int j = *n - 1; j >= 0; --j) {
|
||||||
|
if (actual_x[j] != Scalar(0)) {
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) actual_x[i] += temp * a[(i - j) + j * *lda];
|
||||||
|
if (!unit) actual_x[j] = temp * a[j * *lda];
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// x := op(A)*x, lower band. Process columns left to right.
|
// Transpose or conjugate transpose.
|
||||||
for (int j = 0; j < *n; ++j) {
|
auto maybe_conj = [op](Scalar val) -> Scalar { return op == ADJ ? Eigen::numext::conj(val) : val; };
|
||||||
Scalar temp = actual_x[j];
|
if (upper) {
|
||||||
if (!unit) temp *= maybe_conj(a[j * *lda]);
|
for (int j = *n - 1; j >= 0; --j) {
|
||||||
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) temp += maybe_conj(a[(i - j) + j * *lda]) * actual_x[i];
|
Scalar temp = actual_x[j];
|
||||||
actual_x[j] = temp;
|
if (!unit) temp *= maybe_conj(a[*k + j * *lda]);
|
||||||
|
for (int i = std::max(0, j - *k); i < j; ++i) temp += maybe_conj(a[(*k + i - j) + j * *lda]) * actual_x[i];
|
||||||
|
actual_x[j] = temp;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
Scalar temp = actual_x[j];
|
||||||
|
if (!unit) temp *= maybe_conj(a[j * *lda]);
|
||||||
|
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i)
|
||||||
|
temp += maybe_conj(a[(i - j) + j * *lda]) * actual_x[i];
|
||||||
|
actual_x[j] = temp;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -194,62 +194,79 @@ EIGEN_BLAS_FUNC(sbmv)
|
|||||||
|
|
||||||
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
||||||
|
|
||||||
int kx = *incx > 0 ? 0 : (1 - *n) * *incx;
|
const Scalar *actual_x = get_compact_vector(x, *n, *incx);
|
||||||
int ky = *incy > 0 ? 0 : (1 - *n) * *incy;
|
Scalar *actual_y = get_compact_vector(y, *n, *incy);
|
||||||
|
|
||||||
// First form y := beta*y.
|
// First form y := beta*y.
|
||||||
if (beta != Scalar(1)) {
|
if (beta != Scalar(1)) {
|
||||||
int iy = ky;
|
if (beta == Scalar(0))
|
||||||
for (int i = 0; i < *n; ++i) {
|
make_vector(actual_y, *n).setZero();
|
||||||
y[iy] = (beta == Scalar(0)) ? Scalar(0) : beta * y[iy];
|
else
|
||||||
iy += *incy;
|
make_vector(actual_y, *n) *= beta;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (alpha == Scalar(0)) return;
|
if (alpha == Scalar(0)) {
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (UPLO(*uplo) == UP) {
|
if (*k >= 8) {
|
||||||
// Upper triangle: A[i,j] at a[(k+i-j) + j*lda], diagonal at row k.
|
// Vectorized path: use Eigen Map segments for the inner band operations.
|
||||||
int jx = kx, jy = ky;
|
ConstMatrixType band(a, *k + 1, *n, *lda);
|
||||||
for (int j = 0; j < *n; ++j) {
|
if (UPLO(*uplo) == UP) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp2 = Scalar(0);
|
int start = std::max(0, j - *k);
|
||||||
int ix = kx, iy = ky;
|
int len = j - start;
|
||||||
for (int i = std::max(0, j - *k); i < j; ++i) {
|
int offset = *k - (j - start);
|
||||||
Scalar aij = a[(*k + i - j) + j * *lda];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
y[iy] += temp1 * aij;
|
actual_y[j] += temp1 * band(*k, j);
|
||||||
temp2 += aij * x[ix];
|
if (len > 0) {
|
||||||
ix += *incx;
|
make_vector(actual_y + start, len) += temp1 * band.col(j).segment(offset, len);
|
||||||
iy += *incy;
|
actual_y[j] += alpha * band.col(j).segment(offset, len).dot(make_vector(actual_x + start, len));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
y[jy] += temp1 * a[*k + j * *lda] + alpha * temp2;
|
} else {
|
||||||
jx += *incx;
|
for (int j = 0; j < *n; ++j) {
|
||||||
jy += *incy;
|
int len = std::min(*n - 1, j + *k) - j;
|
||||||
if (j >= *k) {
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
kx += *incx;
|
actual_y[j] += temp1 * band(0, j);
|
||||||
ky += *incy;
|
if (len > 0) {
|
||||||
|
make_vector(actual_y + j + 1, len) += temp1 * band.col(j).segment(1, len);
|
||||||
|
actual_y[j] += alpha * band.col(j).segment(1, len).dot(make_vector(actual_x + j + 1, len));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Lower triangle: A[i,j] at a[(i-j) + j*lda], diagonal at row 0.
|
// Scalar path: for narrow bandwidth, avoid Map overhead.
|
||||||
int jx = kx, jy = ky;
|
if (UPLO(*uplo) == UP) {
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
Scalar temp2 = Scalar(0);
|
Scalar temp2 = Scalar(0);
|
||||||
y[jy] += temp1 * a[j * *lda];
|
for (int i = std::max(0, j - *k); i < j; ++i) {
|
||||||
int ix = jx, iy = jy;
|
Scalar aij = a[(*k + i - j) + j * *lda];
|
||||||
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) {
|
actual_y[i] += temp1 * aij;
|
||||||
ix += *incx;
|
temp2 += aij * actual_x[i];
|
||||||
iy += *incy;
|
}
|
||||||
Scalar aij = a[(i - j) + j * *lda];
|
actual_y[j] += temp1 * a[*k + j * *lda] + alpha * temp2;
|
||||||
y[iy] += temp1 * aij;
|
}
|
||||||
temp2 += aij * x[ix];
|
} else {
|
||||||
|
for (int j = 0; j < *n; ++j) {
|
||||||
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
|
Scalar temp2 = Scalar(0);
|
||||||
|
actual_y[j] += temp1 * a[j * *lda];
|
||||||
|
for (int i = j + 1; i <= std::min(*n - 1, j + *k); ++i) {
|
||||||
|
Scalar aij = a[(i - j) + j * *lda];
|
||||||
|
actual_y[i] += temp1 * aij;
|
||||||
|
temp2 += aij * actual_x[i];
|
||||||
|
}
|
||||||
|
actual_y[j] += alpha * temp2;
|
||||||
}
|
}
|
||||||
y[jy] += alpha * temp2;
|
|
||||||
jx += *incx;
|
|
||||||
jy += *incy;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
}
|
}
|
||||||
|
|
||||||
/** SPMV performs the matrix-vector operation
|
/** SPMV performs the matrix-vector operation
|
||||||
@@ -285,59 +302,51 @@ EIGEN_BLAS_FUNC(spmv)
|
|||||||
|
|
||||||
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
if (*n == 0 || (alpha == Scalar(0) && beta == Scalar(1))) return;
|
||||||
|
|
||||||
int kx = *incx > 0 ? 0 : (1 - *n) * *incx;
|
const Scalar *actual_x = get_compact_vector(x, *n, *incx);
|
||||||
int ky = *incy > 0 ? 0 : (1 - *n) * *incy;
|
Scalar *actual_y = get_compact_vector(y, *n, *incy);
|
||||||
|
|
||||||
// First form y := beta*y.
|
// First form y := beta*y.
|
||||||
if (beta != Scalar(1)) {
|
if (beta != Scalar(1)) {
|
||||||
int iy = ky;
|
if (beta == Scalar(0))
|
||||||
for (int i = 0; i < *n; ++i) {
|
make_vector(actual_y, *n).setZero();
|
||||||
y[iy] = (beta == Scalar(0)) ? Scalar(0) : beta * y[iy];
|
else
|
||||||
iy += *incy;
|
make_vector(actual_y, *n) *= beta;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (alpha == Scalar(0)) return;
|
if (alpha == Scalar(0)) {
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
int kk = 0;
|
int kk = 0;
|
||||||
if (UPLO(*uplo) == UP) {
|
if (UPLO(*uplo) == UP) {
|
||||||
// Upper triangle packed.
|
// Upper triangle packed: column j occupies ap[kk..kk+j].
|
||||||
int jx = kx, jy = ky;
|
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
Scalar temp2 = Scalar(0);
|
actual_y[j] += temp1 * ap[kk + j];
|
||||||
int ix = kx, iy = ky;
|
if (j > 0) {
|
||||||
for (int i = 0; i < j; ++i) {
|
make_vector(actual_y, j) += temp1 * make_vector(ap + kk, j);
|
||||||
y[iy] += temp1 * ap[kk + i];
|
actual_y[j] += alpha * make_vector(ap + kk, j).dot(make_vector(actual_x, j));
|
||||||
temp2 += ap[kk + i] * x[ix];
|
|
||||||
ix += *incx;
|
|
||||||
iy += *incy;
|
|
||||||
}
|
}
|
||||||
y[jy] += temp1 * ap[kk + j] + alpha * temp2;
|
|
||||||
jx += *incx;
|
|
||||||
jy += *incy;
|
|
||||||
kk += j + 1;
|
kk += j + 1;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Lower triangle packed.
|
// Lower triangle packed: column j occupies ap[kk..kk+(n-j-1)].
|
||||||
int jx = kx, jy = ky;
|
|
||||||
for (int j = 0; j < *n; ++j) {
|
for (int j = 0; j < *n; ++j) {
|
||||||
Scalar temp1 = alpha * x[jx];
|
int len = *n - j - 1;
|
||||||
Scalar temp2 = Scalar(0);
|
Scalar temp1 = alpha * actual_x[j];
|
||||||
y[jy] += temp1 * ap[kk];
|
actual_y[j] += temp1 * ap[kk];
|
||||||
int ix = jx, iy = jy;
|
if (len > 0) {
|
||||||
for (int i = 1; i < *n - j; ++i) {
|
make_vector(actual_y + j + 1, len) += temp1 * make_vector(ap + kk + 1, len);
|
||||||
ix += *incx;
|
actual_y[j] += alpha * make_vector(ap + kk + 1, len).dot(make_vector(actual_x + j + 1, len));
|
||||||
iy += *incy;
|
|
||||||
y[iy] += temp1 * ap[kk + i];
|
|
||||||
temp2 += ap[kk + i] * x[ix];
|
|
||||||
}
|
}
|
||||||
y[jy] += alpha * temp2;
|
|
||||||
jx += *incx;
|
|
||||||
jy += *incy;
|
|
||||||
kk += *n - j;
|
kk += *n - j;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (actual_x != x) delete[] actual_x;
|
||||||
|
if (actual_y != y) delete[] copy_back(actual_y, y, *n, *incy);
|
||||||
}
|
}
|
||||||
|
|
||||||
/** DSPR performs the symmetric rank 1 operation
|
/** DSPR performs the symmetric rank 1 operation
|
||||||
|
|||||||
Reference in New Issue
Block a user