Added Heading functionality.

Initial reading of compass without any filtering complete.