Added sensor data handling to AHRS loop; updated cukf.h with latest version from sfwa/ukf