[Compass] Fixed magnetometer (compass) sensor. Based on Tigrouzen patch

Change-Id: I5034d7301816ef57ed9e31d004b5a31a657f93d6
Merge pull request #8 from Volk204/jellybean

[Compass] Fixed magnetometer (compass) sensor. Based on Tigrouzen patch