Began to fix calibration issues by extracting some angle calculation
functions and returning degrees as the heading.