From 89c7f6e5bcc21b0e8f83a2bc6d680e2ffe431e6f Mon Sep 17 00:00:00 2001
From: vincentlu <t1341870251@gmail.com>
Date: 星期一, 13 一月 2025 09:38:29 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AllocateService.java | 174 +++++++++++++++++++++++++---------------------------------
1 files changed, 75 insertions(+), 99 deletions(-)
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AllocateService.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AllocateService.java
index c62fe74..5d6cdb2 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AllocateService.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/AllocateService.java
@@ -2,8 +2,9 @@
import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
import com.zy.acs.framework.common.Cools;
-import com.zy.acs.manager.common.utils.LocUtils;
+import com.zy.acs.manager.common.utils.CommonUtil;
import com.zy.acs.manager.core.domain.Lane;
+import com.zy.acs.manager.core.domain.TaskPosDto;
import com.zy.acs.manager.manager.entity.*;
import com.zy.acs.manager.manager.enums.StatusType;
import com.zy.acs.manager.manager.enums.TaskStsType;
@@ -86,7 +87,7 @@
public synchronized Agv execute(Task task) {
List<Agv> availableAgvList = getAvailableAgv();
if (Cools.isEmpty(availableAgvList)) {
- log.warn("No available agv to assign the task[{}]", task.getSeqNum());
+// log.warn("No available agv to assign the task[{}]", task.getSeqNum());
return null;
}
List<String> availableAgvNos = availableAgvList.stream().map(Agv::getUuid).distinct().collect(Collectors.toList());
@@ -102,7 +103,8 @@
List<String> availableAgvNosByOriLane = new ArrayList<>(availableAgvNos);
if (null != originLane) {
List<String> agvNosByOriLane = findAgvNosByLane(originLane); // the agv list that had tasks in this lane
- if (!Cools.isEmpty(agvNosByOriLane) && agvNosByOriLane.size() >= maxAgvCountInLane) {
+ // if full lane
+ if (agvNosByOriLane.size() >= maxAgvCountInLane) {
availableAgvNosByOriLane = Cools.getIntersection(agvNosByOriLane, availableAgvNos);
}
@@ -115,7 +117,7 @@
List<String> availableAgvNosByDestLane = new ArrayList<>(availableAgvNos);
if (null != destinationLane) {
List<String> agvNosByDestLane = findAgvNosByLane(destinationLane);
- if (!Cools.isEmpty(agvNosByDestLane) && agvNosByDestLane.size() >= maxAgvCountInLane) {
+ if (agvNosByDestLane.size() >= maxAgvCountInLane) {
availableAgvNosByDestLane = Cools.getIntersection(agvNosByDestLane, availableAgvNos);
}
@@ -131,7 +133,6 @@
log.warn("No available agv to assign the task destination[{}]", task.getSeqNum());
return null;
}
-
List<String> actualAvailableAgvNos = Cools.getIntersection(availableAgvNosByOriLane, availableAgvNosByDestLane);
if (Cools.isEmpty(actualAvailableAgvNos)) {
log.warn("No available agv to assign the task[{}]", task.getSeqNum());
@@ -157,17 +158,18 @@
return agvService.selectByUuid(actualAvailableAgvNos.stream().findFirst().orElse(null));
}
- private List<String> findAgvNosByLane(Lane lane) {
+ public List<String> findAgvNosByLane(Lane lane) {
if (null == lane) {
- return null;
+ return new ArrayList<>();
}
List<Task> taskList = taskService.findRunningTasksByLaneHash(lane.getHashCode());
if (Cools.isEmpty(taskList)) {
- return null;
+ return new ArrayList<>();
}
- return taskList.stream().map(task -> {
- return agvService.getById(task.getAgvId()).getUuid();
- }).distinct().collect(Collectors.toList());
+ return taskList.stream()
+ .map(task -> agvService.getById(task.getAgvId()).getUuid())
+ .distinct()
+ .collect(Collectors.toList());
}
private List<String> validBackpackLimit(List<String> agvNoList) {
@@ -176,26 +178,26 @@
}
return agvNoList.stream().filter(agvNo -> {
Agv agv = agvService.selectByUuid(agvNo);
- AgvModel agvModel = agvModelService.getById(agv.getAgvModel());
- List<Task> runningTasks = taskService.findRunningTasksByAgv(agv.getId());
- return runningTasks.size() < agvModel.getBackpack();
+ AgvModel agvModel = agvModelService.getByAgvNo(agvNo);
+ List<Task> transportTasks = taskService.findTransportTasksByAgv(agv.getId());
+ return transportTasks.size() < agvModel.getBackpack();
}).collect(Collectors.toList());
}
// calculate wight = backpack + distance
private int calcAllocateWeight(String agvNo, Task task) {
int weight = 0;
- Agv agv = agvService.selectByUuid(agvNo);
+ Long agvId = agvService.getAgvId(agvNo);
// backpack
- List<Task> runningTasks = taskService.findRunningTasksByAgv(agv.getId());
- if (!Cools.isEmpty(runningTasks)) {
- weight = weight + runningTasks.size() * 100000;
+ List<Task> transportTasks = taskService.findTransportTasksByAgv(agvId);
+ if (!Cools.isEmpty(transportTasks)) {
+ weight = weight + transportTasks.size() * 100000;
}
// distance
// from
- AgvDetail agvDetail = agvDetailService.selectByAgvId(agv.getId());
+ AgvDetail agvDetail = agvDetailService.selectByAgvId(agvId);
Code agvCurrCode = codeService.getById(agvDetail.getRecentCode());
Double[] fromPosition = new Double[]{agvCurrCode.getX(), agvCurrCode.getY()};
// to
@@ -224,99 +226,73 @@
assert null != firstCode;
Double[] toPosition = new Double[]{firstCode.getX(), firstCode.getY()};
// calculate distance
- weight = weight + this.calcPositionDistance(fromPosition, toPosition);
+ weight = weight + CommonUtil.calcDistance(fromPosition, toPosition);
// return opposite
return -weight;
}
- private int calcPositionDistance(Double[] from, Double[] to) {
- return (int) (Math.abs(to[0] - from[0]) + Math.abs(to[1] - from[1]));
+ public Boolean validCapacityOfLane(String agvNo, Code code) {
+ Lane lane = laneService.search(code.getData());
+ if (null != lane) {
+ Integer maxAgvCountInLane = configService.getVal("maxAgvCountInLane", Integer.class);
+
+ List<String> agvNosByLane = this.findAgvNosByLane(lane);
+ agvNosByLane.remove(agvNo);
+ if (agvNosByLane.size() >= maxAgvCountInLane) {
+ return false;
+ }
+ }
+
+ return true;
}
- public synchronized Agv execute(Task task, Map<String, List<Long>> taskAllot, List<Long> taskIds) {
- String oriLocNo = task.getOriLoc$();
- int oriLocRow = LocUtils.getRow(oriLocNo);
- String destLocNo = task.getDestLoc$();
- int destLocRow = LocUtils.getRow(destLocNo);
- Agv hit = null;
+ // The Permutations and combinations for task
- List<Agv> agvList = agvService.list(new LambdaQueryWrapper<Agv>().eq(Agv::getStatus, StatusType.ENABLE.val));
- Collections.shuffle(agvList);
- for (Agv agv : agvList) {
- AgvModel agvModel = agvModelService.getById(agv.getAgvModel());
- int allotTaskCount = 0;
- List<Long> allotTaskIds = taskAllot.get(agv.getUuid());
- if (!Cools.isEmpty(allotTaskIds)) {
- allotTaskCount = allotTaskIds.size();
- }
- if (allotTaskCount >= agvModel.getBackpack()) {
- continue;
- }
- if (taskService.count(new LambdaQueryWrapper<Task>()
- .eq(Task::getAgvId, agv.getId())
- .notIn(Task::getId, taskIds)
- .and(i -> {
- i.eq(Task::getTaskSts, TaskStsType.WAITING.val()) // 宸茬粡鏈墂aiting浠诲姟鐨勮溅涓嶈兘鍐嶅垎閰�
- .or().eq(Task::getTaskSts, TaskStsType.ASSIGN.val())
- .or().eq(Task::getTaskSts, TaskStsType.PROGRESS.val());
- })) > 0) {
- log.info(agv.getUuid() + "鍙稟GV涓嶅彲鐢紝宸茬粡瀛樺湪杩涜涓殑浠诲姟...");
- continue;
- }
- if (!agvService.judgeEnable(agv.getId(), true)) {
- log.info(agv.getUuid() + "鍙稟GV涓嶅彲鐢紝" + task.getSeqNum() + "浠诲姟鏃犳硶璁＄畻...");
- continue;
+ public Double[] pac(Double[] currPosition, List<List<TaskPosDto>> list) {
+ 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);
}
- hit = agv;
- break;
+ } 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);
+ }
+ }
}
- return hit;
- }
-
- public synchronized Agv execute1(Task task, Map<String, List<Long>> taskAllot, List<Long> taskIds) {
- String oriLocNo = task.getOriLoc$();
- int oriLocRow = LocUtils.getRow(oriLocNo);
- String destLocNo = task.getDestLoc$();
- int destLocRow = LocUtils.getRow(destLocNo);
-
- Agv agv = null;
- if (oriLocRow <= 2 && destLocRow <= 2) {
- agv = agvService.selectByUuid(String.valueOf(1));
- }
- if (oriLocRow > 2 && destLocRow > 2) {
- agv = agvService.selectByUuid(String.valueOf(2));
- }
- assert agv != null;
- AgvModel agvModel = agvModelService.getById(agv.getAgvModel());
- int allotTaskCount = 0;
- List<Long> allotTaskIds = taskAllot.get(agv.getUuid());
- if (!Cools.isEmpty(allotTaskIds)) {
- allotTaskCount = allotTaskIds.size();
- }
- if (allotTaskCount >= agvModel.getBackpack()) {
- return null;
- }
- if (taskService.count(new LambdaQueryWrapper<Task>()
- .eq(Task::getAgvId, agv.getId())
- .notIn(Task::getId, taskIds)
- .and(i -> {
- i.eq(Task::getTaskSts, TaskStsType.WAITING.val()) // 宸茬粡鏈墂aiting浠诲姟鐨勮溅涓嶈兘鍐嶅垎閰�
- .or().eq(Task::getTaskSts, TaskStsType.ASSIGN.val())
- .or().eq(Task::getTaskSts, TaskStsType.PROGRESS.val());
- })) > 0) {
- log.info(agv.getUuid() + "鍙稟GV涓嶅彲鐢紝宸茬粡瀛樺湪杩涜涓殑浠诲姟...");
- return null;
- }
- if (!agvService.judgeEnable(agv.getId(), true)) {
- log.info(agv.getUuid() + "鍙稟GV涓嶅彲鐢紝" + task.getSeqNum() + "浠诲姟鏃犳硶璁＄畻...");
- return null;
- }
-
- return agv;
+ theLastOne = list.get(list.size() - 1);
+ return theLastOne.get(theLastOne.size() - 1).getXy();
}
}
--
Gitblit v1.9.1