pub fn print_ukf(ukf: &UKF, record: &TestDataRecord)
Print the UKF state and covariance for debugging purposes.