|
|
@ -4,7 +4,7 @@ import cn.hutool.core.lang.Assert; |
|
|
|
import com.iflytop.sgs.app.core.BaseCommandHandler; |
|
|
|
import com.iflytop.sgs.app.model.bo.Point3D; |
|
|
|
import com.iflytop.sgs.app.model.bo.status.device.HeatModuleState; |
|
|
|
import com.iflytop.sgs.app.model.bo.status.device.PumpState; |
|
|
|
import com.iflytop.sgs.app.model.bo.status.device.SolutionModuleState; |
|
|
|
import com.iflytop.sgs.app.model.dto.CmdDTO; |
|
|
|
import com.iflytop.sgs.app.service.api.DevicePositionService; |
|
|
|
import com.iflytop.sgs.app.service.device.DeviceStateService; |
|
|
@ -55,11 +55,11 @@ public class MoveToHeatAreaCommand extends BaseCommandHandler { |
|
|
|
String heatId = cmdDTO.getStringParam("heatId"); |
|
|
|
HeatModuleCode heatModuleId = HeatModuleCode.valueOf(heatId); |
|
|
|
HeatModuleState heatModuleState=deviceStateService.getDeviceState().getHeatModuleByCode(heatModuleId); |
|
|
|
PumpState pumpState=deviceStateService.getDeviceState().getPumpState(); |
|
|
|
SolutionModuleState solutionModuleState=deviceStateService.getDeviceState().getSolutionModule(); |
|
|
|
//判断是否有托盘 |
|
|
|
Assert.isTrue(heatModuleState.getTrayStatus()==0,heatModuleId+"此加热位已存在托盘"); |
|
|
|
//判断泵现在处于关闭状态 |
|
|
|
Assert.isTrue(pumpState.equals(PumpStateCode.close),"蠕动泵正在运行,无法转移"); |
|
|
|
Assert.isTrue(solutionModuleState.isPumping(),"蠕动泵正在运行,无法转移"); |
|
|
|
//加液电机升起的安全高度 |
|
|
|
double liquidMotorSafeDistance = devicePositionService.getPosition(DevicePositionCode.clawTrayGrip).getDistance(); |
|
|
|
//获取机械臂夹取托盘的横向距离 |
|
|
|