-Remove int casts from AHRS heading.

WindhoverLabs · Feb 25, 2024 · fb5c4bc · fb5c4bc
1 parent bc32ae2
commit fb5c4bc
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 10 deletions.
diff --git a/src/main/java/com/windhoverlabs/yamcs/gdl90/AHRS.java b/src/main/java/com/windhoverlabs/yamcs/gdl90/AHRS.java
@@ -160,16 +160,16 @@ public int packAltitude(int altFt) {
     return (int) ((1000 + altFt) / 25);
   }
 
-  //  public int packDegrees(double deg) {
-  //    int tenth = ((int) ((deg % ((int) deg)) * 10));
-  //    return ((int) ((deg * 10)) + tenth);
-  //  }
-
   public int packDegrees(double deg) {
-    return ((int) ((deg * 10)));
+    int tenth = ((int) ((deg % ((int) deg)) * 10));
+    return ((int) ((deg * 10)) + tenth);
   }
 
-  public int FFB_PackForeFlightHeading(double heading) {
+  //  public int packDegrees(double deg) {
+  //    return ((int) ((deg * 10)));
+  //  }
+
+  public double FFB_PackForeFlightHeading(double heading) {
 
     // Connvert heading of [-180, 180] to [-360,360]
     double PackedHeading = heading;
@@ -178,6 +178,6 @@ public int FFB_PackForeFlightHeading(double heading) {
     } else {
       PackedHeading = heading;
     }
-    return (int) (PackedHeading);
+    return (PackedHeading);
   }
 }
diff --git a/src/main/java/com/windhoverlabs/yamcs/gdl90/GDL90Link.java b/src/main/java/com/windhoverlabs/yamcs/gdl90/GDL90Link.java
@@ -1220,12 +1220,12 @@ private void calcYPR(AHRS ahrs) {
         case BOOLEAN:
           break;
         case DOUBLE:
-          ahrs.Heading = (int) pvAHRS_Heading.getEngValue().getDoubleValue();
+          ahrs.Heading = pvAHRS_Heading.getEngValue().getDoubleValue();
           break;
         case ENUMERATED:
           break;
         case FLOAT:
-          ahrs.Heading = (int) pvAHRS_Heading.getEngValue().getFloatValue();
+          ahrs.Heading = pvAHRS_Heading.getEngValue().getFloatValue();
           break;
         case NONE:
           break;