Fixed incorrect motorAxisActualVel calculation.

2015-03-13 15:05:28 +00:00
parent cbbabe0ce8
commit 6a6a34ebe5
1 changed files with 1 additions and 1 deletions
@@ -820,7 +820,7 @@ static void EnsemblePoller(EnsembleController *pController)
            }
            else
            {
-                double actvelocity = atof(&inputBuff[1]) * 1000.;
+                double actvelocity = atof(&inputBuff[1]) / fabs(pAxis->stepSize);
                motorParam->setDouble(pAxis->params, motorAxisActualVel, actvelocity);
            }
            motorParam->callCallback(pAxis->params);