Added log-function for debug
Added Compass-module processing and few fixes to the bearing calculation