|
|
@ -121,7 +121,7 @@ double ServoController::getStopAngle() |
|
|
|
auto speedVector1 = _modbusWrapper.getHoldingRegister(SRV_STOP_ANGLE_INT_PART_REG, 1); |
|
|
|
auto speedVector2 = _modbusWrapper.getHoldingRegister(SRV_STOP_ANGLE_FRAC_PART_REG, 1); |
|
|
|
|
|
|
|
return ((speedVector1[0] + speedVector2[0]) / SRV_ANGLE_FACTOR); |
|
|
|
return (speedVector1[0] + speedVector2[0] / SRV_ANGLE_FACTOR); |
|
|
|
} |
|
|
|
|
|
|
|
/*************************************************************************************************/ |
|
|
@ -130,7 +130,7 @@ double ServoController::getStartAngle() |
|
|
|
auto speedVector1 = _modbusWrapper.getHoldingRegister(SRV_START_ANGLE_INT_PART_REG, 1); |
|
|
|
auto speedVector2 = _modbusWrapper.getHoldingRegister(SRV_START_ANGLE_FRAC_PART_REG, 1); |
|
|
|
|
|
|
|
return ((speedVector1[0] + speedVector2[0]) / SRV_ANGLE_FACTOR); |
|
|
|
return (speedVector1[0] + speedVector2[0] / SRV_ANGLE_FACTOR); |
|
|
|
} |
|
|
|
|
|
|
|
/*************************************************************************************************/ |
|
|
|