diff --git a/main.lua b/main.lua
index 33b45ea..0253289 100644
--- a/main.lua
+++ b/main.lua
@@ -508,9 +508,11 @@ function PollNavTable()
         Heading = navTable.getHeading()
 
         if Config.SensorCorrection.Heading ~= 0 then
-            if Heading + Config.SensorCorrection.Heading > 360 then
-                local difference = 360 - Heading
-                Heading = 0 + (Config.SensorCorrection.Heading - difference)
+            Heading = Heading + Config.SensorCorrection.Heading
+            if Heading > 360 then
+                Heading = Heading - 360
+            elseif Heading + Config.SensorCorrection.Heading < 0 then
+                Heading = Heading + 360
             else
                 Heading = Heading + Config.SensorCorrection.Heading
             end