Binary-Coalescence/motorDSM
2
0
Fork 0
mirror of https://github.com/Binary-Coalescence/motorDSM.git synced 2025-08-05 06:05:40 -05:00
Code Issues Packages Projects Releases Wiki Activity

Updated to read md90 power state.

Browse Source
This commit is contained in:
Daniel Sissom
2024-05-23 16:02:03 -05:00
parent 0841ff3e15
commit 0c32dd28eb
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
dsmApp/src/MD90Driver.cpp
View File

@@ -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);