Update LinoRoboArm.h

LoBrol · Nov 20, 2022 · 0b19b60 · 0b19b60
1 parent b2ae204
commit 0b19b60
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/LinoRoboArm.h b/LinoRoboArm.h
@@ -80,7 +80,7 @@ uint8_t LinoRoboArm::GetJoints() {
  */
 void LinoRoboArm::SetServo(uint8_t ServoID, uint8_t val) {
  servos[ServoID].SetServo(val);
- moveServo(ServoID, val);
+ moveServo(ServoID, servos[ServoID].GetServo());
 }
 
 
@@ -158,4 +158,4 @@ String LinoRoboArm::PrintPositions() {
  aux += servos[i].GetServo() + ",";
  aux += servos[5].GetServo();
  return aux;
-}
+}