|
| 1 | +const IndexRange{T <: Integer} = Base.AbstractRange{T} |
| 2 | + |
| 3 | +# Elementary Householder reflection |
| 4 | +struct Householder{T, V <: AbstractVector, R <: IndexRange} |
| 5 | + β::T |
| 6 | + v::V |
| 7 | + r::R |
| 8 | +end |
| 9 | +Base.adjoint(H::Householder) = Householder(conj(H.β), H.v, H.r) |
| 10 | + |
| 11 | +function householder(x::AbstractVector, r::IndexRange = axes(x, 1), k = first(r)) |
| 12 | + i = findfirst(equalto(k), r) |
| 13 | + i == nothing && error("k = $k should be in the range r = $r") |
| 14 | + β, v, ν = _householder!(x[r], i) |
| 15 | + return Householder(β, v, r), ν |
| 16 | +end |
| 17 | +# Householder reflector h that zeros the elements A[r,col] (except for A[k,col]) upon lmul!(h,A) |
| 18 | +function householder(A::AbstractMatrix, r::IndexRange, col::Int, k = first(r)) |
| 19 | + i = findfirst(equalto(k), r) |
| 20 | + i == nothing && error("k = $k should be in the range r = $r") |
| 21 | + β, v, ν = _householder!(A[r, col], i) |
| 22 | + return Householder(β, v, r), ν |
| 23 | +end |
| 24 | +# Householder reflector that zeros the elements A[row,r] (except for A[row,k]) upon rmul!(A,h') |
| 25 | +function householder(A::AbstractMatrix, row::Int, r::IndexRange, k = first(r)) |
| 26 | + i = findfirst(equalto(k), r) |
| 27 | + i == nothing && error("k = $k should be in the range r = $r") |
| 28 | + β, v, ν = _householder!(conj!(A[row, r]), i) |
| 29 | + return Householder(β, v, r), ν |
| 30 | +end |
| 31 | + |
| 32 | +# generate Householder vector based on vector v, such that applying the reflection |
| 33 | +# to v yields a vector with single non-zero element on position i, whose value is |
| 34 | +# positive and thus equal to norm(v) |
| 35 | +function _householder!(v::AbstractVector{T}, i::Int = 1) where {T} |
| 36 | + β::T = zero(T) |
| 37 | + @inbounds begin |
| 38 | + σ = abs2(zero(T)) |
| 39 | + @simd for k in 1:(i - 1) |
| 40 | + σ += abs2(v[k]) |
| 41 | + end |
| 42 | + @simd for k in (i + 1):length(v) |
| 43 | + σ += abs2(v[k]) |
| 44 | + end |
| 45 | + vi = v[i] |
| 46 | + ν = sqrt(abs2(vi) + σ) |
| 47 | + |
| 48 | + if σ == 0 && vi == ν |
| 49 | + β = zero(vi) |
| 50 | + else |
| 51 | + if real(vi) < 0 |
| 52 | + vi = vi - ν |
| 53 | + else |
| 54 | + vi = ((vi - conj(vi)) * ν - σ) / (conj(vi) + ν) |
| 55 | + end |
| 56 | + @simd for k in 1:(i - 1) |
| 57 | + v[k] /= vi |
| 58 | + end |
| 59 | + v[i] = 1 |
| 60 | + @simd for k in (i + 1):length(v) |
| 61 | + v[k] /= vi |
| 62 | + end |
| 63 | + β = -conj(vi) / (ν) |
| 64 | + end |
| 65 | + end |
| 66 | + return β, v, ν |
| 67 | +end |
| 68 | + |
| 69 | +function LinearAlgebra.lmul!(H::Householder, x::AbstractVector) |
| 70 | + v = H.v |
| 71 | + r = H.r |
| 72 | + β = H.β |
| 73 | + β == 0 && return x |
| 74 | + @inbounds begin |
| 75 | + μ = conj(zero(v[1])) * zero(x[r[1]]) |
| 76 | + i = 1 |
| 77 | + @simd for j in r |
| 78 | + μ += conj(v[i]) * x[j] |
| 79 | + i += 1 |
| 80 | + end |
| 81 | + μ *= β |
| 82 | + i = 1 |
| 83 | + @simd for j in H.r |
| 84 | + x[j] -= μ * v[i] |
| 85 | + i += 1 |
| 86 | + end |
| 87 | + end |
| 88 | + return x |
| 89 | +end |
| 90 | +function LinearAlgebra.lmul!(H::Householder, A::AbstractMatrix; cols = axes(A, 2)) |
| 91 | + v = H.v |
| 92 | + r = H.r |
| 93 | + β = H.β |
| 94 | + β == 0 && return A |
| 95 | + @inbounds begin |
| 96 | + for k in cols |
| 97 | + μ = conj(zero(v[1])) * zero(A[r[1], k]) |
| 98 | + i = 1 |
| 99 | + @simd for j in r |
| 100 | + μ += conj(v[i]) * A[j, k] |
| 101 | + i += 1 |
| 102 | + end |
| 103 | + μ *= β |
| 104 | + i = 1 |
| 105 | + @simd for j in H.r |
| 106 | + A[j, k] -= μ * v[i] |
| 107 | + i += 1 |
| 108 | + end |
| 109 | + end |
| 110 | + end |
| 111 | + return A |
| 112 | +end |
| 113 | +function LinearAlgebra.rmul!(A::AbstractMatrix, H::Householder; rows = axes(A, 1)) |
| 114 | + v = H.v |
| 115 | + r = H.r |
| 116 | + β = H.β |
| 117 | + β == 0 && return A |
| 118 | + w = similar(A, length(rows)) |
| 119 | + fill!(w, 0) |
| 120 | + all(in(axes(A, 2)), r) || error("Householder range r = $r not compatible with matrix A of size $(size(A))") |
| 121 | + @inbounds begin |
| 122 | + l = 1 |
| 123 | + for k in r |
| 124 | + j = 1 |
| 125 | + @simd for i in rows |
| 126 | + w[j] += A[i, k] * v[l] |
| 127 | + j += 1 |
| 128 | + end |
| 129 | + l += 1 |
| 130 | + end |
| 131 | + l = 1 |
| 132 | + for k in r |
| 133 | + j = 1 |
| 134 | + @simd for i in rows |
| 135 | + A[i, k] -= β * w[j] * conj(v[l]) |
| 136 | + j += 1 |
| 137 | + end |
| 138 | + l += 1 |
| 139 | + end |
| 140 | + end |
| 141 | + return A |
| 142 | +end |
0 commit comments