-Add VelNED to WHL_AHRS.

-Bump version number
WindhoverLabs · Mar 5, 2024 · 4e5c4b8 · 4e5c4b8
1 parent c74646d
commit 4e5c4b8
Show file tree

Hide file tree

Showing 2 changed files with 121 additions and 1 deletion.
diff --git a/pom.xml b/pom.xml
@@ -3,7 +3,7 @@
 	<modelVersion>4.0.0</modelVersion>
 	<groupId>com.windhoverlabs</groupId>
 	<artifactId>yamcs-gdl90</artifactId>
-	<version>1.4.0-SNAPSHOT</version>
+	<version>1.4.1-SNAPSHOT</version>
 
 	<packaging>jar</packaging>
 	<name>YAMCS plugin for GDL90 standard.</name>

diff --git a/src/main/java/com/windhoverlabs/yamcs/gdl90/GDL90Link.java b/src/main/java/com/windhoverlabs/yamcs/gdl90/GDL90Link.java
@@ -1557,6 +1557,126 @@ private void calcYPR(WHL_AHRS ahrs) {
           break;
       }
     }
+
+    org.yamcs.protobuf.Pvalue.ParameterValue northVel = paramsToSend.get("NorthVel");
+
+    if (northVel != null) {
+      switch (northVel.getEngValue().getType()) {
+        case AGGREGATE:
+          break;
+        case ARRAY:
+          break;
+        case BINARY:
+          break;
+        case BOOLEAN:
+          break;
+        case DOUBLE:
+          //            	Assumes the PV is in meters/second. Convert to Knots
+          ahrs.northVel = northVel.getEngValue().getDoubleValue();
+          break;
+        case ENUMERATED:
+          break;
+        case FLOAT:
+          ahrs.northVel = northVel.getEngValue().getFloatValue();
+          break;
+        case NONE:
+          break;
+        case SINT32:
+          break;
+        case SINT64:
+          break;
+        case STRING:
+          break;
+        case TIMESTAMP:
+          break;
+        case UINT32:
+          break;
+        case UINT64:
+          break;
+        default:
+          break;
+      }
+    }
+
+    org.yamcs.protobuf.Pvalue.ParameterValue eastVel = paramsToSend.get("EastVel");
+
+    if (eastVel != null) {
+      switch (eastVel.getEngValue().getType()) {
+        case AGGREGATE:
+          break;
+        case ARRAY:
+          break;
+        case BINARY:
+          break;
+        case BOOLEAN:
+          break;
+        case DOUBLE:
+          //            	Assumes the PV is in meters/second. Convert to Knots
+          ahrs.eastVel = eastVel.getEngValue().getDoubleValue();
+          break;
+        case ENUMERATED:
+          break;
+        case FLOAT:
+          ahrs.eastVel = eastVel.getEngValue().getFloatValue();
+          break;
+        case NONE:
+          break;
+        case SINT32:
+          break;
+        case SINT64:
+          break;
+        case STRING:
+          break;
+        case TIMESTAMP:
+          break;
+        case UINT32:
+          break;
+        case UINT64:
+          break;
+        default:
+          break;
+      }
+    }
+
+    org.yamcs.protobuf.Pvalue.ParameterValue downVel = paramsToSend.get("DownVel");
+
+    if (downVel != null) {
+      switch (downVel.getEngValue().getType()) {
+        case AGGREGATE:
+          break;
+        case ARRAY:
+          break;
+        case BINARY:
+          break;
+        case BOOLEAN:
+          break;
+        case DOUBLE:
+          //            	Assumes the PV is in meters/second. Convert to Knots
+          ahrs.downVel = downVel.getEngValue().getDoubleValue();
+          break;
+        case ENUMERATED:
+          break;
+        case FLOAT:
+          ahrs.downVel = downVel.getEngValue().getFloatValue();
+          break;
+        case NONE:
+          break;
+        case SINT32:
+          break;
+        case SINT64:
+          break;
+        case STRING:
+          break;
+        case TIMESTAMP:
+          break;
+        case UINT32:
+          break;
+        case UINT64:
+          break;
+        default:
+          break;
+      }
+    }
   }
 
   private void calcQT(AHRS ahrs) {