Initialise and destroy the SensorFusion object properly.
Code still hangs on exit.