Function apply_r_t 

fn apply_r_t(r: &[[f64; 3]; 3], t: &[f64; 3], p: &[f64; 3]) -> [f64; 3]

Row-major 3x3 apply: R * p + t.