FIX: Correct bearing calculation!!!