console/plugins/planning/PlanExecutionPreview: Fix processing depth on StateReport message.

paulosousadias · paulosousadias · commit 9815917ea0a5 · 2024-10-03T18:27:15.000+01:00
diff --git a/src/java/pt/lsts/neptus/console/plugins/planning/PlanExecutionPreview.java b/src/java/pt/lsts/neptus/console/plugins/planning/PlanExecutionPreview.java
@@ -387,7 +387,7 @@ public synchronized void consume(StateReport msg) {
                 EstimatedState current = sim.getState().toEstimatedState();
                 current.setLat(Math.toRadians(msg.getLatitude()));
                 current.setLon(Math.toRadians(msg.getLongitude()));
-                current.setDepth(msg.getDepth()/10.0);
+                current.setDepth(msg.getDepth() == 0xFFFF ? -1 : msg.getDepth()/10.0);
                 double ellapsedTime = Math.abs(System.currentTimeMillis()/1000.0 - msg.getStime()) * 3;
                 sim.setPositionEstimation(current, ellapsedTime);
             }

Original file line number	Diff line number	Diff line change
`@@ -387,7 +387,7 @@ public synchronized void consume(StateReport msg) {`
`387`	`387`	`EstimatedState current = sim.getState().toEstimatedState();`
`388`	`388`	`current.setLat(Math.toRadians(msg.getLatitude()));`
`389`	`389`	`current.setLon(Math.toRadians(msg.getLongitude()));`
`390`		`- current.setDepth(msg.getDepth()/10.0);`
	`390`	`+ current.setDepth(msg.getDepth() == 0xFFFF ? -1 : msg.getDepth()/10.0);`
`391`	`391`	`double ellapsedTime = Math.abs(System.currentTimeMillis()/1000.0 - msg.getStime()) * 3;`
`392`	`392`	`sim.setPositionEstimation(current, ellapsedTime);`
`393`	`393`	`}`