|
@ -134,20 +134,22 @@ public class TubePreProcesModuleExDriver { |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
private void modGroupMoveToZero() throws AppException { |
|
|
|
|
|
miniServoDriver.miniServoMoveToZeroBlock(MiniServoMId.ShakeModGripperSV); |
|
|
|
|
|
miniServoDriver.miniServoMoveToZeroBlock(MiniServoMId.ShakeModGripperYSV); |
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroBlock(StepMotorMId.ShakeModClampingM, actionOvertime); |
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroBlock(StepMotorMId.ShakeModGripperZM, actionOvertime); |
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroBlock(StepMotorMId.ShakeModShakeM, actionOvertime); |
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToBlock(StepMotorMId.ShakeModShakeM, 90, actionOvertime); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
public void moveToZeroQuick() throws AppException { |
|
|
public void moveToZeroQuick() throws AppException { |
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModGripperZM, actionOvertime); |
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModGripperZM, actionOvertime); |
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModClampingM, actionOvertime); |
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModClampingM, actionOvertime); |
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModShakeM, actionOvertime); |
|
|
|
|
|
modGroupMoveToZero(); |
|
|
|
|
|
|
|
|
// stepMotorCtrlDriver.stepMotorEasyMoveToZeroPointQuickBlock(StepMotorMId.ShakeModShakeM, actionOvertime); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
miniServoDriver.miniServoMoveToZeroBlock(MiniServoMId.ShakeModGripperSV); |
|
|
|
|
|
miniServoDriver.miniServoMoveToZeroBlock(MiniServoMId.ShakeModGripperYSV); |
|
|
|
|
|
|
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZero(StepMotorMId.ShakeModClampingM); |
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToZero(StepMotorMId.ShakeModGripperZM); |
|
|
|
|
|
|
|
|
|
|
|
stepMotorCtrlDriver.waitForMod(StepMotorMId.ShakeModClampingM, actionOvertime); |
|
|
|
|
|
stepMotorCtrlDriver.waitForMod(StepMotorMId.ShakeModGripperZM, actionOvertime); |
|
|
|
|
|
|
|
|
|
|
|
stepMotorCtrlDriver.stepMotorEasyMoveToBlock(StepMotorMId.ShakeModShakeM, 90, actionOvertime); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
} |
|
|
} |