|
|
@ -1,5 +1,6 @@ |
|
|
|
package com.iflytop.gd.hardware.drivers.MiniServoDriver; |
|
|
|
|
|
|
|
import com.iflytop.gd.hardware.exception.HardwareException; |
|
|
|
import com.iflytop.gd.hardware.type.Servo.MiniServoMId; |
|
|
|
import com.iflytop.gd.hardware.utils.Math.ServoPositionConverter; |
|
|
|
import lombok.RequiredArgsConstructor; |
|
|
@ -81,13 +82,14 @@ public class ClawDriver { |
|
|
|
} |
|
|
|
|
|
|
|
// ==== ==== ==== ==== ==== ==== Ctrl ==== ==== ==== ==== ==== ==== |
|
|
|
public void moveToHome(MiniServoMId servoMid) throws Exception |
|
|
|
public void moveToHome(MiniServoMId servoMid) throws HardwareException |
|
|
|
{ |
|
|
|
log.info("[ {} ] moveToHome", servoMid.mid.getDescription()); |
|
|
|
|
|
|
|
this.moveTo(servoMid, MIN_DISTANCE); |
|
|
|
} |
|
|
|
|
|
|
|
public void moveTo(MiniServoMId servoMid, double position) throws Exception |
|
|
|
public void moveTo(MiniServoMId servoMid, double position) throws HardwareException |
|
|
|
{ |
|
|
|
// 检查位置是否合法 |
|
|
|
if (position < MIN_DISTANCE || position > MAX_DISTANCE) { |
|
|
@ -101,7 +103,7 @@ public class ClawDriver { |
|
|
|
miniServoDriver.miniServoEnable(servoMid, 0); |
|
|
|
} |
|
|
|
|
|
|
|
public void stop(MiniServoMId servoMid) throws Exception { |
|
|
|
public void stop(MiniServoMId servoMid) throws HardwareException { |
|
|
|
log.info("[ {} ] stop", servoMid.mid.getDescription()); |
|
|
|
miniServoDriver.miniServoStop(servoMid); |
|
|
|
miniServoDriver.miniServoEnable(servoMid, 0); |
|
|
|