From ff1fedd00c22aa232541f63ebcaa5a7f929b89b7 Mon Sep 17 00:00:00 2001
From: Junjie <540245094@qq.com>
Date: 星期一, 15 七月 2024 08:28:26 +0800
Subject: [PATCH] #

---
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/rcs/thread/impl/NyShuttleThread.java |   54 ++++++++++++++++++++++++++++++++++++++++++------------
 1 files changed, 42 insertions(+), 12 deletions(-)

diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/rcs/thread/impl/NyShuttleThread.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/rcs/thread/impl/NyShuttleThread.java
index d9ce954..76c9550 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/rcs/thread/impl/NyShuttleThread.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/rcs/thread/impl/NyShuttleThread.java
@@ -24,6 +24,7 @@
 import com.zy.asrs.wcs.core.utils.NavigateMapData;
 import com.zy.asrs.wcs.core.utils.NavigatePositionConvert;
 import com.zy.asrs.wcs.core.utils.RedisUtil;
+import com.zy.asrs.wcs.core.utils.Utils;
 import com.zy.asrs.wcs.rcs.News;
 import com.zy.asrs.wcs.rcs.cache.OutputQueue;
 import com.zy.asrs.wcs.rcs.constant.DeviceRedisConstant;
@@ -99,17 +100,15 @@
             BufferedReader reader = new BufferedReader(new InputStreamReader(this.socket.getInputStream()));
             // 璇诲彇鏈嶅姟鍣ㄧ殑鍝嶅簲
             StringBuffer sb = new StringBuffer();
-            String response = null;
             char[] chars = new char[2048];//缂撳啿鍖�
-            do {
+            while (true) {
                 reader.read(chars);
-                String trim = new String(chars).trim();
+                String trim = new String(chars);
                 sb.append(trim);
-                if (sb.lastIndexOf("\r\n") != -1) {
+                if (trim.lastIndexOf("\r\n") != -1) {
                     break;
                 }
-            } while (response != null);
-//            System.out.println("Received response from server: " + sb);
+            }
 
             JSONObject result = JSON.parseObject(sb.toString());//寰楀埌鍝嶅簲缁撴灉闆�
             if (!socketResults.isEmpty() && socketResults.size() >= 5) {
@@ -213,7 +212,7 @@
                 shuttleProtocol.setErrorCode(data.getJSONArray("errCode").getString(0));
 
                 //鏄惁椤跺崌
-                shuttleProtocol.setHasLift(data.getInteger("liftPosition") == 1 ? true : false);
+                shuttleProtocol.setHasLift(data.getInteger("liftPosition") == 2 ? true : false);
                 //鏄惁鏈夋墭鐩�
                 shuttleProtocol.setHasPallet(data.getInteger("loadState") == 1 ? true : false);
                 //琛岄┒鏂瑰悜
@@ -324,6 +323,7 @@
                 Integer requestId = resultHeader.getInteger("requestId");
                 if (requestType.equals("init")) {
                     Integer code = resultBody.getInteger("code");
+                    OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戣溅澶嶄綅涓婃姤 ===>> [code:{1}] [ip:{2}] [port:{3}]", code, device.getId(), device.getIp(), device.getPort()));
                     //灏忚溅澶嶄綅璇锋眰
                     ShuttleCommand initCommand = getInitCommand(requestId, code);
                     //鍙戝嚭璇锋眰
@@ -373,6 +373,7 @@
             NyShuttleHttpCommand httpCommand = JSON.parseObject(command.getBody(), NyShuttleHttpCommand.class);
             Map<String, Object> body = httpCommand.getRequest().getBody();
             Object pathObj = body.get("path");
+            int taskId = Integer.parseInt(body.get("taskId").toString());
             List<JSONObject> path = JSON.parseArray(JSON.toJSONString(pathObj), JSONObject.class);
             ArrayList<NyShuttleHttpCommand> commandList = new ArrayList<>();
             while (!path.isEmpty()) {
@@ -380,7 +381,12 @@
                 if (path.size() > 10) {
                     List<JSONObject> subList = path.subList(0, 10);
                     list.addAll(subList);
-                    subList.clear();
+
+                    List<JSONObject> tmp = new ArrayList<>();
+                    for (int i = 10; i < path.size(); i++) {
+                        tmp.add(path.get(i));
+                    }
+                    path = tmp;
                 }else  {
                     list.addAll(path);
                     path.clear();
@@ -391,6 +397,7 @@
 
                 NyShuttleHttpCommand.NyRequest request = httpCommandCopy.getRequest();
                 bodyCopy.put("path", list);
+                bodyCopy.put("taskId", taskId++);
                 request.setBody(bodyCopy);
                 httpCommandCopy.setRequest(request);
 
@@ -399,9 +406,9 @@
 
             for (NyShuttleHttpCommand requestCommand : commandList) {
                 JSONObject result = requestCommand(requestCommand);
-                if (result == null) {
-                    return false;//璇锋眰澶辫触
-                }
+//                if (result == null) {
+//                    return false;//璇锋眰澶辫触
+//                }
                 this.shuttleProtocol.setSendTime(System.currentTimeMillis());//鎸囦护涓嬪彂鏃堕棿
             }
             return true;
@@ -448,6 +455,11 @@
         setProtocolStatus(ShuttleProtocolStatusType.IDLE);
         enableMoveLoc(null, false);
         return true;
+    }
+
+    @Override
+    public boolean updateLocation(ShuttleCommand param) {
+        return true;//杩樻病绉绘杩囨潵
     }
 
     @Override
@@ -551,7 +563,7 @@
                 if (shuttleService == null) {
                     return false;
                 }
-                BasShuttle basShuttle = shuttleService.getById(this.device.getDeviceNo());
+                BasShuttle basShuttle = shuttleService.getOne(new LambdaQueryWrapper<BasShuttle>().eq(BasShuttle::getDeviceId, this.device.getId()));
                 if (basShuttle == null) {
                     return false;
                 }
@@ -613,6 +625,7 @@
     @Override
     public List<NavigateNode> getMoveAdvancePath() {
         ObjectMapper objectMapper = SpringUtils.getBean(ObjectMapper.class);
+        NavigateMapData navigateMapData = SpringUtils.getBean(NavigateMapData.class);
         ArrayList<NavigateNode> path = new ArrayList<>();
         if (shuttleProtocol.getTaskNo() != 0) {
             //瀛樺湪浠诲姟锛岃幏鍙栨寚浠�
@@ -631,6 +644,18 @@
                 if (!nodes.isEmpty()) {
                     path.addAll(nodes);
                 }
+
+                //灏嗚矾寰勯攣涓庡皬杞﹁矾寰勮繘琛屽尮閰�
+                ArrayList<NavigateNode> tmp = new ArrayList<>();
+                //妫�娴嬭矾寰勬槸鍚﹁閿佸畾
+                int[][] map = navigateMapData.getDataFromRedis(NavigationMapType.DFX.id, null, null);
+                for (NavigateNode node : path) {
+                    if(map[node.getX()][node.getY()] == -999) {
+                        tmp.add(node);
+                    }
+                }
+
+                path = tmp;
             }
         }
         return path;
@@ -777,6 +802,11 @@
         return command;
     }
 
+    @Override
+    public ShuttleCommand getUpdateLocationCommand(Integer taskNo, String locNo) {
+        return null;//杩樻病绉绘杩囨潵
+    }
+
     //鑾峰彇灏忚溅澶嶄綅鍝嶅簲鍛戒护
     public ShuttleCommand getInitCommand(Integer taskNo, Integer code) {
         LocService locService = SpringUtils.getBean(LocService.class);

--
Gitblit v1.9.1