#

luxiaotao1123

2025-01-08 aa6f20d98b5d8e18ae56f9562a78d403a5417b48

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

@@ -1,13 +1,14 @@
package com.zy.acs.manager.core.service;

import com.alibaba.fastjson.JSONObject;
import com.zy.acs.common.enums.AgvDirectionType;
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.SortCodeDto;
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;
@@ -21,9 +22,11 @@
import org.springframework.stereotype.Component;

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

/**
 * Created by vincent on 2023/6/14
@@ -121,7 +124,7 @@


    // 角度计算
    public Double calculateDirection(Code startCode, Code endCode) {
    public Double calculateDirection(Code startCode, Code endCode, int angleOffsetVal) {
        Double x0 = startCode.getX();
        Double y0 = startCode.getY();

@@ -131,7 +134,6 @@
        double deltaX = x1 - x0;
        double deltaY = y1 - y0;
        double angle = -Math.atan2(deltaX, deltaY);
        int angleOffsetVal = configService.getVal("mapAngleOffsetVal", Integer.class);
        angle = Math.toDegrees(angle) + angleOffsetVal;
        angle = (angle + 360) % 360; // 将角度转换为正值

@@ -139,8 +141,7 @@
    }

    // 坐标货架阈值 todo:luxiaotao
    public AgvDirectionType calculateAgvWorkDirection(JSONObject storeDirection, Loc loc, Code code) {
        storeDirection.getString("key");
    public AgvDirectionType calculateAgvWorkDirection(Loc loc, Code code) {
        Integer compDirect = loc.getCompDirect();
        AgvDirectionType agvDirectionType = null;
        if (compDirect == 0) {
@@ -364,4 +365,103 @@
        return turnMatrixNode == TurnNodeType.TURN.val;
    }

    /**
     * That vehicle is walking if the dynamic node count > 1
     */
    @SuppressWarnings("all")
    public boolean isWalkingByVehicle(Integer lev, String vehicle) {
        if (Cools.isEmpty(vehicle)) {
            return false;
        }

        lev = Optional.ofNullable(lev).orElse(MapDataDispatcher.MAP_DEFAULT_LEV);
        DynamicNode[][] dynamicMatrix = mapDataDispatcher.getDynamicMatrix(lev);

        int count = 0;
        for (int i = 0; i < dynamicMatrix.length; i++) {
            for (int j = 0; j < dynamicMatrix[i].length; j++) {
                if (vehicle.equals(dynamicMatrix[i][j].getVehicle())) {
                    count++;
                    if (count > 1) {
                        return true;
                    }
                }
            }
        }

        return false;
    }

    public List<String> queryCodeListFromDynamicNode(Integer lev, String nodeType) {
        if (Cools.isEmpty(nodeType)) {
            return new ArrayList<>();
        }
        lev = Optional.ofNullable(lev).orElse(MapDataDispatcher.MAP_DEFAULT_LEV);

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

        // concurrent
        ConcurrentLinkedQueue<SortCodeDto> codeList = new ConcurrentLinkedQueue<>();
        IntStream.range(0, codeMatrix.length).parallel().forEach(i -> {
            for (int j = 0; j < codeMatrix[i].length; j++) {
                DynamicNode dynamicNode = dynamicMatrix[i][j];
                if (nodeType.equals(dynamicNode.getVehicle())) {
                    codeList.add(new SortCodeDto(codeMatrix[i][j], dynamicNode.getSerial()));
                }
            }
        });

        // synchronize
//        List<SortCodeDto> codeList = new ArrayList<>();
//        for (int i = 0; i < codeMatrix.length; i++) {
//            for (int j = 0; j < codeMatrix[i].length; j++) {
//                DynamicNode dynamicNode = dynamicMatrix[i][j];
//                if (nodeType.equals(dynamicNode.getVehicle())) {
//                    codeList.add(new SortCodeDto(codeMatrix[i][j], dynamicNode.getSerial()));
//                }
//            }
//        }

        return codeList.stream()
                .sorted(Comparator.comparingInt(SortCodeDto::getSerial))
                .map(SortCodeDto::getCode)
                .collect(Collectors.toList());
    }

    public Map<String, List<String>> queryCodeListFromDynamicNode(Integer lev, Set<String> vehicles) {
        if (Cools.isEmpty(vehicles)) {
            return new HashMap<>();
        }
        lev = Optional.ofNullable(lev).orElse(MapDataDispatcher.MAP_DEFAULT_LEV);

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

        Map<String, List<SortCodeDto>> map = new HashMap<>(vehicles.size());

        for (int i = 0; i < codeMatrix.length; i++) {
            for (int j = 0; j < codeMatrix[i].length; j++) {
                DynamicNode dynamicNode = dynamicMatrix[i][j];
                String vehicle = dynamicNode.getVehicle();

                if (vehicles.contains(vehicle)) {
                    int serial = dynamicNode.getSerial();
                    map.computeIfAbsent(vehicle, k -> new ArrayList<>()).add(new SortCodeDto(codeMatrix[i][j], serial));
                }
            }
        }

        Map<String, List<String>> result = new HashMap<>(vehicles.size());
        for (Map.Entry<String, List<SortCodeDto>> entry : map.entrySet()) {
            List<String> codeDataList = entry.getValue().stream()
                    .sorted(Comparator.comparingInt(SortCodeDto::getSerial))
                    .map(SortCodeDto::getCode)
                    .collect(Collectors.toList());
            result.put(entry.getKey(), codeDataList);
        }

        return result;
    }

}