From f3481e45dbca9adac7e95c4f7c6f1bd08d681fc2 Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期四, 21 十一月 2024 08:40:01 +0800
Subject: [PATCH] #

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java |   85 ++++++++++++++++++++----------------------
 1 files changed, 40 insertions(+), 45 deletions(-)

diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
index 297d0f4..3b6ad34 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
@@ -350,13 +350,19 @@
             /**
              * 1.Map<String, List<TaskPosDto>> groups
              *
-             * key: 1000 + ORI_LOC
+             * key: 1000 + ORIGIN
              * val: [TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType), TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType),...]
              *
-             * key: 3000 + ORI_LOC
+             * key: 3000 + ORIGIN
              * val: [TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType), TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType),...]
              *
-             * key: 2000 + ORI_LOC
+             * key: 2000 + ORIGIN
+             * val: [TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType), TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType),...]
+             *
+             * key: 1000 + DESTINATION
+             * val: [TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType), TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType),...]
+             *
+             * key: 2000 + DESTINATION
              * val: [TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType), TaskPosDto(taskId, new Double[]{code.getX(), code.getY()}, posType),...]
              *
              * ......
@@ -374,6 +380,8 @@
              * 瀵规墍鏈夊贩閬撹繘琛屾湁搴忔帓搴忥紝鍏堟槸閽堝List涓轰竴涓崟浣嶏紝瀵逛粬浠繘琛孎irstWeight鎺掑簭锛岀浉褰撲簬琛�1鐨刱ey鐨勬暟鍊艰繘琛屾湁搴忔帓搴�
              *  List<TaskPosDto>: task list on the same lane
              *  ArrayList<List<TaskPosDto>>: all the task list by one agv
+             *
+             *  tip: ORI 鍜� DEST 姘歌繙涓嶄細瀛樺湪鍚屼竴涓� List
              */
             ArrayList<List<TaskPosDto>> list = new ArrayList<>(groups.values());
             list.sort((o1, o2) -> {
@@ -387,48 +395,35 @@
             }
 
             // re-order by agv current position
-//            Code currCode = codeService.getById(agvDetail.getRecentCode());
-//            Double[] currPosition = new Double[] {currCode.getX(), currCode.getY()};
-//
-//            List<TaskPosDto> theFirstOne = list.get(0);
-//            List<TaskPosDto> theLastOne = list.get(list.size() - 1);
-//
-//            if (list.size() == 1) {
-//                TaskPosDto head = theFirstOne.get(0);
-//                TaskPosDto tail = theFirstOne.get(theFirstOne.size() - 1);
-//
-//                int distanceByHead = CommonUtil.calcDistance(currPosition, head.getXy());
-//                int distanceByTail = CommonUtil.calcDistance(currPosition, tail.getXy());
-//
-//                if (distanceByTail < distanceByHead) {
-//                    Collections.reverse(theFirstOne);
-//                }
-//
-//            } else {
-//                TaskPosDto headOfFirst = theFirstOne.get(0);
-//                TaskPosDto tailOfFirst = theFirstOne.get(theFirstOne.size() - 1);
-//
-//                TaskPosDto headOfLast = theLastOne.get(0);
-//                TaskPosDto tailOfLast = theLastOne.get(theLastOne.size() - 1);
-//
-//                int distanceByHeadOfFirst = CommonUtil.calcDistance(currPosition, headOfFirst.getXy());
-//                int distanceByTailOfFirst = CommonUtil.calcDistance(currPosition, tailOfFirst.getXy());
-//
-//                int distanceByHeadOfLast = CommonUtil.calcDistance(currPosition, headOfLast.getXy());
-//                int distanceByTailOfLast = CommonUtil.calcDistance(currPosition, tailOfLast.getXy());
-//
-//                if (Math.min(distanceByHeadOfLast, distanceByTailOfLast) < Math.min(distanceByHeadOfFirst, distanceByTailOfFirst)) {
-//                    Collections.reverse(list);
-//
-//                    if (distanceByTailOfLast < distanceByHeadOfLast) {
-//                        Collections.reverse(theLastOne);
-//                    }
-//                } else {
-//                    if (distanceByTailOfFirst < distanceByHeadOfFirst) {
-//                        Collections.reverse(theFirstOne);
-//                    }
-//                }
-//            }
+            Code currCode = codeService.getById(agvDetail.getRecentCode());
+            Double[] currPosition = new Double[] {currCode.getX(), currCode.getY()};
+
+            List<List<TaskPosDto>> pickGroups = new ArrayList<>();
+            List<List<TaskPosDto>> dropGroups = new ArrayList<>();
+
+            for (List<TaskPosDto> group : list) {
+                // Assume 涓�涓换鍔$粍涓墍鏈塗askPosDto鐨凱osType.brief鐩稿悓
+                TaskPosDto.PosType posType = group.get(0).getPosType();
+                if (posType == TaskPosDto.PosType.ORI_LOC || posType == TaskPosDto.PosType.ORI_STA) {
+                    pickGroups.add(group);
+                } else if (posType == TaskPosDto.PosType.DEST_LOC || posType == TaskPosDto.PosType.DEST_STA) {
+                    dropGroups.add(group);
+                } else {
+                    // import tip: the list must only contain ORIGIN and DESTINATION
+                    log.error("the list must only contain ORIGIN and DESTINATION");
+                }
+            }
+
+            currPosition = allocateService.pac(currPosition, pickGroups);
+            currPosition = allocateService.pac(currPosition, dropGroups);
+
+            List<List<TaskPosDto>> reorderedList = new ArrayList<>();
+            reorderedList.addAll(pickGroups);
+            reorderedList.addAll(dropGroups);
+
+            list.clear();
+            list.addAll(reorderedList);
+
 
             // generate travel
             Travel travel = new Travel();

--
Gitblit v1.9.1