Cleaned up sensorfusion code