From c1586475ace78a16f9fbfb8576f89035fa0e531c Mon Sep 17 00:00:00 2001
From: sige <sige@sige.com>
Date: Mon, 18 Mar 2024 17:13:53 +0800
Subject: [PATCH] ~~

---
 .../my/graphiteDigesterBg/diframe/actuator/DiActServo.java    | 11 +++++++++++
 1 file changed, 11 insertions(+)

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);
+    }
 }