From 9f19c2ea1a1d4e94460eb2d881b7cf8cc10e66df Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期四, 14 十一月 2024 10:42:10 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/manager/service/impl/FuncStaServiceImpl.java | 80 +++++++++++++++++++++++++++++++++++-----
1 files changed, 70 insertions(+), 10 deletions(-)
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/manager/service/impl/FuncStaServiceImpl.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/manager/service/impl/FuncStaServiceImpl.java
index 6ad0dcf..60e3590 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/manager/service/impl/FuncStaServiceImpl.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/manager/service/impl/FuncStaServiceImpl.java
@@ -4,6 +4,7 @@
import com.baomidou.mybatisplus.extension.service.impl.ServiceImpl;
import com.zy.acs.common.enums.AgvStatusType;
import com.zy.acs.framework.common.Cools;
+import com.zy.acs.manager.common.utils.CommonUtil;
import com.zy.acs.manager.manager.entity.*;
import com.zy.acs.manager.manager.enums.FuncStaType;
import com.zy.acs.manager.manager.enums.StatusType;
@@ -14,10 +15,7 @@
import org.springframework.beans.factory.annotation.Autowired;
import org.springframework.stereotype.Service;
-import java.util.ArrayList;
-import java.util.Collections;
-import java.util.Comparator;
-import java.util.List;
+import java.util.*;
import java.util.stream.Collectors;
@Service("funcStaService")
@@ -44,9 +42,8 @@
}
@Override
- public FuncSta query(Long agvId, Long codeId, String type) {
+ public FuncSta query(Long codeId, String type) {
List<FuncSta> list = this.list(new LambdaQueryWrapper<FuncSta>()
- .eq(FuncSta::getAgvId, agvId)
.eq(FuncSta::getCode, codeId)
.eq(FuncSta::getType, type)
);
@@ -152,10 +149,10 @@
@Override
public int compare(FuncSta o1, FuncSta o2) {
Code o1Code = codeService.getById(o1.getCode());
- int o1Distance = calcPositionDistance(startPos, new Double[]{o1Code.getX(), o1Code.getY()});
+ int o1Distance = CommonUtil.calcDistance(startPos, new Double[]{o1Code.getX(), o1Code.getY()});
Code o2Code = codeService.getById(o2.getCode());
- int o2Distance = calcPositionDistance(startPos, new Double[]{o2Code.getX(), o2Code.getY()});
+ int o2Distance = CommonUtil.calcDistance(startPos, new Double[]{o2Code.getX(), o2Code.getY()});
return o1Distance - o2Distance;
}
@@ -166,8 +163,71 @@
return funcStaList.stream().findFirst().orElse(null);
}
- private int calcPositionDistance(Double[] from, Double[] to) {
- return (int) (Math.abs(to[0] - from[0]) + Math.abs(to[1] - from[1]));
+ @Override
+ public Boolean isCanBeIdle(FuncSta funcSta) {
+ Agv agv;
+ switch (Objects.requireNonNull(FuncStaType.query(funcSta.getType()))) {
+ case CHARGE:
+ if (0 < taskService.count(new LambdaQueryWrapper<Task>()
+ .eq(Task::getTaskType, TaskTypeType.TO_CHARGE.val())
+ .eq(Task::getDestCode, funcSta.getCode())
+ .and(i -> {
+ i.eq(Task::getTaskSts, TaskStsType.WAITING.val()).or()
+ .eq(Task::getTaskSts, TaskStsType.ASSIGN.val()).or()
+ .eq(Task::getTaskSts, TaskStsType.PROGRESS.val());
+ })
+ )) {
+ return false;
+ }
+
+ agv = agvService.findByPosition(funcSta.getCode());
+ if (null != agv) {
+ AgvModel agvModel = agvModelService.getById(agv.getAgvModel());
+ AgvDetail agvDetail = agvDetailService.selectByAgvId(agv.getId());
+ if (agvDetail.getAgvStatus().equals(AgvStatusType.CHARGE)) {
+ return false;
+ } else {
+ Task latestTask = taskService.findLatestTask(agv.getId(), null);
+ if (null != latestTask
+ && latestTask.getTaskType().equals(TaskTypeType.TO_CHARGE.val())
+ && latestTask.getDestCode().equals(funcSta.getCode())
+ ) {
+ // avoid the agv already be full battery but there was no task assign to it, so that not in charge status and battery had down
+ if (agvDetailService.isPowerLoss(agv, agvDetail, agvModel)) {
+ return false;
+ }
+ }
+ }
+ }
+ break;
+ case STANDBY:
+ if (0 < taskService.count(new LambdaQueryWrapper<Task>()
+ .eq(Task::getTaskType, TaskTypeType.TO_STANDBY.val())
+ .eq(Task::getDestCode, funcSta.getCode())
+ .and(i -> {
+ i.eq(Task::getTaskSts, TaskStsType.WAITING.val()).or()
+ .eq(Task::getTaskSts, TaskStsType.ASSIGN.val()).or()
+ .eq(Task::getTaskSts, TaskStsType.PROGRESS.val());
+ })
+ )) {
+ return false;
+ }
+
+ agv = agvService.findByPosition(funcSta.getCode());
+ if (null != agv) {
+ Task latestTask = taskService.findLatestTask(agv.getId(), null);
+ if (null != latestTask
+ && latestTask.getTaskType().equals(TaskTypeType.TO_STANDBY.val())
+ && latestTask.getDestCode().equals(funcSta.getCode())
+ ) {
+ return false;
+ }
+ }
+ break;
+ default:
+ break;
+ }
+ return true;
}
}
--
Gitblit v1.9.1