fn dot_product(a: &[f64; 3], b: &[f64; 3]) -> f64
Helper function to compute dot product of two 3D vectors.