From 32bf433492f540b1392c19757124ebb91d0e74bd Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期三, 29 三月 2023 15:55:01 +0800
Subject: [PATCH] 四向车入库分配任务逻辑
---
src/main/java/com/zy/core/thread/ShuttleThread.java | 46 +++++++++++++++++++++++++++++++++++-----------
1 files changed, 35 insertions(+), 11 deletions(-)
diff --git a/src/main/java/com/zy/core/thread/ShuttleThread.java b/src/main/java/com/zy/core/thread/ShuttleThread.java
index 13db8e1..e2ee80d 100644
--- a/src/main/java/com/zy/core/thread/ShuttleThread.java
+++ b/src/main/java/com/zy/core/thread/ShuttleThread.java
@@ -5,7 +5,6 @@
import HslCommunication.Core.Types.OperateResultExOne;
import HslCommunication.ModBus.ModbusTcpNet;
import com.alibaba.fastjson.JSON;
-import com.alibaba.fastjson.JSONObject;
import com.core.common.DateUtils;
import com.core.common.SpringUtils;
import com.core.exception.CoolException;
@@ -288,7 +287,7 @@
}
//鍒嗛厤浠诲姟
- private void assignWork(ShuttleAssignCommand assignCommand) {
+ private void assignWork(ShuttleAssignCommand assignCommand) throws Exception {
//灏嗘map瀛樺叆redis涓�
HashMap<String, Object> map = new HashMap<>();
@@ -299,8 +298,17 @@
ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc);
//璺緞鏁版嵁
map.put("path", data);
+ //璺緞娆℃暟
+ map.put("pathSize", data.size());
+ }else {
+ if (assignCommand.getTaskMode() == ShuttleTaskModeType.PAK_IN.id.shortValue() || assignCommand.getTaskMode() == ShuttleTaskModeType.PAK_OUT.id.shortValue()) {
+ //灞炰簬鍏ュ簱鍑哄簱锛屽繀椤昏璁＄畻璺緞锛屽垯鎶涘嚭寮傚父
+ throw new Exception("鏈兘鎵惧埌杩愯璺緞");
+ }
}
+ //鍥涘悜绌挎杞﹀彿
+ map.put("shuttle_no", assignCommand.getShuttleNo());
//宸ヤ綔鍙�
map.put("wrk_no", assignCommand.getTaskNo());
//鍛戒护鎵ц姝ュ簭
@@ -334,21 +342,27 @@
ArrayList pathList = JSON.parseObject(data.toString(), ArrayList.class);
//鍙栫涓�鏉¤矾寰�
Object o1 = pathList.get(commandStep);
- ArrayList path = JSON.parseObject(o1.toString(), ArrayList.class);
+ ArrayList objectPath = JSON.parseObject(o1.toString(), ArrayList.class);
+ ArrayList<NavigateNode> path = new ArrayList<>();
+ for (Object o2 : objectPath) {
+ NavigateNode navigateNode = JSON.parseObject(o2.toString(), NavigateNode.class);
+ path.add(navigateNode);
+ }
+ Integer allDistance = NavigateUtils.getCurrentPathAllDistance(path);//璁＄畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
- size = path.size();
+ size = Integer.parseInt(map.get("pathSize").toString());
//寮�濮嬭矾寰�
- JSONObject startPath = JSON.parseObject(path.get(0).toString());
+ NavigateNode startPath = path.get(0);
//鐩爣璺緞
- JSONObject endPath = JSON.parseObject(path.get(size - 1).toString());
+ NavigateNode endPath = path.get(path.size() - 1);
command.setCommandWord((short) 1);
- command.setStartCodeNum(NavigatePositionConvert.xyToPosition(startPath.getIntValue("x"), startPath.getIntValue("y")));
+ command.setStartCodeNum(NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY()));
command.setMiddleCodeNum((short) 0);
- command.setDistCodeNum(NavigatePositionConvert.xyToPosition(endPath.getIntValue("x"), endPath.getIntValue("y")));
- command.setStartToDistDistance(1000);
+ command.setDistCodeNum(NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY()));
+ command.setStartToDistDistance(allDistance);
command.setMiddleToDistDistance(1000);
- command.setRunDirection(ShuttleRunDirection.get(startPath.get("direction").toString()).id);
+ command.setRunDirection(ShuttleRunDirection.get(startPath.getDirection()).id);
command.setPalletLift((short) 1);
command.setForceMoveDistance(1000);
command.setChargeSwitch((short) 2);
@@ -372,6 +386,16 @@
command.setRunDirection((short) (assignCommand.getTaskMode() - 4));
command.setCommandEnd((short) 1);
break;
+ case 9://鐘舵�佸浣�
+ command.setCommandWord((short) 0);
+ //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵��
+ shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
+ //浠诲姟鍙锋竻闆�
+ shuttleProtocol.setTaskNo((short) 0);
+ //鏍囪澶嶄綅
+ shuttleProtocol.setPakMk(true);
+ break;
+ default:
}
command.setCommandEnd((short) 1);
@@ -385,7 +409,7 @@
shuttleProtocol.setPakMk(false);
//鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚
- if (commandStep < size) {
+ if (commandStep < size - 1) {
//鏇存柊redis鏁版嵁
//姝ュ簭澧炲姞
commandStep++;
--
Gitblit v1.9.1