Add some debugging for msp headtracker