|
@ -5,7 +5,6 @@ import com.iflytop.gd.app.model.bo.status.device.HeatModuleState; |
|
|
import com.iflytop.gd.app.service.api.DevicePositionService; |
|
|
import com.iflytop.gd.app.service.api.DevicePositionService; |
|
|
import com.iflytop.gd.app.service.device.module.GantryModuleService; |
|
|
import com.iflytop.gd.app.service.device.module.GantryModuleService; |
|
|
import com.iflytop.gd.app.service.device.module.HeatModuleService; |
|
|
import com.iflytop.gd.app.service.device.module.HeatModuleService; |
|
|
import com.iflytop.gd.app.service.device.module.SolutionModuleService; |
|
|
|
|
|
import com.iflytop.gd.common.command.CommandFuture; |
|
|
import com.iflytop.gd.common.command.CommandFuture; |
|
|
import com.iflytop.gd.common.command.DeviceCommandBundle; |
|
|
import com.iflytop.gd.common.command.DeviceCommandBundle; |
|
|
import com.iflytop.gd.common.command.DeviceCommandGenerator; |
|
|
import com.iflytop.gd.common.command.DeviceCommandGenerator; |
|
@ -56,6 +55,7 @@ public class DeviceCommandTempUtilService { |
|
|
Point3D heatArea3TrayClawPoint3D = heatModuleService.getHeatAreaTrayClawPoint3D(HeatModuleCode.heat_module_03); |
|
|
Point3D heatArea3TrayClawPoint3D = heatModuleService.getHeatAreaTrayClawPoint3D(HeatModuleCode.heat_module_03); |
|
|
Point3D heatArea4TrayClawPoint3D = heatModuleService.getHeatAreaTrayClawPoint3D(HeatModuleCode.heat_module_04); |
|
|
Point3D heatArea4TrayClawPoint3D = heatModuleService.getHeatAreaTrayClawPoint3D(HeatModuleCode.heat_module_04); |
|
|
|
|
|
|
|
|
|
|
|
Point3D heatArea2CapClawPoint3D = heatModuleService.getHeatAreaCapClawPointPoint3D(HeatModuleCode.heat_module_02); |
|
|
Point3D heatArea3CapClawPoint3D = heatModuleService.getHeatAreaCapClawPointPoint3D(HeatModuleCode.heat_module_03); |
|
|
Point3D heatArea3CapClawPoint3D = heatModuleService.getHeatAreaCapClawPointPoint3D(HeatModuleCode.heat_module_03); |
|
|
|
|
|
|
|
|
Point3D[] points = new Point3D[]{}; |
|
|
Point3D[] points = new Point3D[]{}; |
|
@ -148,7 +148,7 @@ public class DeviceCommandTempUtilService { |
|
|
} else if (HeatModuleCode.heat_module_05.equals(targetHeatModuleCode)) { |
|
|
} else if (HeatModuleCode.heat_module_05.equals(targetHeatModuleCode)) { |
|
|
if (ClawItemType.cap.equals(clawItemType)) {//移动拍子 |
|
|
if (ClawItemType.cap.equals(clawItemType)) {//移动拍子 |
|
|
//路线 存放区 |
|
|
//路线 存放区 |
|
|
points = new Point3D[]{capStorageCapClawPoint3D}; |
|
|
|
|
|
|
|
|
points = new Point3D[]{heatArea2CapClawPoint3D, capStorageCapClawPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
HeatModuleCode.heat_module_03, |
|
|
HeatModuleCode.heat_module_03, |
|
@ -175,14 +175,14 @@ public class DeviceCommandTempUtilService { |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_06); |
|
|
HeatModuleCode.heat_module_06); |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
|
if(deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayStatus() == 1){ |
|
|
|
|
|
|
|
|
if (deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayStatus() == 1) { |
|
|
//路线 3、1、4、加液 |
|
|
//路线 3、1、4、加液 |
|
|
points = new Point3D[]{heatArea3TrayClawPoint3D, heatArea1TrayClawPoint3D, heatArea4TrayClawPoint3D, liquidAreaTrayPoint3D}; |
|
|
points = new Point3D[]{heatArea3TrayClawPoint3D, heatArea1TrayClawPoint3D, heatArea4TrayClawPoint3D, liquidAreaTrayPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_06); |
|
|
HeatModuleCode.heat_module_06); |
|
|
}else{ |
|
|
|
|
|
|
|
|
} else { |
|
|
//路线 加液 |
|
|
//路线 加液 |
|
|
points = new Point3D[]{liquidAreaTrayPoint3D}; |
|
|
points = new Point3D[]{liquidAreaTrayPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
@ -313,11 +313,12 @@ public class DeviceCommandTempUtilService { |
|
|
} |
|
|
} |
|
|
} else if (HeatModuleCode.heat_module_05.equals(targetHeatModuleCode)) { |
|
|
} else if (HeatModuleCode.heat_module_05.equals(targetHeatModuleCode)) { |
|
|
if (ClawItemType.cap.equals(clawItemType)) {//移动拍子 |
|
|
if (ClawItemType.cap.equals(clawItemType)) {//移动拍子 |
|
|
//路线 5 |
|
|
|
|
|
points = new Point3D[]{heatArea5CapClawPoint3D}; |
|
|
|
|
|
|
|
|
//路线 2、5 |
|
|
|
|
|
points = new Point3D[]{heatArea2CapClawPoint3D, heatArea5CapClawPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
HeatModuleCode.heat_module_03, |
|
|
HeatModuleCode.heat_module_03, |
|
|
|
|
|
HeatModuleCode.heat_module_04, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_06); |
|
|
HeatModuleCode.heat_module_06); |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
@ -341,15 +342,15 @@ public class DeviceCommandTempUtilService { |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_06); |
|
|
HeatModuleCode.heat_module_06); |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
|
} else if (ClawItemType.tray.equals(clawItemType)) {//移动托盘 |
|
|
if(deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayStatus() == 1 |
|
|
|
|
|
|| deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayUp() == 1){ |
|
|
|
|
|
|
|
|
if (deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayStatus() == 1 |
|
|
|
|
|
|| deviceStateService.getDeviceState().getHeatModuleByCode(HeatModuleCode.heat_module_05).getTrayUp() == 1) { |
|
|
//路线 4、1、3、6 |
|
|
//路线 4、1、3、6 |
|
|
points = new Point3D[]{heatArea4TrayClawPoint3D, heatArea1TrayClawPoint3D, heatArea3TrayClawPoint3D, heatArea6TrayClawPoint3D}; |
|
|
points = new Point3D[]{heatArea4TrayClawPoint3D, heatArea1TrayClawPoint3D, heatArea3TrayClawPoint3D, heatArea6TrayClawPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
moveTrayHeatModuleAvoidDown(commandId, command, null, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_05, |
|
|
HeatModuleCode.heat_module_06); |
|
|
HeatModuleCode.heat_module_06); |
|
|
}else{ |
|
|
|
|
|
|
|
|
} else { |
|
|
//路线 6 |
|
|
//路线 6 |
|
|
points = new Point3D[]{heatArea6TrayClawPoint3D}; |
|
|
points = new Point3D[]{heatArea6TrayClawPoint3D}; |
|
|
//不避让的模块 |
|
|
//不避让的模块 |
|
|