pub type PoseSE3 = PoseSE3;
pub struct PoseSE3 { pub t: [f64; 3], pub q: [f64; 4], }
t: [f64; 3]
q: [f64; 4]