From 77ba9a8e95927efc361268c005ae907e709da2c4 Mon Sep 17 00:00:00 2001
From: Junjie <540245094@qq.com>
Date: 星期三, 12 六月 2024 16:55:35 +0800
Subject: [PATCH] #
---
zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/LiftCommandService.java | 206 +++++----------------------------------------------
1 files changed, 22 insertions(+), 184 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 4075c60..cd41492 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
@@ -6,6 +6,7 @@
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;
@@ -19,7 +20,6 @@
import org.springframework.stereotype.Service;
import java.util.ArrayList;
-import java.util.Date;
import java.util.Objects;
/**
@@ -48,11 +48,8 @@
return false;
}
- //鑷姩銆佸氨缁�佺┖闂�
- if (!(liftProtocol.getModel()
- && liftProtocol.getReady()
- && !liftProtocol.getRun())
- ) {
+ //鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔�
+ if (!liftThread.isIdle()) {
return false;
}
@@ -66,7 +63,7 @@
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();
@@ -74,29 +71,27 @@
case LIFT_MOVE:
// 濡傛灉宸茬粡鍦ㄧ洰鏍囧眰锛岄偅杈瑰眰杩囨护
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()));
+ command = liftThread.getMoveCommand(motion.getTaskNo(), 0, Integer.parseInt(motion.getTarget()), LiftCommandModeType.MOVE);
list.add(command);
return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_GOODS:
- return false;
-// if (!liftProtocol.getLineFrontHasStock() || !liftProtocol.getLineEndHasStock()) {
+// 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.add(command);
+ return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_SHUTTLE:
if (!liftProtocol.getHasCar()) {
return false;
}
- command = liftThread.getMoveWithShuttleCommand(motion.getWrkNo(), Integer.parseInt(motion.getOrigin()), Integer.parseInt(motion.getTarget()));
+ command = liftThread.getMoveWithShuttleCommand(motion.getTaskNo(), Integer.parseInt(motion.getOrigin()), Integer.parseInt(motion.getTarget()), LiftCommandModeType.MOVE_CAR);
list.add(command);
return liftAction.assignWork(liftThread.getDevice(), assignCommand);
case LIFT_WITH_GOODS_AND_SHUTTLE:
@@ -111,88 +106,6 @@
// 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);
default:
break;
@@ -212,17 +125,14 @@
return false;
}
- if (liftProtocol.getRun() || liftProtocol.getTaskNo() != motion.getWrkNo().shortValue()) {
+ if (liftProtocol.getRun() || liftProtocol.getTaskNo() != motion.getTaskNo().shortValue()) {
return false;
}
switch (Objects.requireNonNull(MotionCtgType.get(motion.getMotionCtgEl()))){
case LIFT_MOVE:
- // 鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔ㄣ�佺┖闂层�佸噯澶囧氨缁�侀摼鏉℃病鏈夎浆鍔ㄣ�佹病鏈夋湭灏辩华鎶ラ敊
- if (!liftProtocol.getModel()
- || liftProtocol.getRun()
- || !liftProtocol.getReady()
- ) {
+ // 鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
+ if (!liftThread.isIdle()) {
return false;
}
@@ -231,11 +141,8 @@
}
break;
case LIFT_WITH_GOODS:
- // 鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔ㄣ�佺┖闂层�佸噯澶囧氨缁�侀摼鏉℃病鏈夎浆鍔ㄣ�佹病鏈夋湭灏辩华鎶ラ敊
- if (!liftProtocol.getModel()
- || liftProtocol.getRun()
- || !liftProtocol.getReady()
- ) {
+ // 鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
+ if (!liftThread.isIdle()) {
return false;
}
@@ -249,11 +156,8 @@
break;
case LIFT_WITH_SHUTTLE:
- // 鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔ㄣ�佺┖闂层�佸噯澶囧氨缁�侀摼鏉℃病鏈夎浆鍔ㄣ�佹病鏈夋湭灏辩华鎶ラ敊
- if (!liftProtocol.getModel()
- || liftProtocol.getRun()
- || !liftProtocol.getReady()
- ) {
+ // 鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
+ if (!liftThread.isIdle()) {
return false;
}
@@ -267,11 +171,8 @@
}
break;
case LIFT_WITH_GOODS_AND_SHUTTLE:
- // 鍒ゆ柇鎻愬崌鏈烘槸鍚﹁嚜鍔ㄣ�佺┖闂层�佸噯澶囧氨缁�侀摼鏉℃病鏈夎浆鍔ㄣ�佹病鏈夋湭灏辩华鎶ラ敊
- if (!liftProtocol.getModel()
- || liftProtocol.getRun()
- || !liftProtocol.getReady()
- ) {
+ // 鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
+ if (!liftThread.isIdle()) {
return false;
}
@@ -285,76 +186,13 @@
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;
default:
return false;
}
- liftProtocol.setTaskNo(0);//娓呴浂宸ヤ綔鍙�
+ liftThread.setSyncTaskNo(0);//娓呴浂宸ヤ綔鍙�
return true;
}
--
Gitblit v1.9.1