| | |
| | | import com.zy.core.network.DeviceConnectPool; |
| | | import com.zy.core.network.ZyStationConnectDriver; |
| | | import com.zy.core.network.entity.ZyStationStatusEntity; |
| | | import com.zy.core.service.StationTaskLoopService; |
| | | import com.zy.core.thread.impl.v5.StationV5SegmentExecutor; |
| | | import com.zy.core.trace.StationTaskTraceRegistry; |
| | | import com.zy.core.utils.DeviceLogRedisKeyBuilder; |
| | |
| | | |
| | | private static final int RUN_BLOCK_REROUTE_STATE_EXPIRE_SECONDS = 60 * 60 * 24; |
| | | private static final int SHORT_PATH_REPEAT_AVOID_THRESHOLD = 2; |
| | | private static final int LOOP_REPEAT_TRIGGER_COUNT = 2; |
| | | private static final int LOOP_REPEAT_TRIGGER_COUNT = 3; |
| | | private static final int LOCAL_LOOP_NEIGHBOR_HOP = 3; |
| | | |
| | | private List<StationProtocol> statusList = new ArrayList<>(); |
| | |
| | | } |
| | | |
| | | RunBlockRerouteState rerouteState = loadRunBlockRerouteState(taskNo, stationId); |
| | | TaskLoopRerouteState taskLoopRerouteState = loadTaskLoopRerouteState(taskNo); |
| | | LoopIdentity currentLoopIdentity = resolveStationLoopIdentity(stationId); |
| | | StationTaskLoopService taskLoopService = loadStationTaskLoopService(); |
| | | StationTaskLoopService.LoopEvaluation loopEvaluation = taskLoopService == null |
| | | ? new StationTaskLoopService.LoopEvaluation(taskNo, stationId, StationTaskLoopService.LoopIdentitySnapshot.empty(), 0, 0, false) |
| | | : taskLoopService.evaluateLoop(taskNo, stationId, true); |
| | | log.info("输送线堵塞重规划环线识别,taskNo={}, stationId={}, scopeType={}, localStationCount={}, sourceLoopStationCount={}", |
| | | taskNo, |
| | | stationId, |
| | | currentLoopIdentity.getScopeType(), |
| | | currentLoopIdentity.getLocalStationCount(), |
| | | currentLoopIdentity.getSourceLoopStationCount()); |
| | | loopEvaluation.getLoopIdentity().getScopeType(), |
| | | loopEvaluation.getLoopIdentity().getLocalStationCount(), |
| | | loopEvaluation.getLoopIdentity().getSourceLoopStationCount()); |
| | | rerouteState.setTaskNo(taskNo); |
| | | rerouteState.setBlockStationId(stationId); |
| | | rerouteState.setLastTargetStationId(targetStationId); |
| | | rerouteState.setPlanCount((rerouteState.getPlanCount() == null ? 0 : rerouteState.getPlanCount()) + 1); |
| | | rerouteState.setLastPlanTime(System.currentTimeMillis()); |
| | | taskLoopRerouteState.setTaskNo(taskNo); |
| | | |
| | | List<List<NavigateNode>> candidatePathList = calcCandidatePathNavigateNodes(taskNo, stationId, targetStationId); |
| | | if (candidatePathList.isEmpty()) { |
| | |
| | | |
| | | StationCommand rerouteCommand = selectAvailableRerouteCommand( |
| | | rerouteState, |
| | | taskLoopRerouteState, |
| | | currentLoopIdentity, |
| | | loopEvaluation, |
| | | candidatePathList, |
| | | taskNo, |
| | | stationId, |
| | |
| | | rerouteState.resetIssuedRoutes(); |
| | | rerouteCommand = selectAvailableRerouteCommand( |
| | | rerouteState, |
| | | taskLoopRerouteState, |
| | | currentLoopIdentity, |
| | | loopEvaluation, |
| | | candidatePathList, |
| | | taskNo, |
| | | stationId, |
| | |
| | | |
| | | if (rerouteCommand != null) { |
| | | saveRunBlockRerouteState(rerouteState); |
| | | touchTaskLoopRerouteState(taskLoopRerouteState, currentLoopIdentity); |
| | | syncTaskTraceLoopAlert(taskNo, stationId, currentLoopIdentity, |
| | | resolveCurrentLoopIssuedCount(taskLoopRerouteState, currentLoopIdentity)); |
| | | saveTaskLoopRerouteState(taskLoopRerouteState); |
| | | if (taskLoopService != null) { |
| | | taskLoopService.recordLoopIssue(loopEvaluation, "RUN_BLOCK_REROUTE"); |
| | | } |
| | | log.info("输送线堵塞重规划选中候选路线,taskNo={}, planCount={}, stationId={}, targetStationId={}, route={}", |
| | | taskNo, rerouteState.getPlanCount(), stationId, targetStationId, JSON.toJSONString(rerouteCommand.getNavigatePath())); |
| | | return rerouteCommand; |
| | |
| | | } |
| | | |
| | | private StationCommand selectAvailableRerouteCommand(RunBlockRerouteState rerouteState, |
| | | TaskLoopRerouteState taskLoopRerouteState, |
| | | LoopIdentity currentLoopIdentity, |
| | | StationTaskLoopService.LoopEvaluation loopEvaluation, |
| | | List<List<NavigateNode>> candidatePathList, |
| | | Integer taskNo, |
| | | Integer stationId, |
| | |
| | | } |
| | | |
| | | Set<String> issuedRouteSignatureSet = rerouteState.getIssuedRouteSignatureSet(); |
| | | int currentLoopIssuedCount = resolveExpectedLoopIssuedCount(taskLoopRerouteState, currentLoopIdentity); |
| | | List<RerouteCandidateCommand> candidateCommandList = new ArrayList<>(); |
| | | for (List<NavigateNode> candidatePath : candidatePathList) { |
| | | StationCommand rerouteCommand = buildMoveCommand(taskNo, stationId, targetStationId, palletSize, candidatePath); |
| | |
| | | candidateCommand.setRouteSignature(routeSignature); |
| | | candidateCommand.setPathLength(rerouteCommand.getNavigatePath().size()); |
| | | candidateCommand.setIssuedCount(rerouteState.getRouteIssueCountMap().getOrDefault(routeSignature, 0)); |
| | | candidateCommand.setLoopFingerprint(currentLoopIdentity.getLoopFingerprint()); |
| | | candidateCommand.setLoopIssuedCount(currentLoopIssuedCount); |
| | | candidateCommand.setCurrentLoopHitCount(countCurrentLoopStationHit(rerouteCommand.getNavigatePath(), currentLoopIdentity.getStationIdSet())); |
| | | candidateCommand.setLoopFingerprint(loopEvaluation.getLoopIdentity().getLoopFingerprint()); |
| | | candidateCommand.setLoopIssuedCount(loopEvaluation.getExpectedLoopIssueCount()); |
| | | candidateCommand.setLoopTriggered(loopEvaluation.isLargeLoopTriggered()); |
| | | candidateCommand.setCurrentLoopHitCount(countCurrentLoopStationHit( |
| | | rerouteCommand.getNavigatePath(), |
| | | loopEvaluation.getLoopIdentity().getStationIdSet() |
| | | )); |
| | | candidateCommandList.add(candidateCommand); |
| | | } |
| | | if (candidateCommandList.isEmpty()) { |
| | |
| | | shortestPathOverused = true; |
| | | } |
| | | if (!Cools.isEmpty(candidateCommand.getLoopFingerprint()) |
| | | && candidateCommand.getLoopIssuedCount() != null |
| | | && isLoopRepeatTriggered(candidateCommand.getLoopIssuedCount())) { |
| | | && Boolean.TRUE.equals(candidateCommand.getLoopTriggered())) { |
| | | currentLoopOverused = true; |
| | | } |
| | | } |
| | |
| | | builder.append(stationNo); |
| | | } |
| | | return builder.toString(); |
| | | } |
| | | |
| | | private StationTaskLoopService loadStationTaskLoopService() { |
| | | try { |
| | | return SpringUtils.getBean(StationTaskLoopService.class); |
| | | } catch (Exception ignore) { |
| | | return null; |
| | | } |
| | | } |
| | | |
| | | private String buildRunBlockRerouteStateKey(Integer taskNo, Integer blockStationId) { |
| | |
| | | private Integer issuedCount; |
| | | private String loopFingerprint; |
| | | private Integer loopIssuedCount; |
| | | private Boolean loopTriggered; |
| | | private Integer currentLoopHitCount; |
| | | } |
| | | |