| | |
| | | import java.util.Objects; |
| | | import java.util.concurrent.ExecutorService; |
| | | import java.util.concurrent.Executors; |
| | | import java.util.concurrent.ThreadPoolExecutor; |
| | | |
| | | @Data |
| | | @Slf4j |
| | | public class ZyStationV5Thread implements Runnable, com.zy.core.thread.StationThread { |
| | | |
| | | private static final int SEGMENT_EXECUTOR_POOL_SIZE = 64; |
| | | private static final int EXECUTOR_QUEUE_WARN_THRESHOLD = 20; |
| | | private static final int EXECUTOR_ACTIVE_WARN_THRESHOLD = 48; |
| | | private static final long SEGMENT_EXECUTE_WARN_MS = 10_000L; |
| | | |
| | | private DeviceConfig deviceConfig; |
| | | private RedisUtil redisUtil; |
| | |
| | | if (task == null || task.getStep() == null || task.getStep() != 2) { |
| | | return; |
| | | } |
| | | submitSegmentCommand((StationCommand) task.getData()); |
| | | StationCommand command = (StationCommand) task.getData(); |
| | | logExecutorAbnormal("queue-poll", command); |
| | | submitSegmentCommand(command); |
| | | } |
| | | |
| | | private void submitSegmentCommand(StationCommand command) { |
| | | if (command == null || executor == null || segmentExecutor == null) { |
| | | return; |
| | | } |
| | | executor.submit(() -> segmentExecutor.execute(command)); |
| | | executor.submit(() -> { |
| | | long start = System.currentTimeMillis(); |
| | | try { |
| | | segmentExecutor.execute(command); |
| | | } finally { |
| | | long costMs = System.currentTimeMillis() - start; |
| | | if (costMs >= SEGMENT_EXECUTE_WARN_MS) { |
| | | log.warn("V5输送命令分段执行耗时过长,deviceNo={}, taskNo={}, stationId={}, targetStaNo={}, costMs={}", |
| | | deviceConfig.getDeviceNo(), |
| | | command.getTaskNo(), |
| | | command.getStationId(), |
| | | command.getTargetStaNo(), |
| | | costMs); |
| | | logExecutorAbnormal("segment-finish-slow", command); |
| | | } |
| | | } |
| | | }); |
| | | logExecutorAbnormal("after-submit", command); |
| | | } |
| | | |
| | | @Override |
| | |
| | | return getCommand(StationCommandType.MOVE, taskNo, stationId, targetStationId, palletSize, pathLenFactor); |
| | | } |
| | | |
| | | long startNs = System.nanoTime(); |
| | | StationTaskLoopService taskLoopService = loadStationTaskLoopService(); |
| | | StationTaskLoopService.LoopEvaluation loopEvaluation = taskLoopService == null |
| | | ? new StationTaskLoopService.LoopEvaluation(taskNo, stationId, StationTaskLoopService.LoopIdentitySnapshot.empty(), 0, 0, false) |
| | | : taskLoopService.evaluateLoop(taskNo, stationId, true); |
| | | long loopEvalNs = System.nanoTime(); |
| | | log.info("输送线堵塞重规划环线识别,taskNo={}, stationId={}, scopeType={}, localStationCount={}, sourceLoopStationCount={}", |
| | | taskNo, |
| | | stationId, |
| | |
| | | loopEvaluation.getLoopIdentity().getLocalStationCount(), |
| | | loopEvaluation.getLoopIdentity().getSourceLoopStationCount()); |
| | | List<List<NavigateNode>> candidatePathList = calcCandidatePathNavigateNodes(taskNo, stationId, targetStationId, pathLenFactor); |
| | | long candidatePathNs = System.nanoTime(); |
| | | List<StationCommand> candidateCommandList = new ArrayList<>(); |
| | | for (List<NavigateNode> candidatePath : candidatePathList) { |
| | | StationCommand rerouteCommand = buildMoveCommand(taskNo, stationId, targetStationId, palletSize, candidatePath); |
| | |
| | | } |
| | | candidateCommandList.add(rerouteCommand); |
| | | } |
| | | long buildCommandNs = System.nanoTime(); |
| | | |
| | | StationV5RunBlockReroutePlanner.PlanResult planResult = runBlockReroutePlanner.plan( |
| | | taskNo, |
| | |
| | | loopEvaluation, |
| | | candidateCommandList |
| | | ); |
| | | long planNs = System.nanoTime(); |
| | | logRunBlockRerouteCost(taskNo, |
| | | stationId, |
| | | targetStationId, |
| | | candidatePathList == null ? 0 : candidatePathList.size(), |
| | | candidateCommandList.size(), |
| | | startNs, |
| | | loopEvalNs, |
| | | candidatePathNs, |
| | | buildCommandNs, |
| | | planNs); |
| | | if (candidateCommandList.isEmpty()) { |
| | | log.warn("输送线堵塞重规划失败,候选路径为空,taskNo={}, planCount={}, stationId={}, targetStationId={}", |
| | | taskNo, planResult.getPlanCount(), stationId, targetStationId); |
| | |
| | | continue; |
| | | } |
| | | found = true; |
| | | Integer clearedTaskNo = item.getTaskNo(); |
| | | if (!zyStationConnectDriver.clearTaskBufferSlot(stationId, item.getSlotIdx())) { |
| | | success = false; |
| | | log.warn("输送站缓存区残留路径清理失败。stationId={}, slotIdx={}, taskNo={}", |
| | | stationId, item.getSlotIdx(), item.getTaskNo()); |
| | | stationId, item.getSlotIdx(), clearedTaskNo); |
| | | continue; |
| | | }else { |
| | | item.setTaskNo(0); |
| | | item.setTargetStaNo(0); |
| | | success = true; |
| | | log.warn("输送站缓存区残留路径清理成功。stationId={}, slotIdx={}, taskNo={}", |
| | | stationId, item.getSlotIdx(), item.getTaskNo()); |
| | | } |
| | | item.setTaskNo(0); |
| | | item.setTargetStaNo(0); |
| | | log.warn("输送站缓存区残留路径清理成功。stationId={}, slotIdx={}, taskNo={}", |
| | | stationId, item.getSlotIdx(), clearedTaskNo); |
| | | } |
| | | } |
| | | return found && success; |
| | | } |
| | | |
| | | @Override |
| | | public boolean clearPathByStationSlot(Integer stationId, Integer slotIdx) { |
| | | if (stationId == null || slotIdx == null || zyStationConnectDriver == null) { |
| | | return false; |
| | | } |
| | | List<StationProtocol> status = getStatus(); |
| | | if (status == null || status.isEmpty()) { |
| | | return false; |
| | | } |
| | | |
| | | for (StationProtocol stationProtocol : status) { |
| | | if (stationProtocol == null || !Objects.equals(stationId, stationProtocol.getStationId())) { |
| | | continue; |
| | | } |
| | | if (!zyStationConnectDriver.clearTaskBufferSlot(stationId, slotIdx)) { |
| | | log.warn("输送站缓存区残留路径按站点槽位清理失败。stationId={}, slotIdx={}", stationId, slotIdx); |
| | | return false; |
| | | } |
| | | List<StationTaskBufferItem> taskBufferItems = stationProtocol.getTaskBufferItems(); |
| | | if (taskBufferItems != null) { |
| | | for (StationTaskBufferItem item : taskBufferItems) { |
| | | if (item != null && Objects.equals(slotIdx, item.getSlotIdx())) { |
| | | item.setTaskNo(0); |
| | | item.setTargetStaNo(0); |
| | | break; |
| | | } |
| | | } |
| | | } |
| | | log.warn("输送站缓存区残留路径按站点槽位清理成功。stationId={}, slotIdx={}", stationId, slotIdx); |
| | | return true; |
| | | } |
| | | return false; |
| | | } |
| | | |
| | | @Override |
| | |
| | | optService.save(basStationOpt); |
| | | } |
| | | return commandResponse; |
| | | } |
| | | |
| | | private void logExecutorAbnormal(String scene, StationCommand command) { |
| | | if (!(executor instanceof ThreadPoolExecutor)) { |
| | | return; |
| | | } |
| | | ThreadPoolExecutor threadPoolExecutor = (ThreadPoolExecutor) executor; |
| | | int activeCount = threadPoolExecutor.getActiveCount(); |
| | | int queuedCount = threadPoolExecutor.getQueue() == null ? 0 : threadPoolExecutor.getQueue().size(); |
| | | if (activeCount < EXECUTOR_ACTIVE_WARN_THRESHOLD && queuedCount < EXECUTOR_QUEUE_WARN_THRESHOLD) { |
| | | return; |
| | | } |
| | | log.warn("V5输送线程池出现堆积,scene={}, deviceNo={}, taskNo={}, stationId={}, targetStaNo={}, poolSize={}, activeCount={}, queuedCount={}, completedCount={}", |
| | | scene, |
| | | deviceConfig.getDeviceNo(), |
| | | command == null ? null : command.getTaskNo(), |
| | | command == null ? null : command.getStationId(), |
| | | command == null ? null : command.getTargetStaNo(), |
| | | threadPoolExecutor.getPoolSize(), |
| | | activeCount, |
| | | queuedCount, |
| | | threadPoolExecutor.getCompletedTaskCount()); |
| | | } |
| | | |
| | | @Override |
| | |
| | | return null; |
| | | } |
| | | } |
| | | |
| | | private void logRunBlockRerouteCost(Integer taskNo, |
| | | Integer stationId, |
| | | Integer targetStationId, |
| | | int candidatePathCount, |
| | | int candidateCommandCount, |
| | | long startNs, |
| | | long loopEvalNs, |
| | | long candidatePathNs, |
| | | long buildCommandNs, |
| | | long planNs) { |
| | | long totalMs = nanosToMillis(planNs - startNs); |
| | | if (totalMs < 1000L) { |
| | | return; |
| | | } |
| | | log.warn("输送线堵塞重规划耗时较长, taskNo={}, stationId={}, targetStationId={}, total={}ms, loopEval={}ms, candidatePath={}ms, buildCommand={}ms, planner={}ms, candidatePathCount={}, candidateCommandCount={}", |
| | | taskNo, |
| | | stationId, |
| | | targetStationId, |
| | | totalMs, |
| | | nanosToMillis(loopEvalNs - startNs), |
| | | nanosToMillis(candidatePathNs - loopEvalNs), |
| | | nanosToMillis(buildCommandNs - candidatePathNs), |
| | | nanosToMillis(planNs - buildCommandNs), |
| | | candidatePathCount, |
| | | candidateCommandCount); |
| | | } |
| | | |
| | | private long nanosToMillis(long nanos) { |
| | | return nanos <= 0L ? 0L : nanos / 1_000_000L; |
| | | } |
| | | } |