-
Notifications
You must be signed in to change notification settings - Fork 65
/
rcond.rs
124 lines (115 loc) · 3.96 KB
/
rcond.rs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
//! Reciprocal conditional number
use crate::{error::*, layout::MatrixLayout, *};
use cauchy::*;
use num_traits::Zero;
pub struct RcondWork<T: Scalar> {
pub layout: MatrixLayout,
pub work: Vec<MaybeUninit<T>>,
pub rwork: Option<Vec<MaybeUninit<T::Real>>>,
pub iwork: Option<Vec<MaybeUninit<i32>>>,
}
pub trait RcondWorkImpl {
type Elem: Scalar;
fn new(l: MatrixLayout) -> Self;
fn calc(
&mut self,
a: &[Self::Elem],
anorm: <Self::Elem as Scalar>::Real,
) -> Result<<Self::Elem as Scalar>::Real>;
}
macro_rules! impl_rcond_work_c {
($c:ty, $con:path) => {
impl RcondWorkImpl for RcondWork<$c> {
type Elem = $c;
fn new(layout: MatrixLayout) -> Self {
let (n, _) = layout.size();
let work = vec_uninit(2 * n as usize);
let rwork = vec_uninit(2 * n as usize);
RcondWork {
layout,
work,
rwork: Some(rwork),
iwork: None,
}
}
fn calc(
&mut self,
a: &[Self::Elem],
anorm: <Self::Elem as Scalar>::Real,
) -> Result<<Self::Elem as Scalar>::Real> {
let (n, _) = self.layout.size();
let mut rcond = <Self::Elem as Scalar>::Real::zero();
let mut info = 0;
let norm_type = match self.layout {
MatrixLayout::C { .. } => NormType::Infinity,
MatrixLayout::F { .. } => NormType::One,
};
unsafe {
$con(
norm_type.as_ptr(),
&n,
AsPtr::as_ptr(a),
&self.layout.lda(),
&anorm,
&mut rcond,
AsPtr::as_mut_ptr(&mut self.work),
AsPtr::as_mut_ptr(self.rwork.as_mut().unwrap()),
&mut info,
)
};
info.as_lapack_result()?;
Ok(rcond)
}
}
};
}
impl_rcond_work_c!(c64, lapack_sys::zgecon_);
impl_rcond_work_c!(c32, lapack_sys::cgecon_);
macro_rules! impl_rcond_work_r {
($r:ty, $con:path) => {
impl RcondWorkImpl for RcondWork<$r> {
type Elem = $r;
fn new(layout: MatrixLayout) -> Self {
let (n, _) = layout.size();
let work = vec_uninit(4 * n as usize);
let iwork = vec_uninit(n as usize);
RcondWork {
layout,
work,
rwork: None,
iwork: Some(iwork),
}
}
fn calc(
&mut self,
a: &[Self::Elem],
anorm: <Self::Elem as Scalar>::Real,
) -> Result<<Self::Elem as Scalar>::Real> {
let (n, _) = self.layout.size();
let mut rcond = <Self::Elem as Scalar>::Real::zero();
let mut info = 0;
let norm_type = match self.layout {
MatrixLayout::C { .. } => NormType::Infinity,
MatrixLayout::F { .. } => NormType::One,
};
unsafe {
$con(
norm_type.as_ptr(),
&n,
AsPtr::as_ptr(a),
&self.layout.lda(),
&anorm,
&mut rcond,
AsPtr::as_mut_ptr(&mut self.work),
AsPtr::as_mut_ptr(self.iwork.as_mut().unwrap()),
&mut info,
)
};
info.as_lapack_result()?;
Ok(rcond)
}
}
};
}
impl_rcond_work_r!(f64, lapack_sys::dgecon_);
impl_rcond_work_r!(f32, lapack_sys::sgecon_);