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 |   32 +++++++++++++++++++++++---------
 1 files changed, 23 insertions(+), 9 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/ShuttleThread.java b/src/main/java/com/zy/core/thread/ShuttleThread.java
index e91d81a..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<>();
 
@@ -301,8 +300,15 @@
             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());
         //鍛戒护鎵ц姝ュ簭
@@ -336,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 = 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(path.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);
@@ -380,6 +392,8 @@
                 shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
                 //浠诲姟鍙锋竻闆�
                 shuttleProtocol.setTaskNo((short) 0);
+                //鏍囪澶嶄綅
+                shuttleProtocol.setPakMk(true);
                 break;
             default:
         }

--
Gitblit v1.9.1