| | |
| | | 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.core.exception.CoolException; |
| | | import com.zy.asrs.entity.LocMast; |
| | | import com.zy.asrs.entity.WrkMast; |
| | | import com.zy.asrs.mapper.WrkMastMapper; |
| | | import com.zy.asrs.service.BasShuttleService; |
| | | import com.zy.asrs.service.LocMastService; |
| | | import com.zy.asrs.service.WrkMastService; |
| | | import com.zy.asrs.service.impl.MainServiceImpl; |
| | | import com.zy.common.model.NavigateNode; |
| | | import com.zy.common.model.enums.NavigationMapType; |
| | | import com.zy.common.service.CommonService; |
| | | import com.zy.common.utils.NavigateMapData; |
| | | import com.zy.common.utils.NavigatePositionConvert; |
| | | import com.zy.common.utils.NavigateUtils; |
| | | import com.zy.common.utils.ShuttleDispatchUtils; |
| | | import com.zy.core.DevpThread; |
| | | import com.zy.core.Slave; |
| | | import com.zy.core.cache.MessageQueue; |
| | | import com.zy.core.cache.SlaveConnection; |
| | | import com.zy.core.enums.ShuttleRunDirection; |
| | | import com.zy.core.enums.ShuttleTaskModeType; |
| | | import com.zy.core.enums.SlaveType; |
| | | import com.zy.core.model.ShuttleSlave; |
| | | import com.zy.core.model.Task; |
| | | import com.zy.core.model.command.ShuttleAssignCommand; |
| | | import com.zy.core.model.command.ShuttleCommand; |
| | | import com.zy.core.model.protocol.NyShuttleProtocol; |
| | | import com.zy.core.model.protocol.ShuttleProtocol; |
| | | import com.zy.core.model.protocol.StaProtocol; |
| | | 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.*; |
| | | |
| | | /** |
| | | * 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"); |
| | | |
| | |
| | | } |
| | | 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("库位解析异常"); |
| | | } |
| | | |
| | | } |