寻路算法，地图节点优化，剔除原入出库模式获取地图节点方案，改为根据库位状态实时获取节点信息或直接获取无过滤的完整节点信息

Junjie

2023-06-18 9f05696822f8feee385a34a92dd9aa16009e84a0

 src/main/java/com/zy/asrs/utils/Utils.java

@@ -1,14 +1,27 @@
package com.zy.asrs.utils;

import com.alibaba.fastjson.JSON;
import com.core.common.Arith;
import com.core.common.Cools;
import com.zy.core.properties.SlaveProperties;

import java.math.BigDecimal;
import java.text.DecimalFormat;
import java.util.ArrayList;
import java.util.Arrays;
import java.util.Collections;
import java.util.List;

/**
 * Created by vincent on 2020/8/27
 */
public class Utils {

    public static final List<Integer> FIRST_GROUP_ROW_LIST = new ArrayList<Integer>() {{
        add(1);add(2);add(3);add(4);
    }};
    public static final List<Integer> SECOND_GROUP_ROW_LIST = new ArrayList<Integer>() {{
        add(5);add(6);add(7);add(8);add(9);add(10);add(11);
    }};

    private static final DecimalFormat fmt = new DecimalFormat("##0.00");

@@ -33,5 +46,346 @@
        }
    }

    public static Integer getGroupRow(String locNo, Boolean pakin){
        int row = getRow(locNo);
        return getGroupRow(row, pakin);
    }

    public static List<String> getGroupLocNo(String locNo){
        int row = getRow(locNo);
        List<String> result = new ArrayList<>();
        if (FIRST_GROUP_ROW_LIST.contains(row)) {
            for (Integer groupRow : FIRST_GROUP_ROW_LIST) {
                result.add(zerofill(String.valueOf(groupRow), 2) + locNo.substring(2));
            }
        } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
            for (Integer groupRow : SECOND_GROUP_ROW_LIST) {
                result.add(zerofill(String.valueOf(groupRow), 2) + locNo.substring(2));
            }
        }
        return result;
    }

    public static Integer getGroupRow(Integer row, Boolean pakin) {
        if (FIRST_GROUP_ROW_LIST.contains(row)) {
            return 4;
        } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
            return 5;
        } else {
            return 0;
        }
//        if (pakin) {
//            if (FIRST_GROUP_ROW_LIST.contains(row)) {
//                return 2;
//            } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
//                return 18;
//            } else {
//                return 0;
//            }
//        } else {
//            if (FIRST_GROUP_ROW_LIST.contains(row)) {
//                return 12;
//            } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
//                return 30;
//            } else {
//                return 0;
//            }
//        }
    }

    /**
     * 判断库位是否为穿梭库位
     * @param locNo
     * @return
     */
    public static Boolean isShuttle(String locNo) {
        int row = Utils.getRow(locNo);
        if (row >= 2 && row <= 12) {
            return Boolean.TRUE;
        }
        return Boolean.FALSE;
    }

    // -------------------------------------------------------------------------------------------------------------------



    /**
     * 判断是否为深库位
     */
    public static boolean isDeepLoc(SlaveProperties slaveProperties, String locNo){
        if (slaveProperties.isDoubleDeep()) {
            int row = getRow(locNo);
            return slaveProperties.getDoubleLocs().contains(row);
        } else {
            return false;
        }
    }

    /**
     * 判断是否为深库位
     */
    public static boolean isDeepLoc(SlaveProperties slaveProperties, Integer row){
        if (slaveProperties.isDoubleDeep()) {
            return slaveProperties.getDoubleLocs().contains(row);
        } else {
            return false;
        }
    }

    /**
     * 判断是否为浅库位
     */
    public static boolean isShallowLoc(SlaveProperties slaveProperties, String locNo){
        if (slaveProperties.isDoubleDeep()) {
            int row = getRow(locNo);
            return !slaveProperties.getDoubleLocs().contains(row);
        } else {
            return false;
        }
    }

    /**
     * 判断是否为浅库位
     */
    public static boolean isShallowLoc(SlaveProperties slaveProperties, Integer row){
        if (slaveProperties.isDoubleDeep()) {
            return !slaveProperties.getDoubleLocs().contains(row);
        } else {
            return false;
        }
    }

    /**
     * 获取 深库位对应的浅库位号
     */
    public static String getShallowLoc(SlaveProperties slaveProperties, String deepLoc) {
        int row = getRow(deepLoc);
        int remainder = (int) Arith.remainder(row, slaveProperties.getGroupCount());
        int shallowRow = remainder == 1 ? (row + 1) : (row - 1);
        return zerofill(String.valueOf(shallowRow), 2) + deepLoc.substring(2);
    }


    /**
     * 获取 深库位排对应的浅库位排
     */
    public static Integer getShallowRow(SlaveProperties slaveProperties, Integer deepRow) {
        int remainder = (int) Arith.remainder(deepRow, slaveProperties.getGroupCount());
        return remainder == 1 ? (deepRow + 1) : (deepRow - 1);
    }

    /**
     * 获取 浅库位对应的深库位号
     */
    public static String getDeepLoc(SlaveProperties slaveProperties, String shallowLoc) {
        int row = getRow(shallowLoc);
        int remainder = (int) Arith.remainder(row, slaveProperties.getGroupCount());
        int targetRow;
        if (remainder == 2) {
            targetRow = row - 1;
        } else if (remainder == 1) {
            targetRow = row + 1;
        } else {
            throw new RuntimeException(shallowLoc + "不是浅库位，系统繁忙");
        }
        return zerofill(String.valueOf(targetRow), 2) + shallowLoc.substring(2);
    }

    /**
     * 获取 浅库位排对应的深库位排
     */
    public static Integer getDeepRow(SlaveProperties slaveProperties, Integer shallowRow) {
        int remainder = (int) Arith.remainder(shallowRow, slaveProperties.getGroupCount());
        int targetRow;
        if (remainder == 2) {
            targetRow = shallowRow - 1;
        } else if (remainder == 1) {
            targetRow = shallowRow + 1;
        } else {
            throw new RuntimeException(shallowRow + "不是浅库位排，系统繁忙");
        }
        return targetRow;
    }

    /**
     * 通过库位号获取 排
     */
    public static int getRow(String locNo) {
        if (!Cools.isEmpty(locNo)) {
            return Integer.parseInt(locNo.substring(0, 2));
        }
        throw new RuntimeException("库位解析异常");
    }

    /**
     * 通过库位号获取 列
     */
    public static int getBay(String locNo) {
        if (!Cools.isEmpty(locNo)) {
            return Integer.parseInt(locNo.substring(2, 5));
        }
        throw new RuntimeException("库位解析异常");
    }

    /**
     * 通过库位号获取 层
     */
    public static int getLev(String locNo) {
        if (!Cools.isEmpty(locNo)) {
            return Integer.parseInt(locNo.substring(5, 7));
        }
        throw new RuntimeException("库位解析异常");
    }

    /**
     * 通过排列层拼接出库位号
     */
    public static String append(int row, int bay, int lev) {
        return zerofill(String.valueOf(row), 2) + zerofill(String.valueOf(bay), 3) + zerofill(String.valueOf(lev), 2);
    }


    /**
     * 当检索到双深库位的浅库位时，如果深库位无货，则放入对应的深库位
     */
    public static void toDeepIfEmptyByShallow(String shallowLoc) {
        int row = getRow(shallowLoc);
        int remainder = (int) Arith.remainder(row, 4);
        int targetRow = 0;
        if (remainder == 2) {
            targetRow = row - 1;
        } else if (remainder == 3) {
            targetRow = row + 1;
        } else {
            throw new RuntimeException(shallowLoc + "不是浅库位，系统繁忙");
        }
        String targetLoc = zerofill(String.valueOf(targetRow), 2) + shallowLoc.substring(2);

    }

    public static String getLocNo(Number row, Number bay, Number lev) {
        return zerofill(String.valueOf(row), 2) + zerofill(String.valueOf(bay), 3) + zerofill(String.valueOf(lev), 2);
    }

    //出入库站点号转换对应楼层
    public static Integer outInStaNoToLev(Integer distSta) {
        Integer distLev = 1;//目标楼层
        switch (distSta) {
            case 102:
                distLev = 2;//输送线楼层
            case 105:
                distLev = 1;//一楼
            case 106:
                distLev = 3;//二楼
            case 107:
                distLev = 4;//三楼
            case 108:
                distLev = 5;//四楼
        }
        return distLev;
    }

    //楼层转换对应出入库站点号
    public static Integer levToOutInStaNo(Integer lev) {
        Integer staNo = null;//站点号
        switch (lev) {
            case 1:
                staNo = 105;
                break;
            case 2://输送线层
                staNo = 105;
                break;
            case 3:
                staNo = 106;
                break;
            case 4:
                staNo = 107;
                break;
            case 5:
                staNo = 108;
                break;
        }
        return staNo;
    }

    //提升机位置反馈转换出入库站点库位号
    public static String liftArrivalToOutInStaLocNo(Short liftArrival) {
        String locNo = null;
        switch (liftArrival) {
            case 1:
                locNo = "1800201";
                break;
            case 4:
                locNo = "1800202";
                break;
            case 8:
                locNo = "1800203";
                break;
            case 16:
                locNo = "1800204";
                break;
        }
        return locNo;
    }

    //楼层转换对应出入库站点库位号
    public static String levToOutInStaLocNo(Integer lev) {
        String locNo = null;
        if (lev >= 2) {
            lev++;
        }
        switch (lev) {
            case 1:
                locNo = "1800201";
                break;
            case 3:
                locNo = "1800202";
                break;
            case 4:
                locNo = "1800203";
                break;
            case 5:
                locNo = "1800204";
                break;
        }
        return locNo;
    }

    public static void main(String[] args) {
        System.out.println(JSON.toJSONString(getGroupOutsideLoc("0200101")));
    }

    // 外侧方向的货位  优先入库方向/优先出库方向 ===>> 反之
    public static List<String> getGroupOutsideLoc(String locNo){
        int row = getRow(locNo);
        List<String> result = new ArrayList<>();
        if (SECOND_GROUP_ROW_LIST.contains(row)) {
            for (Integer integer : SECOND_GROUP_ROW_LIST) {
                if (integer < row) {
                    result.add(zerofill(String.valueOf(integer), 2) + locNo.substring(2));
                } else {
                    break;
                }
            }
        } else if (FIRST_GROUP_ROW_LIST.contains(row)) {
            List<Integer> clone = Arrays.asList(new Integer[FIRST_GROUP_ROW_LIST.size()]);
            Collections.copy(clone, FIRST_GROUP_ROW_LIST);
            Collections.reverse(clone);
            for (Integer integer : clone) {
                if (integer > row) {
                    result.add(zerofill(String.valueOf(integer), 2) + locNo.substring(2));
                } else {
                    break;
                }
            }
        } else {
//            throw new RuntimeException("库位解析异常");
        }
        if (!Cools.isEmpty(result)) {
            Collections.reverse(result);
        }
        return result;
    }

}