#

luxiaotao1123

2025-01-07 0a3cbfd5731c46c2a89cc6a7b4ff5096dc89a315

 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java

@@ -5,9 +5,9 @@
import com.zy.acs.framework.common.Cools;
import com.zy.acs.manager.common.utils.MapDataUtils;
import com.zy.acs.manager.core.constant.MapDataConstant;
import com.zy.acs.manager.core.domain.UnlockPathTask;
import com.zy.acs.manager.core.service.astart.*;
import com.zy.acs.manager.core.service.astart.domain.AStarNavigateNode;
import com.zy.acs.manager.core.service.astart.domain.DynamicNode;
import com.zy.acs.manager.core.service.floyd.FloydNavigateService;
import com.zy.acs.manager.manager.entity.Code;
import com.zy.acs.manager.manager.entity.Loc;
@@ -16,12 +16,13 @@
import com.zy.acs.manager.manager.service.CodeService;
import com.zy.acs.manager.system.service.ConfigService;
import lombok.extern.slf4j.Slf4j;
import org.apache.commons.lang.time.StopWatch;
import org.springframework.beans.factory.annotation.Autowired;
import org.springframework.beans.factory.annotation.Value;
import org.springframework.stereotype.Component;

import java.util.*;
import java.util.concurrent.LinkedBlockingQueue;
import java.util.concurrent.TimeUnit;
import java.util.stream.Collectors;

/**
@@ -45,6 +46,8 @@
    private ConfigService configService;
    @Autowired
    private ActionService actionService;
    @Autowired
    private LinkedBlockingQueue<UnlockPathTask> unlockTaskQueue;

    /**
     * 寻址 ===>> A Star
@@ -173,61 +176,16 @@
    }

    public void lockPath(Integer lev, List<String> pathList, String agvNo) {
        mapDataDispatcher.modifyDynamicMatrix(lev, pathList, agvNo);
        List<int[]> codeMatrixIdxList = mapDataDispatcher.getCodeMatrixIdxList(lev, pathList);
        mapDataDispatcher.modifyDynamicMatrix(lev, codeMatrixIdxList, agvNo);
    }

    public synchronized void unlockPath(String agvNo, String codeData) {
    public void unlockPath(String agvNo, String codeData) {
        try {
            StopWatch stopWatch = new StopWatch();
            stopWatch.start();

            if (Cools.isEmpty(agvNo, codeData)) {
                return;
            }

            Integer lev = null;

            String[][] codeMatrix = mapDataDispatcher.getCodeMatrix(null);
            int[] codeMatrixIdx = mapDataDispatcher.getCodeMatrixIdx(lev, codeData);


            DynamicNode[][] dynamicMatrix = mapDataDispatcher.getDynamicMatrix(lev);

            DynamicNode dynamicNode = dynamicMatrix[codeMatrixIdx[0]][codeMatrixIdx[1]];


            Integer serial = dynamicNode.getSerial();

            List<String> resetCodeList = new ArrayList<>();

            for (int i = 0; i < dynamicMatrix.length; i++) {
                for (int j = 0; j < dynamicMatrix[i].length; j++) {

//                    if (i == codeMatrixIdx[0] && j == codeMatrixIdx[1]) { continue; }

                    DynamicNode node = dynamicMatrix[i][j];
                    if (node.getVehicle().equals(agvNo)) {
                        if (node.getSerial() < serial) {
                            resetCodeList.add(codeMatrix[i][j]);
                        }
                    }
                }
            }

            if (!Cools.isEmpty(resetCodeList)) {

                mapDataDispatcher.clearDynamicMatrixByCodeList(lev, resetCodeList);
            }

            stopWatch.stop();
            if (stopWatch.getTime() > 50) {
                log.info("解锁路径函数花费时间为：{}毫秒......", stopWatch.getTime());
            }

        } catch (Exception e) {
            log.error("MapService.unlockPath", e);
            unlockTaskQueue.offer(new UnlockPathTask(agvNo, codeData), 5, TimeUnit.SECONDS);
        } catch (InterruptedException e) {
            log.error("unlockTaskQueue", e);
        }

    }

    public List<String> getWaveScopeByCodeList(Integer lev, List<String> codeList, Double radiusLen) {