Calculates compass to accurate 0-360 degrees and makes difference (error) from setpoint and current angle