faer/linalg/qr/col_pivoting/
inverse.rs1use crate::assert;
2use crate::internal_prelude::*;
3use linalg::householder::apply_block_householder_sequence_transpose_on_the_right_in_place_scratch;
4
5pub fn inverse_scratch<I: Index, T: ComplexField>(dim: usize, blocksize: usize, par: Par) -> StackReq {
6 _ = par;
7 StackReq::or(
8 apply_block_householder_sequence_transpose_on_the_right_in_place_scratch::<T>(dim, blocksize, dim),
9 crate::perm::permute_cols_in_place_scratch::<I, T>(dim, dim),
10 )
11}
12
13#[track_caller]
14pub fn inverse<I: Index, T: ComplexField>(
15 out: MatMut<'_, T>,
16 Q_basis: MatRef<'_, T>,
17 Q_coeff: MatRef<'_, T>,
18 R: MatRef<'_, T>,
19 col_perm: PermRef<'_, I>,
20 par: Par,
21 stack: &mut MemStack,
22) {
23 let n = Q_basis.ncols();
27 let blocksize = Q_coeff.nrows();
28 assert!(all(
29 blocksize > 0,
30 Q_basis.nrows() == n,
31 Q_basis.ncols() == n,
32 Q_coeff.ncols() == n,
33 R.nrows() == n,
34 R.ncols() == n,
35 out.nrows() == n,
36 out.ncols() == n,
37 col_perm.len() == n,
38 ));
39
40 let mut out = out;
41 out.fill(zero());
42 linalg::triangular_inverse::invert_upper_triangular(out.rb_mut(), R, par);
43 linalg::householder::apply_block_householder_sequence_transpose_on_the_right_in_place_with_conj(
44 Q_basis,
45 Q_coeff,
46 Conj::Yes,
47 out.rb_mut(),
48 par,
49 stack,
50 );
51 crate::perm::permute_rows_in_place(out.rb_mut(), col_perm.inverse(), stack);
52}
53
54#[cfg(test)]
55mod tests {
56 use super::*;
57 use crate::assert;
58 use crate::stats::prelude::*;
59 use crate::utils::approx::*;
60 use dyn_stack::MemBuffer;
61 use linalg::qr::col_pivoting::*;
62
63 #[test]
64 fn test_inverse() {
65 let rng = &mut StdRng::seed_from_u64(0);
66 let n = 50;
67 let A = CwiseMatDistribution {
68 nrows: n,
69 ncols: n,
70 dist: ComplexDistribution::new(StandardNormal, StandardNormal),
71 }
72 .rand::<Mat<c64>>(rng);
73
74 let mut QR = A.to_owned();
75 let mut H = Mat::zeros(4, n);
76 let col_perm_fwd = &mut *vec![0usize; n];
77 let col_perm_bwd = &mut *vec![0usize; n];
78
79 let (_, col_perm) = factor::qr_in_place(
80 QR.as_mut(),
81 H.as_mut(),
82 col_perm_fwd,
83 col_perm_bwd,
84 Par::Seq,
85 MemStack::new(&mut { MemBuffer::new(factor::qr_in_place_scratch::<usize, c64>(n, n, 4, Par::Seq, default())) }),
86 default(),
87 );
88
89 let approx_eq = CwiseMat(ApproxEq::eps() * (n as f64));
90
91 let mut A_inv = Mat::zeros(n, n);
92 inverse::inverse(
93 A_inv.as_mut(),
94 QR.as_ref(),
95 H.as_ref(),
96 QR.as_ref(),
97 col_perm,
98 Par::Seq,
99 MemStack::new(&mut MemBuffer::new(inverse::inverse_scratch::<usize, c64>(n, 4, Par::Seq))),
100 );
101
102 assert!(A_inv * A ~ Mat::identity(n, n));
103 }
104}