|  |  | 
 |  |  | package com.zy.asrs.utils; | 
 |  |  |  | 
 |  |  | import com.alibaba.fastjson.JSON; | 
 |  |  | import com.baomidou.mybatisplus.mapper.EntityWrapper; | 
 |  |  | import com.baomidou.mybatisplus.mapper.Wrapper; | 
 |  |  | import com.core.common.Arith; | 
 |  |  | import com.core.common.Cools; | 
 |  |  | import com.core.common.SpringUtils; | 
 |  |  | import com.zy.asrs.entity.BasShuttle; | 
 |  |  | import com.zy.asrs.entity.LocMast; | 
 |  |  | import com.zy.asrs.entity.WrkMast; | 
 |  |  | import com.zy.asrs.service.BasShuttleService; | 
 |  |  | import com.zy.asrs.service.LocMastService; | 
 |  |  | import com.zy.asrs.service.WrkMastService; | 
 |  |  | import com.zy.common.service.CommonService; | 
 |  |  | import com.zy.common.utils.NavigateMapData; | 
 |  |  | import com.zy.common.model.NavigateNode; | 
 |  |  | import com.zy.common.model.enums.NavigationMapType; | 
 |  |  | import com.zy.common.utils.NavigatePositionConvert; | 
 |  |  | import com.zy.common.utils.ShuttleDispatchUtils; | 
 |  |  | import com.zy.core.DevpThread; | 
 |  |  | import com.zy.common.utils.NavigateUtils; | 
 |  |  | import com.zy.core.cache.SlaveConnection; | 
 |  |  | import com.zy.core.enums.SlaveType; | 
 |  |  | import com.zy.core.model.DevpSlave; | 
 |  |  | import com.zy.core.model.ShuttleSlave; | 
 |  |  | import com.zy.core.model.protocol.NyShuttleProtocol; | 
 |  |  | import com.zy.core.model.protocol.StaProtocol; | 
 |  |  | import com.zy.core.model.protocol.ShuttleProtocol; | 
 |  |  | import com.zy.core.properties.SlaveProperties; | 
 |  |  | import com.zy.core.thread.NyShuttleThread; | 
 |  |  | import com.zy.core.thread.ShuttleThread; | 
 |  |  |  | 
 |  |  | import java.text.DecimalFormat; | 
 |  |  | import java.util.*; | 
 |  |  | import java.util.ArrayList; | 
 |  |  | 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); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> SECOND_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(3);add(4); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> THIRD_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(6);add(7); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> FOURTH_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(8); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> FIFTH_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(10);add(11); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> SIXTH_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(13);add(14);add(15);add(16); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> SEVENTH_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(13);add(14); | 
 |  |  |     }}; | 
 |  |  |     public static final List<Integer> EIGHTH_GROUP_ROW_LIST = new ArrayList<Integer>() {{ | 
 |  |  |         add(16); | 
 |  |  |     }}; | 
 |  |  |  | 
 |  |  |     private static final DecimalFormat fmt = new DecimalFormat("##0.00"); | 
 |  |  |  | 
 |  |  |     public static float scale(Float f){ | 
 |  |  |     public static float scale(Float f) { | 
 |  |  |         if (f == null || f == 0f || Float.isNaN(f)) { | 
 |  |  |             return 0f; | 
 |  |  |         } | 
 |  |  |         return (float) Arith.multiplys(2, f, 1); | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     public static String zerofill(String msg, Integer count){ | 
 |  |  |         if (msg.length() == count){ | 
 |  |  |     public static String zerofill(String msg, Integer count) { | 
 |  |  |         if (msg.length() == count) { | 
 |  |  |             return msg; | 
 |  |  |         } else if (msg.length() > count){ | 
 |  |  |         } else if (msg.length() > count) { | 
 |  |  |             return msg.substring(0, 16); | 
 |  |  |         } else { | 
 |  |  |             StringBuilder msgBuilder = new StringBuilder(msg); | 
 |  |  |             for (int i = 0; i<count-msg.length(); i++){ | 
 |  |  |                 msgBuilder.insert(0,"0"); | 
 |  |  |             for (int i = 0; i < count - msg.length(); i++) { | 
 |  |  |                 msgBuilder.insert(0, "0"); | 
 |  |  |             } | 
 |  |  |             return msgBuilder.toString(); | 
 |  |  |         } | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     public static Integer getGroupRow(String locNo, Boolean pakin){ | 
 |  |  |         int row = getRow(locNo); | 
 |  |  |         return getGroupRow(row, pakin); | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     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; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     /** | 
 |  |  | 
 |  |  |         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 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 void main(String[] args) { | 
 |  |  |         System.out.println(JSON.toJSONString(getGroupLoc("1606101"))); | 
 |  |  |     public static List<String> getGroupLoc(String locNo) { | 
 |  |  |         return null; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     /** | 
 |  |  |      * 获取库位组 | 
 |  |  |      * @param locNo 库位号 | 
 |  |  |      */ | 
 |  |  |     public static List<String> getGroupLoc(String locNo){ | 
 |  |  |         int row = getRow(locNo); | 
 |  |  |         int bay = getBay(locNo); | 
 |  |  |         if (FIRST_GROUP_ROW_LIST.contains(row)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : FIRST_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |     //获取除白名单外的指定楼层全部穿梭车xy坐标点 | 
 |  |  |     public static int[] getShuttlePoint(Integer shuttleNo) { | 
 |  |  |         //获取穿梭车所在节点位置 | 
 |  |  |         ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo); | 
 |  |  |         if (shuttleThread == null) { | 
 |  |  |             return null; | 
 |  |  |         } | 
 |  |  |         if (SECOND_GROUP_ROW_LIST.contains(row)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : SECOND_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         ShuttleProtocol shuttleProtocol = shuttleThread.getStatus(); | 
 |  |  |         if (shuttleProtocol == null) { | 
 |  |  |             return null; | 
 |  |  |         } | 
 |  |  |         if (THIRD_GROUP_ROW_LIST.contains(row)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : THIRD_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             Collections.reverse(result); | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (FOURTH_GROUP_ROW_LIST.contains(row)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : FOURTH_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (FIFTH_GROUP_ROW_LIST.contains(row)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : FIFTH_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (SIXTH_GROUP_ROW_LIST.contains(row) && (bay >= 59 && bay <= 61)) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : SIXTH_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             Collections.reverse(result); | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (SEVENTH_GROUP_ROW_LIST.contains(row) && bay < 59) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : SEVENTH_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (EIGHTH_GROUP_ROW_LIST.contains(row) && bay < 59) { | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : EIGHTH_GROUP_ROW_LIST) { | 
 |  |  |                 result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         throw new RuntimeException("库位解析异常"); | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     /** | 
 |  |  |      * 获取外侧方向的库位组 | 
 |  |  |      * @param locNo 库位号 | 
 |  |  |      */ | 
 |  |  |     public static List<String> getGroupOuterLoc(String locNo){ | 
 |  |  |         int row = getRow(locNo); | 
 |  |  |         int bay = getBay(locNo); | 
 |  |  |         String currentLocNo = shuttleProtocol.getCurrentLocNo(); | 
 |  |  |         if (currentLocNo == null) { | 
 |  |  |             return null; | 
 |  |  |         } | 
 |  |  |  | 
 |  |  |         //(1,3,4,10,11)没有外侧方向库位组,(13,14,16)59列之内没有外侧方向库位组 | 
 |  |  |         if (FIRST_GROUP_ROW_LIST.contains(row)) {//1排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         if (shuttleProtocol.getCurrentLocNo() == null) { | 
 |  |  |             return null; | 
 |  |  |         } | 
 |  |  |         if (SECOND_GROUP_ROW_LIST.contains(row)) {//3-4排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (THIRD_GROUP_ROW_LIST.contains(row)) {//6-7排 | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : THIRD_GROUP_ROW_LIST) { | 
 |  |  |                 if (row0 < row) { | 
 |  |  |                     result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (FOURTH_GROUP_ROW_LIST.contains(row)) {//8排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (FIFTH_GROUP_ROW_LIST.contains(row)) {//10-11排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (SIXTH_GROUP_ROW_LIST.contains(row) && (bay >= 59 && bay <= 61)) {//13-16排59-61列外侧方向库位组 | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : SIXTH_GROUP_ROW_LIST) { | 
 |  |  |                 if (row0 < row) { | 
 |  |  |                     result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (SEVENTH_GROUP_ROW_LIST.contains(row) && bay < 59) {//13-14排59列之内没有外侧方向库位组 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (EIGHTH_GROUP_ROW_LIST.contains(row) && bay < 59) {//16排59列之内没有外侧方向库位组 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         throw new RuntimeException("库位解析异常"); | 
 |  |  |         return NavigatePositionConvert.positionToXY(shuttleProtocol.getCurrentLocNo()); | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     //获取除白名单外的指定楼层全部穿梭车xy坐标点 | 
 |  |  |     public static List<int[]> getShuttlePoints(Integer whiteShuttle, Integer lev) { | 
 |  |  |         BasShuttleService basShuttleService = SpringUtils.getBean(BasShuttleService.class); | 
 |  |  |         SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class); | 
 |  |  |         ArrayList<int[]> list = new ArrayList<>(); | 
 |  |  |         for (ShuttleSlave slave : slaveProperties.getShuttle()) { | 
 |  |  | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             //获取穿梭车所在节点位置 | 
 |  |  |             NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); | 
 |  |  |             ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); | 
 |  |  |             if (shuttleThread == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |             NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); | 
 |  |  |             ShuttleProtocol shuttleProtocol = shuttleThread.getStatus(); | 
 |  |  |             if (shuttleProtocol == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             String currentLocNo = shuttleProtocol.getCurrentLocNo(); | 
 |  |  |  | 
 |  |  |             if (currentLocNo == null) { | 
 |  |  |                 //小车没有库位号数据,从数据库中取 | 
 |  |  |                 BasShuttle basShuttle = basShuttleService.selectById(slave.getId()); | 
 |  |  |                 if (basShuttle == null || basShuttle.getPoint() == null) { | 
 |  |  |                     continue; | 
 |  |  |                 } | 
 |  |  |                 NyShuttleProtocol.NyShuttlePointClass shuttlePoint = JSON.parseObject(basShuttle.getPoint(), NyShuttleProtocol.NyShuttlePointClass.class); | 
 |  |  |                 currentLocNo = NavigatePositionConvert.nyXyzToLocNo(shuttlePoint.getX(), shuttlePoint.getY(), shuttlePoint.getZ()); | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             if (lev != Utils.getLev(currentLocNo)) { | 
 |  |  | 
 |  |  |         return list; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     //搜索一条没有小车的空巷道,并调度小车 | 
 |  |  |     public static boolean searchEmptyGroupToMoveShuttle(int z, Integer currentShuttleId, NyShuttleThread shuttleThread) { | 
 |  |  |         LocMastService locMastService = SpringUtils.getBean(LocMastService.class); | 
 |  |  |         WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class); | 
 |  |  |         CommonService commonService = SpringUtils.getBean(CommonService.class); | 
 |  |  |         ShuttleDispatchUtils shuttleDispatchUtils = SpringUtils.getBean(ShuttleDispatchUtils.class); | 
 |  |  |  | 
 |  |  |         if (shuttleThread == null) { | 
 |  |  |             return false; | 
 |  |  |         } | 
 |  |  |         NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); | 
 |  |  |         if (shuttleProtocol == null) { | 
 |  |  |             return false; | 
 |  |  |         } | 
 |  |  |  | 
 |  |  |         NavigateMapData mapData = new NavigateMapData(z);//获取地图数据 | 
 |  |  |         int[][] data = mapData.getData(-1, null, currentShuttleId == null ? null : Utils.getShuttlePoints(0, z));//载入全部车辆 | 
 |  |  |  | 
 |  |  |         int distY = -1; | 
 |  |  |         int distX = -1; | 
 |  |  |         int distZ = -1; | 
 |  |  |         //获取避让库位 | 
 |  |  |         String distLocNo = null; | 
 |  |  |         for (int y = 20; y <= 56; y++) { | 
 |  |  |             boolean searchFlag = true; | 
 |  |  |             for (int x = 10; x <= 11; x++) { | 
 |  |  |                 if (data[x][y] < 0 || data[x][y] == 66) { | 
 |  |  |                     searchFlag = false;//该巷道有禁用节点或有小车 | 
 |  |  |                     break; | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             if (searchFlag) { | 
 |  |  |                 //搜索出空巷道 | 
 |  |  |                 distY = y; | 
 |  |  |                 distX = 11; | 
 |  |  |                 distZ = z; | 
 |  |  |  | 
 |  |  |                 //获取避让库位 | 
 |  |  |                 String locNo = NavigatePositionConvert.xyzToLocNo(distX, distY, distZ); | 
 |  |  |                 LocMast distLocMast = locMastService.queryByLoc(locNo); | 
 |  |  |                 if (distLocMast == null) { | 
 |  |  |                     continue; | 
 |  |  |                 } | 
 |  |  |  | 
 |  |  |                 //判断该库位是否存在工作档 | 
 |  |  |                 EntityWrapper<WrkMast> wrapper = new EntityWrapper<>(); | 
 |  |  |                 wrapper.eq("loc_no", locNo); | 
 |  |  |                 WrkMast wrkMast = wrkMastService.selectOne(wrapper); | 
 |  |  |                 if (wrkMast != null) { | 
 |  |  |                     continue;//存在工作档跳过该库位 | 
 |  |  |                 } | 
 |  |  |  | 
 |  |  |                 distLocNo = locNo; | 
 |  |  |                 break; | 
 |  |  |             } | 
 |  |  |         } | 
 |  |  |  | 
 |  |  |         if (distLocNo != null) { | 
 |  |  |             //调度小车到避让位置 | 
 |  |  |             return shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(7), distLocNo, shuttleProtocol.getShuttleNo().intValue()); | 
 |  |  |         } | 
 |  |  |         return false; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     //检测楼层是否有穿梭车 | 
 |  |  |     //检测楼层是否有可用穿梭车 | 
 |  |  |     public static boolean checkLevHasShuttle(Integer lev) { | 
 |  |  |         SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class); | 
 |  |  |         WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class); | 
 |  |  |         for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { | 
 |  |  |             //获取四向穿梭车线程 | 
 |  |  |             NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); | 
 |  |  |             ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); | 
 |  |  |             if (shuttleThread == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |             NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); | 
 |  |  |             ShuttleProtocol shuttleProtocol = shuttleThread.getStatus(); | 
 |  |  |             if (shuttleProtocol == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |             String currentLocNo = shuttleProtocol.getCurrentLocNo(); | 
 |  |  |             if (currentLocNo == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             //小车正在充电 | 
 |  |  |             if (shuttleThread.isCharging()) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             //小车有充电任务 | 
 |  |  |             WrkMast chargeWorking = wrkMastService.selectChargeWorking(shuttleProtocol.getShuttleNo()); | 
 |  |  |             if (chargeWorking != null) {//已有充电任务 | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             //小车处于故障状态 | 
 |  |  |             if (shuttleThread.isFault()) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  | 
 |  |  |  | 
 |  |  |         for (String loc : groupLoc) { | 
 |  |  |             for (ShuttleSlave slave : slaveProperties.getShuttle()) { | 
 |  |  |                 NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); | 
 |  |  |                 ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); | 
 |  |  |                 if (shuttleThread == null) { | 
 |  |  |                     continue; | 
 |  |  |                 } | 
 |  |  |  | 
 |  |  |                 NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); | 
 |  |  |                 ShuttleProtocol shuttleProtocol = shuttleThread.getStatus(); | 
 |  |  |                 if (shuttleProtocol == null) { | 
 |  |  |                     continue; | 
 |  |  |                 } | 
 |  |  | 
 |  |  |         return null; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     //通过提升机号和楼层获取出入库模式 | 
 |  |  |     public static Integer getOutInModelByLift(Integer liftNo, Integer lev) { | 
 |  |  |         ArrayList<Integer> lev1 = new ArrayList<Integer>() {{ | 
 |  |  |             add(100);add(103); | 
 |  |  |             add(105); | 
 |  |  |         }}; | 
 |  |  |         ArrayList<Integer> lev2 = new ArrayList<Integer>() {{ | 
 |  |  |             add(200);add(203); | 
 |  |  |             add(205); | 
 |  |  |         }}; | 
 |  |  |         ArrayList<Integer> lev3 = new ArrayList<Integer>() {{ | 
 |  |  |             add(341);add(346); | 
 |  |  |         }}; | 
 |  |  |  | 
 |  |  |         Integer staNo = null; | 
 |  |  |         if (lev <= 4) { | 
 |  |  |             staNo = lev1.get(liftNo - 1); | 
 |  |  |         } else if (lev >= 5 && lev <= 7) { | 
 |  |  |             staNo = lev2.get(liftNo - 1); | 
 |  |  |         } else if ((lev >=8 && lev <= 10) && liftNo != 1) { | 
 |  |  |             staNo = lev3.get(liftNo - 2); | 
 |  |  |     //获取小车待机位 | 
 |  |  |     public static String getShuttleStandbyLocNo(String locNo) { | 
 |  |  |         LocMastService locMastService = SpringUtils.getBean(LocMastService.class); | 
 |  |  |         NavigateUtils navigateUtils = SpringUtils.getBean(NavigateUtils.class); | 
 |  |  |         List<LocMast> locMasts = locMastService.selectList(new EntityWrapper<LocMast>() | 
 |  |  |                 .eq("loc_type", "standby") | 
 |  |  |                 .eq("lev1", Utils.getLev(locNo))); | 
 |  |  |         if (locMasts.isEmpty()) { | 
 |  |  |             return null; | 
 |  |  |         } | 
 |  |  |  | 
 |  |  |         if (staNo != null) { | 
 |  |  |             DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1); | 
 |  |  |             StaProtocol staProtocol = devpThread.getStation().get(staNo); | 
 |  |  |             if (staProtocol == null) { | 
 |  |  |                 return null; | 
 |  |  |         Integer recentDistance = Integer.MAX_VALUE; | 
 |  |  |         String recentLocNo = null; | 
 |  |  |         for (LocMast locMast : locMasts) { | 
 |  |  |             //待机位到目标点距离 | 
 |  |  |             List<NavigateNode> currentShuttlePath = navigateUtils.calc(locNo, locMast.getLocNo(), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(0, Utils.getLev(locNo)), null);//搜索空闲穿梭车,使用正常通道地图 | 
 |  |  |             if (currentShuttlePath == null) { | 
 |  |  |                 continue; | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             if (staNo == 100 || staNo == 200) {//1号提升机100站和200站默认全是出库模式 | 
 |  |  |                 return 2;//出库模式 | 
 |  |  |             Integer currentAllDistance = navigateUtils.getOriginPathAllDistance(currentShuttlePath);//计算当前路径行走总距离 | 
 |  |  |             if (currentAllDistance < recentDistance) { | 
 |  |  |                 recentDistance = currentAllDistance; | 
 |  |  |                 recentLocNo = locMast.getLocNo(); | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             if (staNo == 341) { | 
 |  |  |                 return 1;//341站默认只能入库模式 | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             if (staProtocol.getOutInModel() == null) { | 
 |  |  |                 return null;//没有出入库信号 | 
 |  |  |             } | 
 |  |  |  | 
 |  |  |             return staProtocol.getOutInModel().intValue(); | 
 |  |  |         } | 
 |  |  |         return null; | 
 |  |  |  | 
 |  |  |         return recentLocNo; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     public static void wapperSetCondition(Wrapper wrapper, String column, String condition){ | 
 |  |  |         if(Cools.isEmpty(condition) || "null".equals(condition)){ | 
 |  |  |             wrapper.andNew().eq(column,"").or().isNull(column); | 
 |  |  |         }else { | 
 |  |  |             wrapper.eq(column,condition); | 
 |  |  |         } | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     /** | 
 |  |  |      * 获取内侧方向的库位组 | 
 |  |  |      * @param locNo 库位号 | 
 |  |  |      */ | 
 |  |  |     public static List<String> getGroupInnerLoc(String locNo){ | 
 |  |  |         int row = getRow(locNo); | 
 |  |  |         int bay = getBay(locNo); | 
 |  |  |  | 
 |  |  |         //(1,3,4,10,11)没有内侧方向库位组,(13,14,16)59列之内没有内侧方向库位组 | 
 |  |  |         if (FIRST_GROUP_ROW_LIST.contains(row)) {//1排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (SECOND_GROUP_ROW_LIST.contains(row)) {//3-4排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (THIRD_GROUP_ROW_LIST.contains(row)) {//6-7排 | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : THIRD_GROUP_ROW_LIST) { | 
 |  |  |                 if (row0 > row) { | 
 |  |  |                     result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (FOURTH_GROUP_ROW_LIST.contains(row)) {//8排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (FIFTH_GROUP_ROW_LIST.contains(row)) {//10-11排 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (SIXTH_GROUP_ROW_LIST.contains(row) && (bay >= 59 && bay <= 61)) {//13-16排59-61列内侧方向库位组 | 
 |  |  |             List<String> result = new ArrayList<>(); | 
 |  |  |             for (Integer row0 : SIXTH_GROUP_ROW_LIST) { | 
 |  |  |                 if (row0 > row) { | 
 |  |  |                     result.add(zerofill(String.valueOf(row0), 2) + locNo.substring(2)); | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |             return result; | 
 |  |  |         } | 
 |  |  |         if (SEVENTH_GROUP_ROW_LIST.contains(row) && bay < 59) {//13-14排59列之内没有内侧方向库位组 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         if (EIGHTH_GROUP_ROW_LIST.contains(row) && bay < 59) {//16排59列之内没有内侧方向库位组 | 
 |  |  |             return new ArrayList<>(); | 
 |  |  |         } | 
 |  |  |         throw new RuntimeException("库位解析异常"); | 
 |  |  |     } | 
 |  |  |  | 
 |  |  |     /** | 
 |  |  |      * 通过入库站点号获取条码器ID | 
 |  |  |      */ | 
 |  |  |     public static Integer getBarcodeIdByStaNo(int staNo) { | 
 |  |  |         SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class); | 
 |  |  |         for (DevpSlave devpSlave : slaveProperties.getDevp()) { | 
 |  |  |             for (DevpSlave.Sta sta : devpSlave.getInSta()) { | 
 |  |  |                 if (sta.getStaNo().equals(staNo)) { | 
 |  |  |                     return sta.getBarcode(); | 
 |  |  |                 } | 
 |  |  |             } | 
 |  |  |         } | 
 |  |  |         return null; | 
 |  |  |     } | 
 |  |  |  | 
 |  |  | } |