diff --git a/MAVGCL/src/main/java/com/comino/flight/observables/StateProperties.java b/MAVGCL/src/main/java/com/comino/flight/observables/StateProperties.java index 09580143b..12da361c4 100644 --- a/MAVGCL/src/main/java/com/comino/flight/observables/StateProperties.java +++ b/MAVGCL/src/main/java/com/comino/flight/observables/StateProperties.java @@ -141,25 +141,30 @@ private StateProperties(IMAVController control) { control.getStatusManager().addListener(Status.MSP_CONNECTED, (n) -> { - wq.addSingleTask("LP", 500,() -> { - - control.getStatusManager().reset(); - - isGPSAvailable.set(true); - isGPSAvailable.set(n.isSensorAvailable(Status.MSP_GPS_AVAILABILITY)); - isCVAvailable.set(true); - isCVAvailable.set(n.isSensorAvailable(Status.MSP_OPCV_AVAILABILITY)); - isSLAMAvailable.set(true); - isSLAMAvailable.set(n.isSensorAvailable(Status.MSP_SLAM_AVAILABILITY)); - isMSPAvailable.set(true); - isMSPAvailable.set(n.isSensorAvailable(Status.MSP_MSP_AVAILABILITY)); - Platform.runLater(() -> { - simulationProperty.set(n.isStatus(Status.MSP_SITL)); - connectedProperty.set(n.isStatus(Status.MSP_CONNECTED)); - }); - - - }); +// wq.addSingleTask("LP", 500,() -> { +// +// control.getStatusManager().reset(); +// +// isGPSAvailable.set(true); +// isGPSAvailable.set(n.isSensorAvailable(Status.MSP_GPS_AVAILABILITY)); +// isCVAvailable.set(true); +// isCVAvailable.set(n.isSensorAvailable(Status.MSP_OPCV_AVAILABILITY)); +// isSLAMAvailable.set(true); +// isSLAMAvailable.set(n.isSensorAvailable(Status.MSP_SLAM_AVAILABILITY)); +// isMSPAvailable.set(true); +// isMSPAvailable.set(n.isSensorAvailable(Status.MSP_MSP_AVAILABILITY)); +// Platform.runLater(() -> { +// simulationProperty.set(n.isStatus(Status.MSP_SITL)); +// connectedProperty.set(n.isStatus(Status.MSP_CONNECTED)); +// }); +// +// +// }); + + Platform.runLater(() -> { + simulationProperty.set(n.isStatus(Status.MSP_SITL)); + connectedProperty.set(n.isStatus(Status.MSP_CONNECTED)); + }); if(!n.isStatus(Status.MSP_CONNECTED)) { control.writeLogMessage(new LogMessage("[mgc] Connection to vehicle lost..",MAV_SEVERITY.MAV_SEVERITY_CRITICAL));