From a46f9e397d5973e1ff9be3bb89357e2c50919900 Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期五, 13 十二月 2024 14:58:46 +0800
Subject: [PATCH] #

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/common/utils/MapDataUtils.java        |   21 ++-----
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AvoidWaveCalculator.java |  134 +++++++++++++++++++++-----------------------
 zy-acs-manager/pom.xml                                                                |    8 ++
 3 files changed, 79 insertions(+), 84 deletions(-)

diff --git a/zy-acs-manager/pom.xml b/zy-acs-manager/pom.xml
index af1e3a7..8fb1e78 100644
--- a/zy-acs-manager/pom.xml
+++ b/zy-acs-manager/pom.xml
@@ -146,6 +146,14 @@
             <artifactId>easyexcel</artifactId>
             <version>2.2.6</version>
         </dependency>
+
+        <!-- nd4j -->
+<!--        <dependency>-->
+<!--            <groupId>org.nd4j</groupId>-->
+<!--            <artifactId>nd4j-native-platform</artifactId>-->
+<!--            <version>1.0.0-M2.1</version>-->
+<!--        </dependency>-->
+
     </dependencies>
 
     <build>
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/common/utils/MapDataUtils.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/common/utils/MapDataUtils.java
index 8449992..8afc00d 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/common/utils/MapDataUtils.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/common/utils/MapDataUtils.java
@@ -1,12 +1,10 @@
 package com.zy.acs.manager.common.utils;
 
 import com.alibaba.fastjson.JSON;
+import com.zy.acs.common.utils.GsonUtils;
 import com.zy.acs.framework.common.Cools;
-import com.zy.acs.manager.core.service.astart.WaveNodeType;
 
-import java.util.ArrayList;
-import java.util.List;
-import java.util.Optional;
+import java.util.*;
 
 /**
  * Created by vincent on 8/7/2024
@@ -38,17 +36,10 @@
     }
 
     public static String generateWaveNode(String originStr, String waveNode) {
-        List<String> waveNodeList;
-        if (originStr.equals(WaveNodeType.ENABLE.val)) {
-            waveNodeList = new ArrayList<>();
-            waveNodeList.add(waveNode);
-        } else {
-            waveNodeList = JSON.parseArray(originStr, String.class);
-            if (!waveNodeList.contains(waveNode)) {
-                waveNodeList.add(waveNode);
-            }
-        }
-        return JSON.toJSONString(waveNodeList);
+        List<String> originNode = GsonUtils.fromJsonToList(originStr, String.class);
+        Set<String> set = new HashSet<>(originNode);
+        set.add(waveNode);
+        return GsonUtils.toJson(set);
     }
 
     public static Double getVehicleWaveSafeDistance(Integer diameter, Double factor) {
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AvoidWaveCalculator.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AvoidWaveCalculator.java
index 411d0da..ca758b1 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AvoidWaveCalculator.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AvoidWaveCalculator.java
@@ -13,7 +13,6 @@
 import com.zy.acs.manager.manager.entity.AgvDetail;
 import com.zy.acs.manager.manager.entity.AgvModel;
 import com.zy.acs.manager.manager.entity.Code;
-import com.zy.acs.manager.manager.enums.AgvModelType;
 import com.zy.acs.manager.manager.service.AgvDetailService;
 import com.zy.acs.manager.manager.service.AgvModelService;
 import com.zy.acs.manager.manager.service.AgvService;
@@ -25,9 +24,6 @@
 
 import javax.annotation.PostConstruct;
 import javax.annotation.PreDestroy;
-import java.io.BufferedReader;
-import java.io.IOException;
-import java.io.InputStreamReader;
 import java.util.List;
 import java.util.concurrent.ExecutorService;
 import java.util.concurrent.Executors;
@@ -93,78 +89,78 @@
                 return;
             }
 
-            AgvModel agvModel = agvModelService.selectByType(AgvModelType.CTU_BOX_TRANSPORT_AGV.toString());    // can be optimized
-
-            Double avoidDistance = MapDataUtils.getVehicleWaveSafeDistance(agvModel.getDiameter(), MapDataConstant.MAX_DISTANCE_BETWEEN_ADJACENT_AGV_FACTOR);
-
-            long startTime = System.currentTimeMillis();
-
-            ProcessBuilder processBuilder = new ProcessBuilder("python"
-                    , "D:\\tmp\\pyagv\\agv4.py"
-                    , String.valueOf(avoidDistance)
-            );
-            processBuilder.redirectErrorStream(true);
-
-            try {
-                Process process = processBuilder.start();
-
-                // 璇诲彇Python鑴氭湰鐨勮緭鍑�
-                BufferedReader reader = new BufferedReader(new InputStreamReader(process.getInputStream()));
-                String line;
-                StringBuilder builder = new StringBuilder();
-                while ((line = reader.readLine()) != null) {
-                    builder.append(line);
-                }
-
-                // 绛夊緟Python鑴氭湰鎵ц瀹屾垚
-                int exitCode = process.waitFor();
-                if (exitCode != 0) {
-                    System.out.println("Python script exited with error code: " + exitCode);
-                    return;
-                }
-                reader.close();
-
-                if (builder.length() <= 0) {
-                    return;
-                }
-
-                String result = builder.toString();
-
-                if (!Cools.isEmpty(result)) {
-                    if (!"1".equals(result)) {
-                        log.error("Fail python");
-                    }
-                }
-            } catch (IOException | InterruptedException e) {
-                e.printStackTrace();
-            }
-            log.error("python finish {}", System.currentTimeMillis() - startTime);
-
-//            String[][] codeMatrix = mapDataDispatcher.getCodeMatrix(lev);
-//            String[][] waveMatrix = mapDataDispatcher.initWaveMatrix(lev);
+//            AgvModel agvModel = agvModelService.selectByType(AgvModelType.CTU_BOX_TRANSPORT_AGV.toString());    // can be optimized
 //
-//            // lock path
-//            DynamicNode[][] dynamicMatrix = mapDataDispatcher.getDynamicMatrix(lev);
-//            for (int i = 0; i < dynamicMatrix.length; i++) {
-//                for (int j = 0; j < dynamicMatrix[i].length; j++) {
-//                    DynamicNode dynamicNode = dynamicMatrix[i][j];
-//                    String vehicle = dynamicNode.getVehicle();
-//                    if (!DynamicNodeType.ACCESS.val.equals(vehicle) && !DynamicNodeType.BLOCK.val.equals(vehicle)) {
-//                        AgvModel agvModel = agvModelService.getById(agvService.selectByUuid(vehicle).getAgvModel());    // can be optimized
+//            Double avoidDistance = MapDataUtils.getVehicleWaveSafeDistance(agvModel.getDiameter(), MapDataConstant.MAX_DISTANCE_BETWEEN_ADJACENT_AGV_FACTOR);
 //
-//                        Double avoidDistance = MapDataUtils.getVehicleWaveSafeDistance(agvModel.getDiameter(), MapDataConstant.MAX_DISTANCE_BETWEEN_ADJACENT_AGV_FACTOR);
-//                        List<NavigateNode> includeList = mapService.getWaveScopeByCode(lev, codeMatrix[i][j], avoidDistance);
+//            long startTime = System.currentTimeMillis();
 //
-//                        for (NavigateNode navigateNode : includeList) {
-//                            String waveNode = waveMatrix[navigateNode.getX()][navigateNode.getY()]; // overlay
-//                            waveMatrix[navigateNode.getX()][navigateNode.getY()] = MapDataUtils.generateWaveNode(waveNode, vehicle);
-//                        }
+//            ProcessBuilder processBuilder = new ProcessBuilder("python"
+//                    , "D:\\tmp\\pyagv\\agv4.py"
+//                    , String.valueOf(avoidDistance)
+//            );
+//            processBuilder.redirectErrorStream(true);
+//
+//            try {
+//                Process process = processBuilder.start();
+//
+//                // 璇诲彇Python鑴氭湰鐨勮緭鍑�
+//                BufferedReader reader = new BufferedReader(new InputStreamReader(process.getInputStream()));
+//                String line;
+//                StringBuilder builder = new StringBuilder();
+//                while ((line = reader.readLine()) != null) {
+//                    builder.append(line);
+//                }
+//
+//                // 绛夊緟Python鑴氭湰鎵ц瀹屾垚
+//                int exitCode = process.waitFor();
+//                if (exitCode != 0) {
+//                    System.out.println("Python script exited with error code: " + exitCode);
+//                    return;
+//                }
+//                reader.close();
+//
+//                if (builder.length() <= 0) {
+//                    return;
+//                }
+//
+//                String result = builder.toString();
+//
+//                if (!Cools.isEmpty(result)) {
+//                    if (!"1".equals(result)) {
+//                        log.error("Fail python");
 //                    }
 //                }
+//            } catch (IOException | InterruptedException e) {
+//                e.printStackTrace();
 //            }
+//            log.error("python finish {}", System.currentTimeMillis() - startTime);
+
+            String[][] codeMatrix = mapDataDispatcher.getCodeMatrix(lev);
+            String[][] waveMatrix = mapDataDispatcher.initWaveMatrix(lev);
 //
-////            mapDataDispatcher.printMatrix(waveMatrix);
-//            mapDataDispatcher.setWaveMatrix(lev, waveMatrix);
+//            // lock path
+            DynamicNode[][] dynamicMatrix = mapDataDispatcher.getDynamicMatrix(lev);
+            for (int i = 0; i < dynamicMatrix.length; i++) {
+                for (int j = 0; j < dynamicMatrix[i].length; j++) {
+                    DynamicNode dynamicNode = dynamicMatrix[i][j];
+                    String vehicle = dynamicNode.getVehicle();
+                    if (!DynamicNodeType.ACCESS.val.equals(vehicle) && !DynamicNodeType.BLOCK.val.equals(vehicle)) {
+                        AgvModel agvModel = agvModelService.getById(agvService.selectByUuid(vehicle).getAgvModel());    // can be optimized
+
+                        Double avoidDistance = MapDataUtils.getVehicleWaveSafeDistance(agvModel.getDiameter(), MapDataConstant.MAX_DISTANCE_BETWEEN_ADJACENT_AGV_FACTOR);
+                        List<NavigateNode> includeList = mapService.getWaveScopeByCode(lev, codeMatrix[i][j], avoidDistance);
+
+                        for (NavigateNode navigateNode : includeList) {
+                            String waveNode = waveMatrix[navigateNode.getX()][navigateNode.getY()]; // overlay
+                            waveMatrix[navigateNode.getX()][navigateNode.getY()] = MapDataUtils.generateWaveNode(waveNode, vehicle);
+                        }
+                    }
+                }
+            }
+
+//            mapDataDispatcher.printMatrix(waveMatrix);
+            mapDataDispatcher.setWaveMatrix(lev, waveMatrix);
 
         } catch (Exception e) {
 

--
Gitblit v1.9.1