diff --git a/src/src/main/java/com/my/graphiteDigesterBg/diframe/actuator/DiActServo.java b/src/src/main/java/com/my/graphiteDigesterBg/diframe/actuator/DiActServo.java index b1f91d6..04b88ce 100644 --- a/src/src/main/java/com/my/graphiteDigesterBg/diframe/actuator/DiActServo.java +++ b/src/src/main/java/com/my/graphiteDigesterBg/diframe/actuator/DiActServo.java @@ -36,4 +36,15 @@ public class DiActServo extends DiActuatorBase { public void setCurrentPosAsMiddle() { this.call(DiCommand.MOTOR_EASY_SET_CURRENT_POS, 2047); } + + // get current position + public Integer getCurrentPos() { + var response = this.call(DiCommand.MOTOR_READ_POS); + return response.readInteger(0); + } + + // move to position + public void moveToPosition(Integer pos) { + this.moveTo(pos); + } }