fn rotation_mat(vec: [f64; 3], theta: f64) -> [[f64; 3]; 3]
Rodrigues’ rotation formula: rotate by angle theta around axis vec. Returns 3x3 rotation matrix.