|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import com.alibaba.fastjson.JSON; | 
|---|
|  |  |  | import com.alibaba.fastjson.JSONObject; | 
|---|
|  |  |  | import com.core.common.SpringUtils; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasMap; | 
|---|
|  |  |  | import com.zy.asrs.entity.LocMast; | 
|---|
|  |  |  | import com.zy.asrs.service.LocMastService; | 
|---|
|  |  |  | import com.zy.common.model.MapNode; | 
|---|
|  |  |  | import com.zy.common.model.NavigateNode; | 
|---|
|  |  |  | import com.zy.common.model.enums.NavigationMapType; | 
|---|
|  |  |  | import com.zy.core.enums.ShuttleTaskModeType; | 
|---|
|  |  |  | import org.springframework.stereotype.Component; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import java.io.*; | 
|---|
|  |  |  | import java.util.ArrayList; | 
|---|
|  |  |  | import java.util.Date; | 
|---|
|  |  |  | import java.util.List; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * A*算法地图获取类 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | @Component | 
|---|
|  |  |  | public class NavigateMapData { | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public int[][] getData() { | 
|---|
|  |  |  | return getData(ShuttleTaskModeType.PAK_IN.id); | 
|---|
|  |  |  | private Integer lev;//地图楼层 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public NavigateMapData() { | 
|---|
|  |  |  | this.lev = 1; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public int[][] getData(Integer mapType) { | 
|---|
|  |  |  | public NavigateMapData(Integer lev) { | 
|---|
|  |  |  | this.lev = lev; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public int[][] getData() { | 
|---|
|  |  |  | return getData(NavigationMapType.NONE.id, null, null);//默认读取无过滤的全部地图数据 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public int[][] getData(Integer mapType, List<int[]> whitePoints, List<int[]> shuttlePoints) { | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | String mapFilename = ""; | 
|---|
|  |  |  | if (mapType == ShuttleTaskModeType.PAK_IN.id) { | 
|---|
|  |  |  | //入库地图 | 
|---|
|  |  |  | mapFilename = "mapIn.json"; | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | //出库地图 | 
|---|
|  |  |  | mapFilename = "mapOut.json"; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | String mapFilename = "map_" + lev + ".json"; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | String fileName = this.getClass().getClassLoader().getResource(mapFilename).getPath();//获取文件路径 | 
|---|
|  |  |  | File file = new File(fileName); | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //解析json地图数据 | 
|---|
|  |  |  | ArrayList arrayList = JSON.parseObject(stringBuffer.toString(), ArrayList.class); | 
|---|
|  |  |  | int[][] map = new int[arrayList.size()][]; | 
|---|
|  |  |  | List<List<MapNode>> lists = filterMap(mapType, arrayList, lev, whitePoints, shuttlePoints);//过滤地图数据 | 
|---|
|  |  |  | int[][] map = new int[lists.size()][]; | 
|---|
|  |  |  | int j = 0; | 
|---|
|  |  |  | for (Object obj : arrayList) { | 
|---|
|  |  |  | ArrayList list = JSON.parseObject(obj.toString(), ArrayList.class); | 
|---|
|  |  |  | for (List<MapNode> list : lists) { | 
|---|
|  |  |  | int[] tmp = new int[list.size()]; | 
|---|
|  |  |  | int i = 0; | 
|---|
|  |  |  | for (Object o : list) { | 
|---|
|  |  |  | JSONObject jsonObject = JSON.parseObject(o.toString()); | 
|---|
|  |  |  | for (MapNode mapNode : list) { | 
|---|
|  |  |  | //将数据添加进二维数组 | 
|---|
|  |  |  | tmp[i++] = Integer.parseInt(jsonObject.get("value").toString()); | 
|---|
|  |  |  | tmp[i++] = mapNode.getValue(); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | //数据添加进一维数组 | 
|---|
|  |  |  | map[j++] = tmp; | 
|---|
|  |  |  | 
|---|
|  |  |  | return null; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取JSON格式数据 | 
|---|
|  |  |  | public ArrayList<ArrayList<JSONObject>> getJsonData(Integer mapType) { | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | String mapFilename = ""; | 
|---|
|  |  |  | if (mapType == ShuttleTaskModeType.PAK_IN.id) { | 
|---|
|  |  |  | //入库地图 | 
|---|
|  |  |  | mapFilename = "mapIn.json"; | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | //出库地图 | 
|---|
|  |  |  | mapFilename = "mapOut.json"; | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 尝试从redis获取数据 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | public int[][] getDataFromRedis(Integer mapType, List<int[]> whitePoints, List<int[]> shuttlePoints) { | 
|---|
|  |  |  | RedisUtil redisUtil = SpringUtils.getBean(RedisUtil.class); | 
|---|
|  |  |  | Object o = redisUtil.get("realtimeBasMap_" + lev); | 
|---|
|  |  |  | if (o == null) { | 
|---|
|  |  |  | return null; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasMap basMap = JSON.parseObject(o.toString(), BasMap.class); | 
|---|
|  |  |  | return this.getDataFormString(basMap.getData(), mapType, whitePoints, shuttlePoints); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 从List数据中获取地图 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | public int[][] getDataFormString(String data, Integer mapType, List<int[]> whitePoints, List<int[]> shuttlePoints) { | 
|---|
|  |  |  | ArrayList arrayList = JSON.parseObject(data, ArrayList.class); | 
|---|
|  |  |  | List<List<MapNode>> lists = filterMap(mapType, arrayList, lev, whitePoints, shuttlePoints);//过滤地图数据 | 
|---|
|  |  |  | int[][] map = new int[lists.size()][]; | 
|---|
|  |  |  | int j = 0; | 
|---|
|  |  |  | for (List<MapNode> list : lists) { | 
|---|
|  |  |  | int[] tmp = new int[list.size()]; | 
|---|
|  |  |  | int i = 0; | 
|---|
|  |  |  | for (MapNode mapNode : list) { | 
|---|
|  |  |  | //将数据添加进二维数组 | 
|---|
|  |  |  | tmp[i++] = mapNode.getValue(); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | //数据添加进一维数组 | 
|---|
|  |  |  | map[j++] = tmp; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | return map; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取JSON格式数据 | 
|---|
|  |  |  | public List<List<MapNode>> getJsonData(Integer mapType, List<int[]> whitePoints, List<int[]> shuttlePoints) { | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | String mapFilename = "map_" + lev + ".json"; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | String fileName = this.getClass().getClassLoader().getResource(mapFilename).getPath();//获取文件路径 | 
|---|
|  |  |  | File file = new File(fileName); | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  | br.close(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //返回的结果集 | 
|---|
|  |  |  | ArrayList<ArrayList<JSONObject>> returnLists = new ArrayList<>(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //解析json地图数据 | 
|---|
|  |  |  | ArrayList arrayList = JSON.parseObject(stringBuffer.toString(), ArrayList.class); | 
|---|
|  |  |  | for (Object obj : arrayList) { | 
|---|
|  |  |  | ArrayList list = JSON.parseObject(obj.toString(), ArrayList.class); | 
|---|
|  |  |  | ArrayList<JSONObject> maps = new ArrayList<>(); | 
|---|
|  |  |  | for (Object o : list) { | 
|---|
|  |  |  | JSONObject jsonObject = JSON.parseObject(o.toString()); | 
|---|
|  |  |  | maps.add(jsonObject); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | returnLists.add(maps); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | List<List<MapNode>> lists = filterMap(mapType, arrayList, lev, whitePoints, shuttlePoints);//过滤地图数据 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | return returnLists; | 
|---|
|  |  |  | return lists; | 
|---|
|  |  |  | } else { | 
|---|
|  |  |  | System.out.println("文件不存在!"); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | 
|---|
|  |  |  | return null; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 过滤地图数据 | 
|---|
|  |  |  | * mapType -1=>无过滤,1=》过滤库位状态DFX,2=》过滤库位状态X | 
|---|
|  |  |  | * | 
|---|
|  |  |  | * @param whitePoints 白名单节点,不需要被过滤 | 
|---|
|  |  |  | * @param shuttlePoints 穿梭车节点,需要加载进地图 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | public List<List<MapNode>> filterMap(Integer mapType, List arrayList, Integer lev, List<int[]> whitePoints, List<int[]> shuttlePoints) { | 
|---|
|  |  |  | List<List<MapNode>> lists = new ArrayList<>(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //重建数据格式 | 
|---|
|  |  |  | for (int i = 0; i < arrayList.size(); i++) { | 
|---|
|  |  |  | Object obj = arrayList.get(i); | 
|---|
|  |  |  | List<MapNode> list = JSON.parseArray(obj.toString(), MapNode.class); | 
|---|
|  |  |  | for (int j = 0; j < list.size(); j++) { | 
|---|
|  |  |  | MapNode mapNode = list.get(j); | 
|---|
|  |  |  | list.set(j, mapNode); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | lists.add(list); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //过滤数据 | 
|---|
|  |  |  | LocMastService locMastService = SpringUtils.getBean(LocMastService.class); | 
|---|
|  |  |  | //获取当前楼层库位数据 | 
|---|
|  |  |  | List<LocMast> locMasts = locMastService.selectLocByLev(lev); | 
|---|
|  |  |  | for (LocMast locMast : locMasts) { | 
|---|
|  |  |  | Integer row = locMast.getRow1(); | 
|---|
|  |  |  | Integer bay = locMast.getBay1(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | boolean whiteFlag = false;//默认不存在白名单 | 
|---|
|  |  |  | if (whitePoints != null) { | 
|---|
|  |  |  | for (int[] whitePoint : whitePoints) { | 
|---|
|  |  |  | if (whitePoint[0] == row && whitePoint[1] == bay) { | 
|---|
|  |  |  | //存在白名单 | 
|---|
|  |  |  | whiteFlag = true; | 
|---|
|  |  |  | break; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | if (whiteFlag) { | 
|---|
|  |  |  | continue;//存在白名单,不执行下列过滤方案 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | List<MapNode> list = lists.get(row); | 
|---|
|  |  |  | MapNode mapNode = list.get(bay); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (mapType == NavigationMapType.NONE.id) { | 
|---|
|  |  |  | //不过滤任何数据 | 
|---|
|  |  |  | } else if (mapType == NavigationMapType.DFX.id) { | 
|---|
|  |  |  | //车辆有货 | 
|---|
|  |  |  | //读取对应库位数据,将DFX库位状态的节点置为-1(障碍物) | 
|---|
|  |  |  | if (locMast.getLocSts().equals("F") || locMast.getLocSts().equals("D") || locMast.getLocSts().equals("X")) { | 
|---|
|  |  |  | mapNode.setValue(-1);//禁用节点 | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } else if (mapType == NavigationMapType.NORMAL.id) { | 
|---|
|  |  |  | //过滤库位状态X | 
|---|
|  |  |  | if (locMast.getLocSts().equals("X")) { | 
|---|
|  |  |  | mapNode.setValue(-1);//禁用节点 | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //更新list | 
|---|
|  |  |  | list.set(bay, mapNode); | 
|---|
|  |  |  | lists.set(row, list); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //加载车辆坐标到地图中 | 
|---|
|  |  |  | if (shuttlePoints != null) { | 
|---|
|  |  |  | for (int[] points : shuttlePoints) { | 
|---|
|  |  |  | int x = points[0]; | 
|---|
|  |  |  | int y = points[1]; | 
|---|
|  |  |  | List<MapNode> list = lists.get(x); | 
|---|
|  |  |  | MapNode mapNode = list.get(y); | 
|---|
|  |  |  | mapNode.setValue(66);//设置为车辆代码66 | 
|---|
|  |  |  | //更新list | 
|---|
|  |  |  | list.set(y, mapNode); | 
|---|
|  |  |  | lists.set(x, list); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | return lists; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 写入路径节点数据到redis地图中 | 
|---|
|  |  |  | * lock为true 禁用库位,lock为false恢复库位 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | public boolean writeNavigateNodeToRedisMap(List<NavigateNode> nodes, boolean lock) { | 
|---|
|  |  |  | RedisUtil redisUtil = SpringUtils.getBean(RedisUtil.class); | 
|---|
|  |  |  | Object o = redisUtil.get("realtimeBasMap_" + lev); | 
|---|
|  |  |  | if (o == null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasMap basMap = JSON.parseObject(o.toString(), BasMap.class); | 
|---|
|  |  |  | ArrayList arrayList = JSON.parseObject(basMap.getData(), ArrayList.class); | 
|---|
|  |  |  | List<List<MapNode>> lists = filterMap(NavigationMapType.NONE.id, arrayList, lev, null, null);//获取全部地图数据 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | for (NavigateNode node : nodes) { | 
|---|
|  |  |  | if (node.getZ() != lev) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | List<MapNode> listX = lists.get(node.getX()); | 
|---|
|  |  |  | MapNode mapNode = listX.get(node.getY()); | 
|---|
|  |  |  | if (lock) { | 
|---|
|  |  |  | mapNode.setValue(-999);//禁用库位 | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | if (node.getX() == 11 || node.getX() == 19) { | 
|---|
|  |  |  | mapNode.setValue(3);//恢复库位,母轨道 | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | mapNode.setValue(0);//恢复库位,普通库位 | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | listX.set(node.getY(), mapNode); | 
|---|
|  |  |  | lists.set(node.getX(), listX); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | basMap.setData(JSON.toJSONString(lists)); | 
|---|
|  |  |  | basMap.setUpdateTime(new Date()); | 
|---|
|  |  |  | //将数据库地图数据存入redis | 
|---|
|  |  |  | redisUtil.set("realtimeBasMap_" + lev, JSON.toJSONString(basMap)); | 
|---|
|  |  |  | return true; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } | 
|---|