pub fn relative_velocity( vel_a: Vec3, omega_a: Vec3, r_a: Vec3, vel_b: Vec3, omega_b: Vec3, r_b: Vec3, ) -> Vec3
Compute relative velocity of two points on two rigid bodies