diff --git a/DroneSimulator/Drone.cs b/DroneSimulator/Drone.cs
index 4d77ebb..e7d09f7 100644
--- a/DroneSimulator/Drone.cs
+++ b/DroneSimulator/Drone.cs
@@ -361,7 +361,7 @@ namespace DroneSimulator
       RealPos.Update(PosXYZ, tick);
 
       Vector2 of_xy;
-      if (range > 0.1) of_xy = new Vector2(SpdXYZ.X / range - Gyr.Y, SpdXYZ.Y / range + Gyr.X);
+      if (range > 0.1) of_xy = new Vector2(SpdXYZ.X * TO_GRAD / range - Gyr.Y, SpdXYZ.Y * TO_GRAD / range + Gyr.X);
       else of_xy = Vector2.Zero;
 
       bool of = RealOF.Update(of_xy, LaserRange, tick);