|
|
@ -30,7 +30,7 @@ public class MotorWrapperDriver { |
|
|
|
public void setSpeed(StepMotorMId stepMotorMId, double speed) throws HardwareException { |
|
|
|
// 检查速度是否合法 |
|
|
|
// 设置速度到单片机 |
|
|
|
int motorSpeed = StepMotorConverter.toMotorSpeed(Math.abs(speed), config_.getLead(stepMotorMId)); |
|
|
|
int motorSpeed = (int) Math.abs(speed); // 转换速度为整数 |
|
|
|
stepMotorCtrlDriver_.setReg(stepMotorMId, StepMotorRegIndex.kreg_step_motor_default_velocity, motorSpeed); |
|
|
|
} |
|
|
|
|
|
|
|