|
|
@ -99,10 +99,10 @@ public class ActionCommandService { |
|
|
|
deviceStateService.getDeviceState().getHeatModuleByCode(heatModuleCode).setCapExist(false);//加热模块是否存在拍子 |
|
|
|
capModuleService.capMotorMoveByNumNoWait(commandId, command, -1);//拍子存放模块下降1个拍子位置 |
|
|
|
gantryModuleService.gantryZMoveZero(commandId, command);//抬升z轴 |
|
|
|
heatModuleService.heaterMotorMoveNoWait(commandId, command, heatModuleCode, trayLower);//下降加热模块 |
|
|
|
Thread.sleep(2500); |
|
|
|
// heatModuleService.heaterMotorMoveNoWait(commandId, command, heatModuleCode, trayLower);//下降加热模块 |
|
|
|
// Thread.sleep(2500); |
|
|
|
deviceCommandTempUtilService.carryMoveXYToSolutionManyPoints(commandId, command, heatModuleCode, ClawItemType.cap);//携带拍子移动至存放区 |
|
|
|
deviceCommandTempUtilService.moveTrayHeatModuleAvoidUpNoWait(commandId, command, heatModuleCode);//移动完毕恢复抬升状态 |
|
|
|
deviceCommandTempUtilService.moveTrayHeatModuleAvoidUpNoWait(commandId, command, null);//移动完毕恢复抬升状态 |
|
|
|
gantryModuleService.gantryZMove(capModuleCapMoveHeight);//下降z轴,使夹拍子落入存放区 |
|
|
|
gantryModuleService.clawMove(commandId, command, clawCapPick);//将夹爪打开,释放夹取的拍子 |
|
|
|
gantryModuleService.gantryZMoveZero(commandId, command);//抬升z轴 |
|
|
@ -123,19 +123,18 @@ public class ActionCommandService { |
|
|
|
double capModuleCapMoveHeight = devicePositionService.getPosition(DevicePositionCode.capModuleCapMoveHeight).getDistance();//拍子升降模块拍子z轴移动高度 |
|
|
|
Point3D capStorageCapClawPoint3D = devicePositionService.getPosition(DevicePositionCode.capStorageCapClawPoint).getPoint3D();//获取拍子存放区上方点位; |
|
|
|
|
|
|
|
heatModuleService.heaterMotorMoveNoWait(commandId, command, heatModuleCode, trayLower);//确保目标加热模块是下降状态 |
|
|
|
// heatModuleService.heaterMotorMoveNoWait(commandId, command, heatModuleCode, trayLower);//确保目标加热模块是下降状态 |
|
|
|
|
|
|
|
gantryModuleService.gantryXYMove(commandId, command, capStorageCapClawPoint3D);//移动机械臂至拍子存放区上方 |
|
|
|
deviceStateService.getDeviceState().getHeatModuleByCode(heatModuleCode).setTrayUp(0);//将加热模块托盘状态改为下降 |
|
|
|
// deviceStateService.getDeviceState().getHeatModuleByCode(heatModuleCode).setTrayUp(0);//将加热模块托盘状态改为下降 |
|
|
|
gantryModuleService.clawMove(commandId, command, clawCapPick);//将夹爪打开,准备夹取拍子 |
|
|
|
gantryModuleService.gantryZMove(capModuleCapMoveHeight);//下降z轴,使夹爪落入拍子升降模块拍子孔位 |
|
|
|
gantryModuleService.clawMove(commandId, command, clawCapGrip);//将夹爪收紧,夹住拍子 |
|
|
|
gantryModuleService.gantryZMoveZero(commandId, command);//抬升z轴 |
|
|
|
deviceCommandTempUtilService.carryMoveXYToHeatManyPoints(commandId, command, heatModuleCode, ClawItemType.cap);//将拍子移动至目标加热模块上方 |
|
|
|
capModuleService.capUpBalanceNoWait(commandId, command); //提升拍子存放区 |
|
|
|
// capModuleService.capUpBalanceNoWait(commandId, command); //提升拍子存放区 |
|
|
|
|
|
|
|
deviceCommandTempUtilService.moveTrayHeatModuleAvoidUpNoWait(commandId, command, heatModuleCode); |
|
|
|
Thread.sleep(3700); |
|
|
|
deviceCommandTempUtilService.moveTrayHeatModuleAvoidUpNoWait(commandId, command, null); |
|
|
|
|
|
|
|
gantryModuleService.gantryZMove(heatModuleCapMoveHeight);//下降z轴,使夹拍子落入加热模块 |
|
|
|
gantryModuleService.clawMove(commandId, command, clawCapPick);//将夹爪打开,释放拍子 |
|
|
|