From a032e83b86f182f2939454949129adfece45ebed Mon Sep 17 00:00:00 2001
From: Junjie <540245094@qq.com>
Date: 星期四, 26 九月 2024 16:35:52 +0800
Subject: [PATCH] #
---
zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java | 324 ++++++++++++++++++++++++------------------------------
1 files changed, 144 insertions(+), 180 deletions(-)
diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java
index 3f67aa7..496ca62 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java
@@ -3,14 +3,18 @@
import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
import com.zy.asrs.wcs.core.action.LiftAction;
import com.zy.asrs.wcs.core.entity.Motion;
+import com.zy.asrs.wcs.core.entity.Task;
import com.zy.asrs.wcs.core.model.command.LiftAssignCommand;
import com.zy.asrs.wcs.core.model.command.LiftCommand;
import com.zy.asrs.wcs.core.model.enums.DeviceCtgType;
+import com.zy.asrs.wcs.core.model.enums.LiftCommandModeType;
import com.zy.asrs.wcs.core.model.enums.MotionCtgType;
import com.zy.asrs.wcs.core.model.enums.MotionStsType;
import com.zy.asrs.wcs.core.service.MotionService;
import com.zy.asrs.wcs.core.service.TaskService;
+import com.zy.asrs.wcs.core.utils.Utils;
import com.zy.asrs.wcs.rcs.cache.SlaveConnection;
+import com.zy.asrs.wcs.rcs.model.enums.LiftProtocolStatusType;
import com.zy.asrs.wcs.rcs.model.enums.SlaveType;
import com.zy.asrs.wcs.rcs.model.protocol.LiftProtocol;
import com.zy.asrs.wcs.rcs.thread.LiftThread;
@@ -20,6 +24,7 @@
import java.util.ArrayList;
import java.util.Date;
+import java.util.List;
import java.util.Objects;
/**
@@ -48,11 +53,6 @@
return false;
}
- //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
- if (!liftThread.isIdle()) {
- return false;
- }
-
if (motionService.count(new LambdaQueryWrapper<Motion>()
.eq(Motion::getDeviceCtg, DeviceCtgType.LIFT.val())
.eq(Motion::getDevice, motion.getDevice())
@@ -60,139 +60,113 @@
return false;
}
+ //妫�娴嬫彁鍗囨満鏄惁鏈変换鍔＄粦瀹�
+ boolean liftResult = Utils.checkLiftHasBinding(liftProtocol.getLiftNo(), String.valueOf(motion.getTaskNo()));
+ if (liftResult) {
+ //瀛樺湪浠诲姟锛岀姝㈡墽琛�
+ return false;
+ }
+
+ //姣忔鎵ц鎻愬崌鏈烘寚浠ら兘缁戝畾鎻愬崌鏈�
+ Task task = taskService.getOne(new LambdaQueryWrapper<Task>().eq(Task::getTaskNo, motion.getTaskNo()));
+ if (task == null) {
+ return false;
+ }
+ task.setLiftNo(liftProtocol.getLiftNo());
+ task.setUpdateTime(new Date());
+ if (!taskService.updateById(task)) {
+ return false;
+ }
+
ArrayList<LiftCommand> list = new ArrayList<>();
LiftAssignCommand assignCommand = new LiftAssignCommand();
assignCommand.setLiftNo(liftProtocol.getLiftNo());
- assignCommand.setTaskNo(motion.getWrkNo());
+ assignCommand.setTaskNo(motion.getTaskNo());
assignCommand.setCommands(list);
- LiftCommand command = new LiftCommand();
+ List<LiftCommand> command = new ArrayList<>();
switch (Objects.requireNonNull(MotionCtgType.get(motion.getMotionCtgEl()))){
case LIFT_MOVE:
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle()) {
+ return false;
+ }
+
// 濡傛灉宸茬粡鍦ㄧ洰鏍囧眰锛岄偅杈瑰眰杩囨护
if (liftProtocol.getLev().equals(Integer.valueOf(motion.getTarget()))) {
- liftProtocol.setTaskNo(motion.getWrkNo());
+ liftThread.setSyncTaskNo(motion.getTaskNo());
break;
}
- command = liftThread.getEmptyMoveCommand(motion.getWrkNo(), Integer.parseInt(motion.getTarget()));
- list.add(command);
+ command = liftThread.getMoveCommand(motion.getTaskNo(), 0, Integer.parseInt(motion.getTarget()), LiftCommandModeType.MOVE);
+ list.addAll(command);
return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_GOODS:
- return false;
-// if (!liftProtocol.getLineFrontHasStock() || !liftProtocol.getLineEndHasStock()) {
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle()) {
+ return false;
+ }
+// if (liftProtocol.getHasTray()) {
// return false;
// }
-//
-// command = liftThread.getLiftUpDownCommand(Integer.parseInt(motion.getTarget()));
-// command.setLiftNo(deviceNo.shortValue());
-// command.setTaskNo(motion.getWrkNo().shortValue());
-// return liftThread.assignWork(command);
+
+ command = liftThread.getPalletInOutCommand(motion.getTaskNo(), Integer.parseInt(motion.getOrigin()), Integer.parseInt(motion.getTarget()), motion.getOriDrt(), motion.getTarDrt(), LiftCommandModeType.PALLET_INOUT);
+ list.addAll(command);
+ return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_SHUTTLE:
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle()) {
+ return false;
+ }
+
if (!liftProtocol.getHasCar()) {
return false;
}
- command = liftThread.getMoveWithShuttleCommand(motion.getWrkNo(), Integer.parseInt(motion.getOrigin()), Integer.parseInt(motion.getTarget()));
- list.add(command);
+ command = liftThread.getMoveWithShuttleCommand(motion.getTaskNo(), Integer.parseInt(motion.getOrigin()), Integer.parseInt(motion.getTarget()), LiftCommandModeType.MOVE_CAR);
+ list.addAll(command);
return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_GOODS_AND_SHUTTLE:
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle()) {
+ return false;
+ }
+
return false;
-// if (!liftProtocol.getPlatShuttleCheck()) {
-// return false;
-// }
-//
-// command = liftThread.getLiftUpDownCommand(Integer.parseInt(motion.getTarget()));
-// command.setLiftNo(deviceNo.shortValue());
-// command.setTaskNo(motion.getWrkNo().shortValue());
-// return liftThread.assignWork(command);
case LIFT_TRANSPORT_TO_CONVEYOR:
return false;
-// // 鍒ゆ柇杈撻�佺嚎鐘舵��
-// int staNo = Integer.parseInt(motion.getTarget());
-// WorkZoneType zoneType = WorkZoneType.query(staNo);
-//
-// SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, zoneType.devpPlcId);
-//
-// StaProtocol staProtocol = devpThread.getStation().get(staNo);
-// if (staProtocol == null) {
-// return false;
-// }
-//
-// if (!staProtocol.isAutoing()
-// || staProtocol.isLoading()
-//// || !staProtocol.isOutEnable()
-// || staProtocol.getWorkNo() != 0) {
-// return false;
-// }
-//
-// // 鍒ゆ柇鎻愬崌鏈虹姸鎬�
-// if (!liftProtocol.getLev().equals(Short.parseShort(motion.getOrigin()))) { // 鏄惁澶勪簬浠诲姟灞�
-// return false;
-// }
-//
-// // 涓嬪彂鍛戒护 ---------------------------------------------------
-//
-// // 1.椹卞姩杈撻�佺嚎鐢垫満
-// StaMotorType staMotorType = null;
-// StaMotorType reqStaMotorType = null;
-// LiftInteractiveModeType liftInteractiveModeType = null;
-// LiftNeighborType neighborType = LiftNeighborType.query(staNo);
-// StaProtocol staProtocol1 = staProtocol.clone();
-// staProtocol1.setWorkNo(motion.getWrkNo().shortValue());
-// staProtocol1.setStaNo(neighborType.finalStaNo.shortValue());
-// switch (neighborType) {
-// case LIFT_2_NEIGHBOR_OUTBOUND_LEV_1:
-// staMotorType = StaMotorType.FORWARD;
-// reqStaMotorType = StaMotorType.REQ_FORWARD;
-// liftInteractiveModeType = LiftInteractiveModeType.ENGINE_LOADING_TURN_REVERSE;
-// break;
-// case LIFT_1_NEIGHBOR_INBOUND_LEV_2:
-// case LIFT_1_NEIGHBOR_INBOUND_LEV_3:
-// case LIFT_1_NEIGHBOR_INBOUND_LEV_4:
-// staMotorType = StaMotorType.FORWARD;
-// reqStaMotorType = StaMotorType.REQ_FORWARD;
-// liftInteractiveModeType = LiftInteractiveModeType.ENGINE_LOADING_TURN_REVERSE;
-// break;
-// case LIFT_1_NEIGHBOR_OUTBOUND_LEV_1_FINAL_8:
-// staMotorType = StaMotorType.FORWARD;
-// reqStaMotorType = StaMotorType.REQ_FORWARD;
-// liftInteractiveModeType = LiftInteractiveModeType.ENGINE_LOADING_TURN_REVERSE;
-// break;
-// default:
-// break;
-// }
-//
-// MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol1));
-// try {
-// Thread.sleep(1000);
-// } catch (InterruptedException ignore) {}
-//// int times = 0;boolean staProtocolMotorRes = false;
-//// while (times < 5) {
-//// if (staProtocol.getStaMotorType().equals(staMotorType)) {
-//// staProtocolMotorRes = true;
-//// break;
-//// }
-//// if (!devpThread.controlMotor(staNo, reqStaMotorType)) {
-//// continue;
-//// }
-//// try {
-//// Thread.sleep(500);
-//// } catch (InterruptedException ignore) {}
-//// times++;
-//// }
-//// if (!staProtocolMotorRes) {
-//// return false;
-//// }
-//
-// // 2.椹卞姩鎻愬崌鏈虹數鏈�
-// command = liftThread.getLiftTurnCommand(liftInteractiveModeType.id);
-// command.setLiftNo(deviceNo.shortValue());
-// command.setTaskNo(motion.getWrkNo().shortValue());
-// return liftThread.assignWork(command);
+ case LIFT_LOCK:
+ //閿佸畾鎻愬崌鏈�
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle(MotionCtgType.LIFT_LOCK)) {
+ return false;
+ }
+
+ command = liftThread.getLockCommand(motion.getTaskNo(), true);//鑾峰彇鎻愬崌鏈洪攣瀹氬懡浠�
+ list.addAll(command);
+ return liftAction.assignWork(liftThread.getDevice(), assignCommand);
+ case LIFT_UNLOCK:
+ //瑙ｉ攣鎻愬崌鏈�
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle(MotionCtgType.LIFT_UNLOCK)) {
+ return false;
+ }
+
+ command = liftThread.getLockCommand(motion.getTaskNo(), false);//鑾峰彇鎻愬崌鏈鸿В瀹氬懡浠�
+ list.addAll(command);
+ return liftAction.assignWork(liftThread.getDevice(), assignCommand);
+ case LIFT_SHUTTLE_ARRIVAL:
+ //鎻愬崌鏈�-灏忚溅宸插埌浣�
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle(MotionCtgType.LIFT_SHUTTLE_ARRIVAL)) {
+ return false;
+ }
+
+ command = liftThread.getShuttleSignalCommand(motion.getTaskNo(), true);//鑾峰彇灏忚溅宸插埌浣嶅懡浠�
+ list.addAll(command);
+ return liftAction.assignWork(liftThread.getDevice(), assignCommand);
default:
break;
-
}
return Boolean.TRUE;
@@ -209,7 +183,12 @@
return false;
}
- if (liftProtocol.getRun() || liftProtocol.getTaskNo() != motion.getWrkNo().shortValue()) {
+ if (liftProtocol.getRun() || liftProtocol.getTaskNo() != motion.getTaskNo().shortValue()) {
+ return false;
+ }
+
+ Task task = taskService.getOne(new LambdaQueryWrapper<Task>().eq(Task::getTaskNo, motion.getTaskNo()));
+ if (task == null) {
return false;
}
@@ -223,6 +202,15 @@
if (!liftProtocol.getLev().equals(Integer.valueOf(motion.getTarget()))) {
return false;
}
+
+ if (motion.getReleaseLift() == 1) {//閲婃斁鎻愬崌鏈�
+ task.setLiftNo(0);
+ task.setUpdateTime(new Date());
+ if (!taskService.updateById(task)) {
+ return false;
+ }
+ }
+
break;
case LIFT_WITH_GOODS:
// 鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
@@ -230,12 +218,26 @@
return false;
}
-// if (!liftProtocol.getLineFrontHasStock() || !liftProtocol.getLineEndHasStock()) {
-// return false;
-// }
-
if (!liftProtocol.getLev().equals(Integer.valueOf(motion.getTarget()))) {
return false;
+ }
+
+ if (task.getTaskSts() < 100) {//鍏ュ簱鍒ゆ柇鎵樼洏鏄惁杩涘叆鎻愬崌鏈�
+ if (!liftProtocol.getHasTray()) {
+ return false;
+ }
+ } else if (task.getTaskSts() >= 100 && task.getTaskSts() < 200) {//鍑哄簱鍒ゆ柇鎵樼洏鏄惁绂诲紑鎻愬崌鏈�
+ if (liftProtocol.getHasTray()) {
+ return false;
+ }
+ }
+
+ if (motion.getReleaseLift() == 1) {//閲婃斁鎻愬崌鏈�
+ task.setLiftNo(0);
+ task.setUpdateTime(new Date());
+ if (!taskService.updateById(task)) {
+ return false;
+ }
}
break;
@@ -264,84 +266,46 @@
return false;
}
+ if (!liftProtocol.getHasTray()) {
+ return false;
+ }
+
if (!liftProtocol.getLev().equals(Integer.valueOf(motion.getTarget()))) {
return false;
}
break;
case LIFT_TRANSPORT_TO_CONVEYOR:
-// // 鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔ㄣ�佺┖闂层�佸噯澶囧氨缁�佸墠鍏夌數鏃犺揣銆侀摼鏉℃病鏈夎浆鍔�
-// if (!liftProtocol.getModel()
-// || liftProtocol.getRun()
-// || !liftProtocol.getReady()
-// || liftProtocol.getLineFxrontHasStock()
-// || liftProtocol.getLineEndHasStock()
-// || liftProtocol.getForwardRotationFeedback()
-// || liftProtocol.getReverseFeedback()
-// ) {
-// return false;
-// }
-//
-// if (liftProtocol.getTaskNo().intValue() != motion.getWrkNo()) {
-// return false;
-// }
-//
-// // 鍒ゆ柇杈撻�佺嚎鐘舵��
-// int staNo = Integer.parseInt(motion.getTarget());
-// WorkZoneType zoneType = WorkZoneType.query(staNo);
-//
-// SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, zoneType.devpPlcId);
-//
-// StaProtocol staProtocol = devpThread.getStation().get(staNo);
-// if (staProtocol == null) {
-// return false;
-// }
-//
-// if (!staProtocol.getStaMotorType().equals(StaMotorType.STANDBY)) {
-// return false;
-// }
-//
-//// // 鍒ゆ柇杈撻�佺嚎鐘舵��
-//// int staNo = Integer.parseInt(motion.getTarget());
-//// WorkZoneType zoneType = WorkZoneType.query(staNo);
-////
-//// SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, zoneType.devpPlcId);
-////
-//// StaProtocol staProtocol = devpThread.getStation().get(staNo);
-//// if (staProtocol == null) {
-//// return false;
-//// }
-////
-//// if (!staProtocol.isAutoing() || !staProtocol.isLoading() || staProtocol.getWorkNo() != motion.getWrkNo().intValue()) {
-//// return false;
-//// }
-//
-//// if (!staProtocol.getStaMotorType().equals(StaMotorType.STANDBY)) {
-//// return false;
-//// }
-//
-//// // 灏嗕换鍔″彿鍏堜繚瀛樺埌杈撻�佺嚎绔欑偣涓婏紝鐩爣绔欎负0
-//// StaProtocol clone = staProtocol.clone();
-//// clone.setWorkNo(motion.getWrkNo().shortValue());
-//// clone.setStaNo((short) 0);
-//// if (!MessageQueue.offer(SlaveType.Devp, zoneType.devpPlcId, new Task(2, clone))) {
-//// return false;
-//// }
-////
-//// // 鍋滄鎻愬崌鏈虹數鏈鸿浆鍔紝骞跺浣�
-//// command = liftThread.getLiftTurnCommand(LiftInteractiveModeType.ENGINE_STOP.id);
-//// command.setLiftNo(deviceNo.shortValue());
-//// command.setTaskNo(motion.getWrkNo().shortValue());
-//// return liftThread.assignWork(command);
+
+ break;
+ case LIFT_LOCK:
+ if (!liftThread.isLock(null)) {
+ return false;
+ }
+ break;
+ case LIFT_UNLOCK:
+ if (liftThread.isLock(null)) {
+ return false;
+ }
+
+ if (motion.getReleaseLift() == 1) {//閲婃斁鎻愬崌鏈�
+ task.setLiftNo(0);
+ task.setUpdateTime(new Date());
+ if (!taskService.updateById(task)) {
+ return false;
+ }
+ }
+ break;
+ case LIFT_SHUTTLE_ARRIVAL:
break;
default:
return false;
}
- liftProtocol.setTaskNo(0);//娓呴浂宸ヤ綔鍙�
+ liftThread.setSyncTaskNo(0);//娓呴浂宸ヤ綔鍙�
+ liftThread.setProtocolStatus(LiftProtocolStatusType.IDLE);
return true;
}
-
}
--
Gitblit v1.9.1