Browse Source

Add code to servoControler class

test
nasi 3 years ago
parent
commit
f6ac65beb8
  1. 4
      Servo/src/ServoController.cpp

4
Servo/src/ServoController.cpp

@ -146,8 +146,6 @@ void ServoController::setAngleOffset(double offset)
/*************************************************************************************************/ /*************************************************************************************************/
double ServoController::getAzimuth() double ServoController::getAzimuth()
{ {
auto azimuthVector = _modbusWrapper.getHoldingRegister(SRV_AZIMUTH_REG,1); auto azimuthVector = _modbusWrapper.getHoldingRegister(SRV_AZIMUTH_REG, 1);
return (azimuthVector[0] / SRV_ANGLE_FACTOR); return (azimuthVector[0] / SRV_ANGLE_FACTOR);
} }

Loading…
Cancel
Save