Added ability to toggle debug outputs in Sensorfusion module