From 0c32dd28eb2d503e0e0a67f7190091f64c625669 Mon Sep 17 00:00:00 2001
From: Daniel Sissom <daniel.sissom@binarycoalescence.com>
Date: Thu, 23 May 2024 16:02:03 -0500
Subject: [PATCH] Updated to read md90 power state.

---
 dsmApp/src/MD90Driver.cpp | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

diff --git a/dsmApp/src/MD90Driver.cpp b/dsmApp/src/MD90Driver.cpp
index 87ef9de..36310c2 100644
--- a/dsmApp/src/MD90Driver.cpp
+++ b/dsmApp/src/MD90Driver.cpp
@@ -299,10 +299,12 @@ asynStatus MD90Axis::poll(bool *moving)
   setIntegerParam(pC_->motorStatusAtHome_, home);
 
   // Read the drive power on status
-  sprintf(pC_->outString_, "#%02dW", axisNo_);
+  sprintf(pC_->outString_, "GPS");
   comStatus = pC_->writeReadController();
   if (comStatus) goto skip;
-  driveOn = (pC_->inString_[5] == '1') ? 1:0;
+  // The response string is of the form "0: Power supply enabled state: 1"
+  sscanf (pC_->inString_, "%d: %[^:]: %d", &replyStatus, replyString, &replyValue);
+  driveOn = (replyValue == '1') ? 1:0;
   setIntegerParam(pC_->motorStatusPowerOn_, driveOn);
   setIntegerParam(pC_->motorStatusProblem_, 0);