pub fn fuse_imu_gps(lat: f64, lon: f64, yaw_deg: f64) -> (f64, f64, f64)
Sensor fusion combining IMU yaw angle with GPS geodetic coordinates