pub fn rtvec_to_na_dvec( rtvec: ((f64, f64, f64), (f64, f64, f64)), ) -> (DVector<f64>, DVector<f64>)