Sensor Fusion Demo Code