| | |
| | | @Autowired |
| | | private StationTaskTraceRegistry stationTaskTraceRegistry; |
| | | |
| | | public synchronized List<NavigateNode> calcOptimalPathByStationId(Integer startStationId, |
| | | public List<NavigateNode> calcOptimalPathByStationId(Integer startStationId, |
| | | Integer endStationId, |
| | | Integer currentTaskNo, |
| | | Double pathLenFactor) { |
| | | return calcPathByStationId(startStationId, endStationId, currentTaskNo, pathLenFactor, StationPathCalcMode.OPTIMAL); |
| | | } |
| | | |
| | | public synchronized List<NavigateNode> calcReachablePathByStationId(Integer startStationId, Integer endStationId) { |
| | | public List<NavigateNode> calcReachablePathByStationId(Integer startStationId, Integer endStationId) { |
| | | return calcPathByStationId(startStationId, endStationId, null, null, StationPathCalcMode.REACHABILITY); |
| | | } |
| | | |
| | | public synchronized List<List<NavigateNode>> calcCandidatePathByStationId(Integer startStationId, |
| | | public List<List<NavigateNode>> calcCandidatePathByStationId(Integer startStationId, |
| | | Integer endStationId, |
| | | Integer currentTaskNo, |
| | | Double pathLenFactor) { |
| | |
| | | return normalizeCandidatePaths(orderedPathList); |
| | | } |
| | | |
| | | public synchronized Map<Integer, Set<Integer>> loadUndirectedStationGraphSnapshot() { |
| | | public Map<Integer, Set<Integer>> loadUndirectedStationGraphSnapshot() { |
| | | Map<Integer, Set<Integer>> graph = loadUndirectedStationGraph(); |
| | | Map<Integer, Set<Integer>> snapshot = new HashMap<>(); |
| | | for (Map.Entry<Integer, Set<Integer>> entry : graph.entrySet()) { |
| | |
| | | return snapshot; |
| | | } |
| | | |
| | | private synchronized List<NavigateNode> calcPathByStationId(Integer startStationId, |
| | | private List<NavigateNode> calcPathByStationId(Integer startStationId, |
| | | Integer endStationId, |
| | | Integer currentTaskNo, |
| | | Double pathLenFactor, |
| | |
| | | return normalizeStationPath(list); |
| | | } |
| | | |
| | | public synchronized List<NavigateNode> calcByTrackSiteNo(int lev, Integer startTrackSiteNo, Integer endTrackSiteNo) { |
| | | public List<NavigateNode> calcByTrackSiteNo(int lev, Integer startTrackSiteNo, Integer endTrackSiteNo) { |
| | | NavigateSolution navigateSolution = new NavigateSolution(); |
| | | List<List<NavigateNode>> rgvTrackMap = navigateSolution.getRgvTrackMap(lev); |
| | | |
| | |
| | | return fitlerList; |
| | | } |
| | | |
| | | public synchronized List<NavigateNode> findLiftStationList(int lev) { |
| | | public List<NavigateNode> findLiftStationList(int lev) { |
| | | NavigateSolution navigateSolution = new NavigateSolution(); |
| | | List<List<NavigateNode>> stationMap = navigateSolution.getStationMap(lev); |
| | | |
| | |
| | | } |
| | | |
| | | @Override |
| | | public synchronized StationCommand getRunBlockRerouteCommand(Integer taskNo, |
| | | public StationCommand getRunBlockRerouteCommand(Integer taskNo, |
| | | Integer stationId, |
| | | Integer targetStationId, |
| | | Integer palletSize) { |
| | |
| | | } |
| | | |
| | | @Override |
| | | public synchronized StationCommand getRunBlockRerouteCommand(Integer taskNo, |
| | | public StationCommand getRunBlockRerouteCommand(Integer taskNo, |
| | | Integer stationId, |
| | | Integer targetStationId, |
| | | Integer palletSize, |
| | |
| | | } |
| | | |
| | | @Override |
| | | public synchronized boolean clearPath(Integer taskNo) { |
| | | public boolean clearPath(Integer taskNo) { |
| | | if (taskNo == null || taskNo <= 0) { |
| | | return false; |
| | | } |
| | |
| | | if (wrkMast == null || wrkMast.getStaNo() == null) { |
| | | return null; |
| | | } |
| | | DecisionPathCache decisionPathCache = new DecisionPathCache(); |
| | | if (!shouldApplyOutOrder(wrkMast, outOrderStationIds)) { |
| | | return OutOrderDispatchDecision.direct(wrkMast.getStaNo()); |
| | | } |
| | |
| | | wrkMast.getSourceStaNo(), |
| | | wrkMast.getStaNo(), |
| | | outOrderStationIds, |
| | | pathLenFactor |
| | | pathLenFactor, |
| | | decisionPathCache |
| | | ); |
| | | if (dispatchStationId == null) { |
| | | return null; |
| | | } |
| | | if (isCurrentOutOrderDispatchStation(currentStationId, wrkMast, outOrderStationIds, pathLenFactor)) { |
| | | return resolveCurrentOutOrderDispatchDecision(currentStationId, wrkMast, outOrderStationIds, pathLenFactor); |
| | | if (isCurrentOutOrderDispatchStation(currentStationId, wrkMast, outOrderStationIds, pathLenFactor, decisionPathCache)) { |
| | | return resolveCurrentOutOrderDispatchDecision(currentStationId, wrkMast, outOrderStationIds, pathLenFactor, decisionPathCache); |
| | | } |
| | | if (!Objects.equals(dispatchStationId, wrkMast.getStaNo()) |
| | | && isCurrentOutOrderStation(currentStationId, outOrderStationIds) |
| | |
| | | Integer sourceStationId, |
| | | Integer targetStationId, |
| | | Double pathLenFactor) { |
| | | return calcOutboundNavigatePath(wrkMast, sourceStationId, targetStationId, pathLenFactor, null); |
| | | } |
| | | |
| | | private List<NavigateNode> calcOutboundNavigatePath(WrkMast wrkMast, |
| | | Integer sourceStationId, |
| | | Integer targetStationId, |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | Double normalizedFactor = normalizePathLenFactor(pathLenFactor); |
| | | Integer currentTaskNo = wrkMast == null ? null : wrkMast.getWrkNo(); |
| | | if (decisionPathCache == null) { |
| | | if (currentTaskNo == null) { |
| | | return navigateUtils.calcOptimalPathByStationId(sourceStationId, targetStationId, null, normalizedFactor); |
| | | } |
| | | return navigateUtils.calcOptimalPathByStationId(sourceStationId, targetStationId, currentTaskNo, normalizedFactor); |
| | | } |
| | | String cacheKey = buildPathCacheKey(currentTaskNo, sourceStationId, targetStationId, normalizedFactor); |
| | | List<NavigateNode> cachedPath = decisionPathCache.pathMap.get(cacheKey); |
| | | if (cachedPath != null) { |
| | | return cachedPath; |
| | | } |
| | | List<NavigateNode> path = currentTaskNo == null |
| | | ? navigateUtils.calcOptimalPathByStationId(sourceStationId, targetStationId, null, normalizedFactor) |
| | | : navigateUtils.calcOptimalPathByStationId(sourceStationId, targetStationId, currentTaskNo, normalizedFactor); |
| | | if (path == null) { |
| | | path = Collections.emptyList(); |
| | | } |
| | | decisionPathCache.pathMap.put(cacheKey, path); |
| | | return path; |
| | | } |
| | | |
| | | private boolean isBatchOutboundTaskWithSeq(WrkMast wrkMast) { |
| | |
| | | private boolean isCurrentOutOrderDispatchStation(Integer currentStationId, |
| | | WrkMast wrkMast, |
| | | List<Integer> outOrderStationIds, |
| | | Double pathLenFactor) { |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | if (!shouldApplyOutOrder(wrkMast, outOrderStationIds) || currentStationId == null) { |
| | | return false; |
| | | } |
| | |
| | | wrkMast.getSourceStaNo(), |
| | | wrkMast.getStaNo(), |
| | | outOrderStationIds, |
| | | pathLenFactor |
| | | pathLenFactor, |
| | | decisionPathCache |
| | | ); |
| | | return dispatchStationId != null |
| | | && !Objects.equals(dispatchStationId, wrkMast.getStaNo()) |
| | |
| | | private OutOrderDispatchDecision resolveCurrentOutOrderDispatchDecision(Integer currentStationId, |
| | | WrkMast wrkMast, |
| | | List<Integer> outOrderStationIds, |
| | | Double pathLenFactor) { |
| | | if (!isCurrentOutOrderDispatchStation(currentStationId, wrkMast, outOrderStationIds, pathLenFactor)) { |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | if (!isCurrentOutOrderDispatchStation(currentStationId, wrkMast, outOrderStationIds, pathLenFactor, decisionPathCache)) { |
| | | return null; |
| | | } |
| | | |
| | |
| | | |
| | | List<NavigateNode> initPath; |
| | | try { |
| | | initPath = calcOutboundNavigatePath(wrkMast, wrkMast.getSourceStaNo(), wrkMast.getStaNo(), pathLenFactor); |
| | | initPath = calcOutboundNavigatePath(wrkMast, wrkMast.getSourceStaNo(), wrkMast.getStaNo(), pathLenFactor, decisionPathCache); |
| | | } catch (Exception e) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "批次:{} 计算排序路径失败,当前站点={}", wrkMast.getBatch(), currentStationId); |
| | | return null; |
| | |
| | | ? currentBatchSeq.equals(wrkMast.getBatchSeq()) |
| | | : Integer.valueOf(seq + 1).equals(wrkMast.getBatchSeq()); |
| | | if (toTarget) { |
| | | if (hasReachableOutReleaseSlot(wrkMast, currentStationId, wrkMast.getStaNo(), pathLenFactor)) { |
| | | if (hasReachableOutReleaseSlot(wrkMast, currentStationId, wrkMast.getStaNo(), pathLenFactor, decisionPathCache)) { |
| | | return OutOrderDispatchDecision.direct(wrkMast.getStaNo()); |
| | | } |
| | | StationTaskLoopService.LoopEvaluation loopEvaluation = evaluateOutOrderLoop( |
| | |
| | | currentStationId, |
| | | outOrderStationIds, |
| | | loopEvaluation.getExpectedLoopIssueCount(), |
| | | pathLenFactor |
| | | pathLenFactor, |
| | | decisionPathCache |
| | | ); |
| | | if (circleTarget == null) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "目标站当前不可进,且未找到可执行的下一排序检测点,当前站点={}", currentStationId); |
| | |
| | | currentStationId, |
| | | outOrderStationIds, |
| | | loopEvaluation.getExpectedLoopIssueCount(), |
| | | pathLenFactor |
| | | pathLenFactor, |
| | | decisionPathCache |
| | | ); |
| | | if (circleTarget == null) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "未找到可执行的下一排序检测点,当前站点={}", currentStationId); |
| | |
| | | Integer sourceStationId, |
| | | Integer finalTargetStationId, |
| | | List<Integer> outOrderList, |
| | | Double pathLenFactor) { |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | if (finalTargetStationId == null) { |
| | | return null; |
| | | } |
| | |
| | | } |
| | | |
| | | try { |
| | | List<NavigateNode> nodes = calcOutboundNavigatePath(wrkMast, sourceStationId, finalTargetStationId, pathLenFactor); |
| | | List<NavigateNode> nodes = calcOutboundNavigatePath(wrkMast, sourceStationId, finalTargetStationId, pathLenFactor, decisionPathCache); |
| | | for (int i = nodes.size() - 1; i >= 0; i--) { |
| | | Integer stationId = getStationIdFromNode(nodes.get(i)); |
| | | if (stationId == null) { |
| | |
| | | private boolean hasReachableOutReleaseSlot(WrkMast wrkMast, |
| | | Integer currentStationId, |
| | | Integer finalTargetStationId, |
| | | Double pathLenFactor) { |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | if (currentStationId == null || finalTargetStationId == null) { |
| | | return true; |
| | | } |
| | | |
| | | try { |
| | | List<NavigateNode> nodes = calcOutboundNavigatePath(wrkMast, currentStationId, finalTargetStationId, pathLenFactor); |
| | | List<NavigateNode> nodes = calcOutboundNavigatePath(wrkMast, currentStationId, finalTargetStationId, pathLenFactor, decisionPathCache); |
| | | if (nodes == null || nodes.isEmpty()) { |
| | | return true; |
| | | } |
| | |
| | | Integer currentStationId, |
| | | List<Integer> orderedOutStationList, |
| | | Integer expectedLoopIssueCount, |
| | | Double pathLenFactor) { |
| | | Double pathLenFactor, |
| | | DecisionPathCache decisionPathCache) { |
| | | if (currentStationId == null || orderedOutStationList == null || orderedOutStationList.size() <= 1) { |
| | | return null; |
| | | } |
| | |
| | | continue; |
| | | } |
| | | try { |
| | | List<NavigateNode> path = calcOutboundNavigatePath(wrkMast, currentStationId, candidateStationId, pathLenFactor); |
| | | List<NavigateNode> path = calcOutboundNavigatePath(wrkMast, currentStationId, candidateStationId, pathLenFactor, decisionPathCache); |
| | | if (path != null && !path.isEmpty()) { |
| | | candidateList.add(new CircleTargetCandidate(candidateStationId, path.size(), offset)); |
| | | } |
| | |
| | | return pathLenFactor; |
| | | } |
| | | |
| | | private String buildPathCacheKey(Integer currentTaskNo, |
| | | Integer sourceStationId, |
| | | Integer targetStationId, |
| | | Double normalizedFactor) { |
| | | return String.valueOf(currentTaskNo) + "->" |
| | | + String.valueOf(sourceStationId) + "->" |
| | | + String.valueOf(targetStationId) + "@" |
| | | + String.format(java.util.Locale.ROOT, "%.4f", normalizedFactor == null ? 0.0d : normalizedFactor); |
| | | } |
| | | |
| | | private boolean isBlank(String value) { |
| | | return value == null || value.trim().isEmpty(); |
| | | } |
| | | |
| | | private static class DecisionPathCache { |
| | | private final Map<String, List<NavigateNode>> pathMap = new HashMap<>(); |
| | | } |
| | | } |