zy-wcs.git - Gitblit

			@@ -2,20 +2,17 @@

			import com.alibaba.fastjson.JSON;
			import com.alibaba.fastjson.JSONObject;
			import com.baomidou.mybatisplus.mapper.EntityWrapper;
			import com.core.common.Cools;
			import com.core.common.SpringUtils;
			import com.core.exception.CoolException;
			import com.zy.asrs.entity.*;
			import com.zy.asrs.mapper.*;
			import com.zy.asrs.service.*;
			import com.zy.asrs.utils.Utils;
			import com.zy.common.model.*;
			import com.zy.common.model.enums.WrkChargeType;
			import com.zy.common.model.enums.NavigationMapType;
			import com.zy.common.service.CommonService;
			import com.zy.common.service.erp.ErpService;
			import com.zy.common.utils.*;
			import com.zy.core.CrnThread;
			import com.zy.core.DevpThread;
			import com.zy.core.News;
			import com.zy.core.cache.MessageQueue;
			@@ -52,6 +49,8 @@
			@Autowired
			private WrkMastMapper wrkMastMapper;
			@Autowired
			private WrkMastService wrkMastService;
			@Autowired
			private WrkDetlService wrkDetlService;
			@Autowired
			private LocMastService locMastService;
			@@ -60,13 +59,13 @@
			@Autowired
			private StaDescService staDescService;
			@Autowired
			private BasCrnpService basCrnpService;
			@Autowired
			private BasDevpService basDevpService;
			@Autowired
			private BasErrLogService basErrLogService;
			@Autowired
			private BasSteErrLogService basSteErrLogService;
			@Autowired
			private BasShuttleService basShuttleService;
			@Autowired
			private BasShuttleErrLogService basShuttleErrLogService;
			@Autowired
			@@ -84,11 +83,17 @@
			@Autowired
			private WrkChargeMapper wrkChargeMapper;
			@Autowired
			private BasMapService basMapService;
			@Autowired
			private ErpService erpService;
			@Autowired
			private OrderMapper orderMapper;
			@Autowired
			private OrderDetlMapper orderDetlMapper;
			@Autowired
			private BasLiftService basLiftService;
			@Autowired
			private ShuttleDispatchUtils shuttleDispatchUtils;
			@Autowired
			private RedisUtil redisUtil;

			@@ -150,11 +155,12 @@
			}
			continue;
			}

			// 判断是否满足入库条件
			if (staProtocol.isAutoing() && staProtocol.isLoading()
			&& staProtocol.isInEnable()
			&& !staProtocol.isEmptyMk() && (workNo == 0 \|\| (workNo >= 9990 && workNo <= 9999))
			&& staProtocol.isPakMk()) {
			) {

			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
			@@ -165,10 +171,10 @@
			if(!Cools.isEmpty(barcode)) {
			// News.info("{}号条码扫描器检测条码信息：{}", inSta.getBarcode(), barcode);
			if("NG".endsWith(barcode) \|\| "NoRead".equals(barcode) \|\| "empty".equals(barcode)\|\| "00000000".equals(barcode)) {
			staProtocol.setWorkNo((short) 32002);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// staProtocol.setWorkNo((short) 32002);
			// staProtocol.setStaNo(inSta.getBackSta().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));

			// led 异常显示
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
			@@ -179,10 +185,10 @@
			continue;
			}
			} else {
			staProtocol.setWorkNo((short) 32002);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// staProtocol.setWorkNo((short) 32002);
			// staProtocol.setStaNo(inSta.getBackSta().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));

			// led 异常显示
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
			@@ -194,16 +200,17 @@
			}

			// 过滤盘点/拣料/并板任务
			// if (null != wrkMastMapper.selectPickStepByBarcode(barcode)) {
			// continue;
			// }
			WrkMast wrkMast1 = wrkMastMapper.selectPickStepByBarcode(barcode);
			if (null != wrkMast1) {
			continue;
			}

			// 判断重复工作档
			// WrkMast wrkMast = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode);
			// if (wrkMast != null) {
			// News.error("工作档中已存在该站状态为（ 2.设备上走）的数据,工作号={}", wrkMast.getWrkNo());
			// continue;
			// }
			WrkMast wrkMast2 = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode);
			if (wrkMast2 != null) {
			News.error("工作档中已存在该站状态为（ 2.设备上走）的数据,工作号={}", wrkMast2.getWrkNo());
			continue;
			}

			try {
			LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
			@@ -233,6 +240,18 @@
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}

			// 判断重复工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep11(inSta.getStaNo());
			if (wrkMast == null) { continue; }

			// 更新工作主档
			wrkMast.setWrkSts(2L); // 工作状态：2.设备上走
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("更新工作档失败！！！ [工作号：{}]", wrkMast.getWrkNo());
			}

			} else if (code == 500){
			if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			@@ -243,9 +262,9 @@
			News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			} else if (code == 700) {
			staProtocol.setWorkNo((short) 32002);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			staProtocol.setRollback102(1);//102站回退信号
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(5, staProtocol));

			// led 异常显示
			if (ledThread != null) {
			@@ -364,6 +383,7 @@
			/**
			* 拣料、并板、盘点再入库
			*/
			@Transactional
			public synchronized void stnToCrnStnPick(){
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历拣料入库口
			@@ -379,25 +399,20 @@
			}
			if (staProtocol.isAutoing()
			&& staProtocol.isLoading()
			&& staProtocol.isInEnable()
			// 0 - 9990 或者 9996
			&& (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9990)
			&& (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9999)
			&& staProtocol.getStaNo().equals(staProtocol.getSiteId().shortValue())
			&& staProtocol.isPakMk()){

			// 获取条码扫描仪信息
			// BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
			// if (barcodeThread == null) {
			// continue;
			// }
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
			if (barcodeThread == null) {
			continue;
			}
			String barcode = barcodeThread.getBarcode();

			WrkMast wrkMast = null;
			if (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9990) {
			wrkMast = wrkMastMapper.selectPickStep(staProtocol.getWorkNo());
			if (null == wrkMast) {
			continue;
			}
			} else {
			wrkMast = wrkMastMapper.selectPickStepByBarcode(barcode);
			if (wrkMast == null) {
			continue;
			}
			// if (staProtocol.getWorkNo() == 9996) {
			@@ -437,6 +452,7 @@
			// News.error("{}条码错误，暂无拣料任务！", barcode);
			// }
			// }

			if ((wrkMast.getIoType() != 103 && wrkMast.getIoType() != 104 && wrkMast.getIoType() != 107)
			\|\| Cools.isEmpty(wrkMast.getStaNo()) \|\| Cools.isEmpty(wrkMast.getSourceStaNo()) ) {
			continue;
			@@ -491,14 +507,22 @@
			wrkMast.setSourceStaNo(pickSta.getStaNo()); // 源站
			wrkMast.setStaNo(dto.getStaNo()); // 目标站
			wrkMast.setCrnNo(dto.getCrnNo());
			wrkMast.setLocNo(dto.getLocNo()); // 目标库位 = 出库时的源库位
			wrkMast.setSourceLocNo(""); // 源库位清空
			wrkMast.setLocNo(sourceLocNo); // 目标库位 = 出库时的源库位
			wrkMast.setShuttleNo(null); // 穿梭车清空
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
			}
			if (wrkMastMapper.setSteEmpty(wrkMast.getWrkNo()) == 0) {
			throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
			}

			// 修改库位状态 Q.拣料/盘点/并板再入库
			LocMast locMast = locMastService.selectById(sourceLocNo);
			locMast.setLocSts("Q");
			locMast.setModiTime(new Date());
			if (!locMastService.updateById(locMast)) {
			throw new CoolException("修改库位状态失败");
			}

			// 更新站点信息且下发plc命令
			@@ -544,6 +568,38 @@
			}

			/**
			* 初始化实时地图
			*/
			public synchronized void initRealtimeBasMap() {
			for (int i = 1; i <= 10; i++) {//总共四层楼
			Object data = redisUtil.get("realtimeBasMap_" + i);
			if (data == null) {//redis地图数据为空，从数据库中获取
			BasMap basMap = basMapService.selectLatestMap(i);
			if (basMap == null) {
			//数据库中也不存在地图数据，从地图文件中获取
			//载入地图
			NavigateMapData mapData = new NavigateMapData(i);
			List<List<MapNode>> lists = mapData.getJsonData(-1, null, null);//获取完整地图(包括入库出库)

			//存入数据库
			basMap = new BasMap();
			basMap.setData(JSON.toJSONString(lists));
			basMap.setCreateTime(new Date());
			basMap.setUpdateTime(new Date());
			basMap.setLev(i);

			if (!basMapService.insert(basMap)) {
			log.info("地图数据存储失败");
			}
			}

			//将数据库地图数据存入redis
			redisUtil.set("realtimeBasMap_" + i, JSON.toJSONString(basMap));
			}
			}
			}

			/**
			* 从redis中重启任务
			*/
			public synchronized void restartTaskFromRedis() {
			@@ -561,6 +617,9 @@
			continue;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}
			if (!liftProtocol.isIdle()) {
			continue;
			}
			@@ -568,9 +627,8 @@
			//提升机处于空闲状态，进行任务的恢复
			liftProtocol.setTaskNo(redisCommand.getWrkNo());//将提升机线程分配任务号
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//工作状态
			liftProtocol.setLiftLock(true);//提升机锁定

			}else {//四向穿梭车任务
			}else if(key.toString().contains("shuttle_wrk_no_")){//四向穿梭车任务
			ShuttleRedisCommand redisCommand = JSON.parseObject(map.get(key).toString(), ShuttleRedisCommand.class);
			if (redisCommand == null) {
			continue;
			@@ -582,6 +640,9 @@
			continue;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}
			if (!shuttleProtocol.isIdle()) {
			continue;
			}
			@@ -597,123 +658,38 @@
			/**
			* 入库 ===>> 四向穿梭车入库作业下发
			*/
			public synchronized void shuttleIoInExecute() {
			public synchronized void shuttleInExecute() {
			// 根据输送线plc遍历
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历入库站
			for (DevpSlave.StaRack rackInStn : devp.getRackInStn()) {
			for (DevpSlave.StaRack staRack : devp.getRackInStn()) {
			// 获取入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());

			StaProtocol staProtocol = devpThread.getStation().get(rackInStn.getStaNo());
			StaProtocol staProtocol105 = devpThread.getStation().get(105);
			staProtocol105.setWorkNo((short) 752);
			staProtocol105.setStaNo((short) 100);

			StaProtocol staProtocol106 = devpThread.getStation().get(106);
			staProtocol106.setWorkNo((short) 753);
			staProtocol106.setStaNo((short) 100);

			StaProtocol staProtocol = devpThread.getStation().get(staRack.getStaNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			Short workNo = staProtocol.getWorkNo();
			BasDevp basDevp = basDevpService.selectById(staProtocol.getSiteId());
			if (basDevp == null) {
			continue;//站点信息不存在
			}

			// 判断是否满足入库条件
			if (true \|\| staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()) {
			WrkMast wrkMast = wrkMastMapper.selectRackInStep48(workNo, staProtocol.getSiteId());
			if (wrkMast != null) {
			if (wrkMast.getWrkSts() == 4 \|\| wrkMast.getWrkSts() == 8) {
			ShuttleThread shuttleThread = null;
			HashMap<String, Object> searchIdleShuttle = null;
			if (wrkMast.getWrkSts() == 4) {
			//寻找最近且空闲的四向穿梭车
			searchIdleShuttle = this.searchIdleShuttle(wrkMast);
			shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
			}else {
			//状态8，四向穿梭车已在提升机口，等待命令进行入库搬运动作
			Integer shuttleNo = wrkMast.getShuttleNo();//四向穿梭车号
			shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo);
			}
			// 判断是否满足入库条件，自动、有物、四向穿梭车可取信号
			if (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isShuttleTakeEnable())) {
			continue;
			}

			if (shuttleThread == null) {
			continue;
			}
			WrkMast wrkMast = wrkMastMapper.selectRackInStep4(workNo, staProtocol.getSiteId());
			if (wrkMast == null) {
			continue;
			}

			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (!shuttleProtocol.isIdle()) {
			continue;
			}

			wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//给工作档分配四向穿梭车号

			//分配任务号
			shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
			//分配源库位
			shuttleProtocol.setSourceLocNo(wrkMast.getSourceLocNo());

			//创建分配命令
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//入出库模式
			String currentLocNo = shuttleProtocol.getCurrentLocNo();
			assignCommand.setSourceLocNo(currentLocNo);//源库位(小车当前位置)

			String locNo = wrkMast.getLocNo();//当前工作档库位号
			Integer lev = Integer.parseInt(locNo.substring(locNo.length() - 2, locNo.length()));//当前工作档库位层高
			Integer currentLev = Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));//小车当前层高

			//获取提升机
			LiftSlave liftSlave = slaveProperties.getLift().get(0);
			//提升机库位号
			String liftLocNo = liftSlave.getLiftLocNo(currentLev);

			if (wrkMast.getWrkSts() == 8 \|\| Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
			//同一层直接取货无需经过提升机
			//直接计算车到提升机取货再到库位路径指令
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, locNo);
			if (wrkMast.getWrkSts() == 8) {
			//此时车在提升机内部，需要多下达一步指令让车移动到提升机口
			BasDevp basDevp = basDevpService.selectById(109);//获取提升机信息
			ShuttleCommand moveCommand = new ShuttleCommand();
			moveCommand.setCommandWord((short) 1);
			moveCommand.setStartCodeNum(Short.parseShort(basDevp.getQrCodeValue()));//提升机内部二维码
			moveCommand.setDistCodeNum(commands.get(0).getStartCodeNum());//提升机口二维码
			moveCommand.setStartToDistDistance(1300);
			moveCommand.setMiddleToDistDistance(0);
			moveCommand.setRunDirection(commands.get(0).getRunDirection());
			moveCommand.setCommandEnd((short) 1);
			commands.add(0, moveCommand);//将该指令添加到队头
			}
			assignCommand.setCommands(commands);
			//分配目标库位
			shuttleProtocol.setLocNo(wrkMast.getLocNo());
			//目标库位
			assignCommand.setLocNo(wrkMast.getLocNo());
			wrkMast.setWrkSts(9L);//小车入库中
			}else {
			//不同层，将目标库位分配成提升机库位号

			//小车移动到提升机口，计算路径
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, ShuttleTaskModeType.PAK_IN.id);
			//分配目标库位
			shuttleProtocol.setLocNo(liftLocNo);
			//目标库位
			assignCommand.setLocNo(liftLocNo);
			assignCommand.setCommands(commands);
			wrkMast.setWrkSts(5L);//小车迁移状态
			}

			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}

			}
			boolean step1 = this.shuttleInExecuteStep1(wrkMast, basDevp);//小车搬入库中
			if (!step1) {
			continue;
			}

			}
			@@ -721,280 +697,140 @@

			}

			//获取起点-终点指令。mapType：1=》无货地图，2=》有货地图
			public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String locNO,Integer mapType) {
			//计算小车起点到中点所需命令
			List<NavigateNode> calc = NavigateUtils.calc(startLocNo, locNO, mapType);
			List<ShuttleCommand> commands = new ArrayList<>();
			if (calc == null) {
			return null;
			/**
			* 入库-小车搬入库中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public boolean shuttleInExecuteStep1(WrkMast wrkMast, BasDevp basDevp) {
			if (wrkMast.getWrkSts() == 4) {
			if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo());//调度小车到货物所在输送站点进行取货
			return false;
			}

			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}
			if (!shuttleProtocol.isIdle()) {
			return false;
			}

			//判断小车是否到达输送站点库位
			if (!shuttleProtocol.getCurrentLocNo().equals(basDevp.getLocNo())) {
			//小车不在输送站点位置
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在输送站点进行取货
			return false;
			}

			//小车已抵达输送站点位置，进行搬运货物
			NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo(), wrkMast.getLocNo());
			if (result == null) {//路径计算失败
			return false;
			}

			//创建分配命令
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//入库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(result.getCommands());//运行命令
			assignCommand.setNodes(result.getNodes());//路径节点

			wrkMast.setWrkSts(5L);//4.提升机搬运完成 => 5.小车搬运中
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}

			//获取分段路径
			ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc);
			//将每一段路径分成command指令
			for (ArrayList<NavigateNode> nodes : data) {
			//开始路径
			NavigateNode startPath = nodes.get(0);
			//目标路径
			NavigateNode endPath = nodes.get(nodes.size() - 1);
			Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//计算当前路径行走总距离

			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 1);

			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			command.setStartCodeNum(startCodeNum);

			command.setMiddleCodeNum((short) 1);

			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			command.setDistCodeNum(distCodeNum);

			command.setStartToDistDistance(allDistance);
			command.setMiddleToDistDistance(0);
			command.setRunDirection(ShuttleRunDirection.get(startPath.getDirection()).id);
			command.setPalletLift((short) 1);
			command.setForceMoveDistance(0);
			command.setChargeSwitch((short) 2);
			command.setIOControl((short) 0);
			command.setRadarTmp((short) 0);
			command.setCommandEnd((short) 1);
			commands.add(command);
			}
			return commands;
			}

			//获取起点-中点-终点指令
			public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String middleLocNo, String locNO) {
			//计算小车起点到中点所需命令
			List<NavigateNode> calc = NavigateUtils.calc(startLocNo, middleLocNo, 1);//小车无货，走入库地图
			List<ShuttleCommand> commands = new ArrayList<>();
			if (calc == null) {
			return null;
			}

			//获取分段路径
			ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc);
			//将每一段路径分成command指令
			for (ArrayList<NavigateNode> nodes : data) {
			//开始路径
			NavigateNode startPath = nodes.get(0);
			//目标路径
			NavigateNode endPath = nodes.get(nodes.size() - 1);
			Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//计算当前路径行走总距离

			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 1);

			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			command.setStartCodeNum(startCodeNum);

			command.setMiddleCodeNum((short) 1);

			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			command.setDistCodeNum(distCodeNum);

			command.setStartToDistDistance(allDistance);
			command.setMiddleToDistDistance(0);
			command.setRunDirection(ShuttleRunDirection.get(startPath.getDirection()).id);
			command.setPalletLift((short) 1);
			command.setForceMoveDistance(0);
			command.setChargeSwitch((short) 2);
			command.setIOControl((short) 0);
			command.setRadarTmp((short) 0);
			command.setCommandEnd((short) 1);
			commands.add(command);
			}

			//小车指令到达目标位置后，再发出一条顶升指令
			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 2);
			command.setPalletLift((short) 1);
			command.setCommandEnd((short) 1);
			commands.add(command);

			//计算小车中点到终点所需命令
			List<NavigateNode> calc2 = NavigateUtils.calc(middleLocNo, locNO, 2);//小车有货，走出库地图(出库地图有专用货道)
			if (calc2 == null) {
			return null;
			}

			//获取分段路径
			ArrayList<ArrayList<NavigateNode>> data2 = NavigateUtils.getSectionPath(calc2);
			for (ArrayList<NavigateNode> nodes : data2) {
			//开始路径
			NavigateNode startPath = nodes.get(0);
			//目标路径
			NavigateNode endPath = nodes.get(nodes.size() - 1);
			Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//计算当前路径行走总距离

			command = new ShuttleCommand();
			command.setCommandWord((short) 1);

			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			command.setStartCodeNum(startCodeNum);

			command.setMiddleCodeNum((short) 1);

			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			command.setDistCodeNum(distCodeNum);

			command.setStartToDistDistance(allDistance);
			command.setMiddleToDistDistance(0);
			command.setRunDirection(ShuttleRunDirection.get(startPath.getDirection()).id);
			command.setPalletLift((short) 1);
			command.setForceMoveDistance(0);
			command.setChargeSwitch((short) 2);
			command.setIOControl((short) 0);
			command.setRadarTmp((short) 0);
			command.setCommandEnd((short) 1);
			commands.add(command);
			}

			//小车指令到达目标位置后，再发出一条托盘下降指令
			command = new ShuttleCommand();
			command.setCommandWord((short) 2);
			command.setPalletLift((short) 2);
			command.setCommandEnd((short) 1);
			commands.add(command);

			return commands;
			return true;
			}

			/**
			* 出库 ===>> 四向穿梭车出库作业下发
			*/
			public synchronized void shuttleIoOutExecute() {
			public synchronized void shuttleOutExecute() {
			for (WrkMast wrkMast : wrkMastMapper.selectBy2125()) {
			//提取一条待出库任务
			if (wrkMast != null) {
			String outStaLocNo = null;//出库站点库位号
			//获取出库站点
			for (DevpSlave devpSlave : slaveProperties.getDevp()) {
			for (DevpSlave.StaRack staOutRack : devpSlave.getRackOutStn()) {
			if (staOutRack.getStaNo().equals(wrkMast.getStaNo())) {
			//出库站点和工作档出库站点一致
			outStaLocNo = CommonUtils.getLocNoFromRBL(staOutRack.getRow(), staOutRack.getBay(), staOutRack.getLev());
			}
			}

			}

			if (wrkMast.getWrkSts() == 21
			\|\| wrkMast.getWrkSts() == 25
			\|\| wrkMast.getWrkSts() == 31) {
			ShuttleThread shuttleThread = null;
			HashMap<String, Object> searchIdleShuttle = null;
			if (wrkMast.getWrkSts() == 21) {
			//寻找最近且空闲的四向穿梭车
			searchIdleShuttle = this.searchIdleShuttle(wrkMast);
			shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
			}else if(wrkMast.getWrkSts() == 31 \|\| wrkMast.getWrkSts() == 25) {
			//继续完成之前小车未完成的任务
			shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			}

			if (shuttleThread == null) {
			continue;
			}

			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			if (!shuttleProtocol.isIdle()) {
			continue;
			}

			if (outStaLocNo == null) {
			continue;
			}

			wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//给工作档分配四向穿梭车号
			//源库位(小车当前位置)
			String currentLocNo = shuttleProtocol.getCurrentLocNo();

			//小车当前层高
			Integer currentLev = Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));
			//获取提升机
			LiftSlave liftSlave = slaveProperties.getLift().get(0);
			//提升机库位号
			String liftLocNo = liftSlave.getLiftLocNo(currentLev);

			//分配任务号
			shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
			//分配源库位
			shuttleProtocol.setSourceLocNo(currentLocNo);

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			//四向穿梭车号
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			//任务号
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
			//入出库模式
			assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());
			assignCommand.setSourceLocNo(currentLocNo);

			if (wrkMast.getWrkSts() == 21) {
			//判断小车和库位是否在同一层
			if (Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
			//同一层(将小车移动到货物位置)

			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftLocNo);
			//分配目标库位
			shuttleProtocol.setLocNo(wrkMast.getSourceLocNo());
			//目标库位
			assignCommand.setLocNo(wrkMast.getSourceLocNo());
			assignCommand.setCommands(commands);
			wrkMast.setWrkSts(26L);//小车搬运中
			}else {
			//不同层，将目标库位分配成提升机库位号(将小车移动到提升机位置)

			//小车到提升机口指令
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, ShuttleTaskModeType.PAK_IN.id);
			shuttleProtocol.setLocNo(liftLocNo);
			//目标库位
			assignCommand.setLocNo(liftLocNo);
			assignCommand.setCommands(commands);
			wrkMast.setWrkSts(22L);//小车迁移状态
			}
			} else if (wrkMast.getWrkSts() == 25) {
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftLocNo);
			//此时车在提升机内部，需要多下达一步指令让车移动到提升机口
			BasDevp basDevp = basDevpService.selectById(109);//获取提升机信息
			ShuttleCommand moveCommand = new ShuttleCommand();
			moveCommand.setCommandWord((short) 1);//小车移动指令字
			moveCommand.setStartCodeNum(Short.parseShort(basDevp.getQrCodeValue()));//提升机二维码
			moveCommand.setDistCodeNum(commands.get(0).getStartCodeNum());
			moveCommand.setStartToDistDistance(1300);
			moveCommand.setMiddleToDistDistance(0);
			moveCommand.setRunDirection(commands.get(0).getRunDirection());
			moveCommand.setCommandEnd((short) 1);
			commands.add(0, moveCommand);//将该指令添加到队头

			//分配目标库位
			shuttleProtocol.setLocNo(wrkMast.getSourceLocNo());
			//目标库位
			assignCommand.setLocNo(wrkMast.getSourceLocNo());
			assignCommand.setCommands(commands);
			wrkMast.setWrkSts(26L);//小车搬运中
			}

			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}
			boolean step1 = this.shuttleOutExecuteStep1(wrkMast);//小车搬出库中
			if (!step1) {
			continue;
			}
			}
			}

			/**
			* 出库-小车搬出库中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public boolean shuttleOutExecuteStep1(WrkMast wrkMast) {
			//21.生成出库任务 => 22.小车搬运中
			if (wrkMast.getWrkSts() == 21) {
			if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到货物所在库位进行取货
			return false;
			}

			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}
			if (!shuttleProtocol.isIdle()) {
			return false;
			}

			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), wrkMast.getLiftNo());
			if (targetBasDevp == null) {
			return false;//缺少站点信息
			}

			//判断小车是否到达货物库位
			if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) {
			//小车不在输送站点位置
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在输送站点进行取货
			return false;
			}

			//小车已抵达货物位置，进行搬运货物
			NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), targetBasDevp.getLocNo());
			if (result == null) {//出库路径计算失败
			return false;
			}

			//创建分配命令
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());//出库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(result.getCommands());//运行命令
			assignCommand.setNodes(result.getNodes());//路径节点

			wrkMast.setWrkSts(22L);//21.生成出库任务 => 22.小车搬运中
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			return false;
			}
			return true;
			}

			/**
			@@ -1002,16 +838,44 @@
			*/
			public HashMap<String,Object> searchIdleShuttle(WrkMast wrkMast) {
			HashMap<String, Object> map = new HashMap<>();
			String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();//库位号
			String locNo = wrkMast.getIoType() < 101 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();//库位号
			LocMast locMast = locMastService.queryByLoc(locNo);//找到库位记录
			String lay = locNo.substring(locNo.length() - 2, locNo.length());//当前工作档库位层高
			int lev = Utils.getLev(locNo);//当前工作档库位层高
			ShuttleThread recentShuttle = null;//当前距离最近的四向穿梭车线程

			ArrayList<ShuttleThread> sameLev = new ArrayList<>();//相同楼层的穿梭车
			ArrayList<ShuttleThread> diffLev = new ArrayList<>();//不同楼层的穿梭车

			//判断其他空闲穿梭车是否离任务最近
			String distLocNo = null;//目标地点，入库=》提升机口，出库=》货物库位号
			if (wrkMast.getIoType() < 101 && wrkMast.getIoType() != 11) {
			//入库
			distLocNo = Utils.levToOutInStaLocNo(lev);
			}else if(wrkMast.getIoType() >= 101){
			//出库
			distLocNo = locNo;
			} else if (wrkMast.getIoType() == 11) {
			//库位移转
			distLocNo = wrkMast.getSourceLocNo();
			}

			//判断当前任务所在楼层是否有其他任务已经分配了小车，如有则直接用该小车(一层楼仅分配一台车)
			List<WrkMast> wrkMasts = wrkMastService.selectShuttleWrkByLev(lev);//判断当前穿梭车楼层是否已有分配车辆的任务，如果有则分配这辆车
			if (wrkMasts.size() > 0) {
			//存在其他任务，分配这辆车
			WrkMast wrkMast1 = wrkMasts.get(0);
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast1.getShuttleNo());

			map.put("sameLay", true);//同层
			map.put("result", shuttleThread);
			return map;
			}

			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			if (shuttleProtocol == null \|\| shuttleProtocol.getShuttleNo() == null) {
			continue;
			}
			if (!shuttleProtocol.isIdle()) {
			@@ -1019,62 +883,79 @@
			}

			String shuttleLocNo = shuttleProtocol.getCurrentLocNo();//二维码对应库位号
			String shuttleLocNoLay = shuttleLocNo.substring(shuttleLocNo.length() - 2, shuttleLocNo.length());//库位号对应层高
			if (lay.equals(shuttleLocNoLay)) {
			//当前四向穿梭车和工作档任务在同一层，则调配该车辆
			map.put("sameLay", true);//同一层
			if (shuttleLocNo == null) {
			continue;
			}

			if (shuttleLocNo.equals(distLocNo)) {
			//车辆当前位置已经是目标库位，无需计算
			map.put("sameLay", true);//同层
			map.put("result", shuttleThread);
			return map;
			}

			//更新当前最近的四向穿梭车
			if (recentShuttle == null) {
			recentShuttle = shuttleThread;
			int shuttleLocNoLey = Utils.getLev(shuttleLocNo);//库位号对应层高
			if (lev == shuttleLocNoLey) {
			//工作档楼层相同的穿梭车
			sameLev.add(shuttleThread);
			}else {
			ShuttleProtocol recentShuttleProtocol = recentShuttle.getShuttleProtocol();//目前最近穿梭车
			String recentShuttleLocNo = recentShuttleProtocol.getCurrentLocNo();//二维码对应库位号
			String recentShuttleLocNoLay = recentShuttleLocNo.substring(recentShuttleLocNo.length() - 2, recentShuttleLocNo.length());//库位号对应层高

			int recentShuttleLocNoLayInt = Integer.parseInt(recentShuttleLocNoLay);
			int layInt = Integer.parseInt(lay);
			int shuttleLocNoLayInt = Integer.parseInt(shuttleLocNoLay);
			int i = Math.abs(layInt - recentShuttleLocNoLayInt);//工作档楼层减最近穿梭车楼层，取绝对值
			int j = Math.abs(layInt - shuttleLocNoLayInt);//工作档楼层减当前穿梭车楼层，取绝对值
			if (i < j) {
			//更新最近穿梭车
			recentShuttle = shuttleThread;
			} else if (i == j) {
			//楼层相同情况
			//找距离出库点最近的车

			if (!(recentShuttleProtocol.isIdle() && shuttleProtocol.isIdle())) {
			//只要有一辆车不是空闲则不进行调度
			map.put("sameLay", false);//不同层
			map.put("result", null);
			return map;
			}

			//获取提升机
			LiftSlave liftSlave = slaveProperties.getLift().get(0);
			//提升机库位号
			String recentLiftLocNo = liftSlave.getLiftLocNo(recentShuttleLocNoLayInt);
			String shuttleLiftLocNo = liftSlave.getLiftLocNo(shuttleLocNoLayInt);

			//当前最近四向穿梭车到提升机路径
			List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentShuttleLocNo, recentLiftLocNo, ShuttleTaskModeType.PAK_IN.id);
			//当前楼层四向穿梭车到提升机路径
			List<NavigateNode> shuttlePath = NavigateUtils.calc(shuttleLocNo, shuttleLiftLocNo, ShuttleTaskModeType.PAK_IN.id);
			//判断哪一个路径最短
			if (shuttlePath.size() < recentShuttlePath.size()) {
			//如果当前楼层的车路径更小，则更新最近穿梭车
			recentShuttle = shuttleThread;
			}
			}
			//工作档不同楼层的穿梭车
			diffLev.add(shuttleThread);
			}

			}

			map.put("sameLay", false);//不同层
			map.put("result", recentShuttle);
			Integer recentAllDistance = 9999999;
			if (sameLev.size() > 0) {
			//同一楼层有空闲穿梭车，则只在工作档楼层寻找
			//寻找离任务最近的穿梭车
			for (ShuttleThread shuttleThread : sameLev) {
			//当前穿梭车库位号
			String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo();
			//当前穿梭车线程到目标地点距离
			List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, distLocNo, NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), Utils.getLev(currentLocNo)));//搜索空闲穿梭车，使用正常通道地图
			if (currentShuttlePath == null) {
			continue;
			}
			Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//计算当前路径行走总距离
			if (currentAllDistance < recentAllDistance) {
			//如果当前楼层的车路径更小，则更新最近穿梭车
			recentShuttle = shuttleThread;
			}
			}

			map.put("sameLay", true);//同层
			map.put("result", recentShuttle);
			}else {
			//同一楼层，没有空闲穿梭车，只能从其他楼层调度
			//寻找离任务最近的穿梭车
			for (ShuttleThread shuttleThread : diffLev) {

			//当前穿梭车库位号
			String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo();
			int currentLev = Utils.getLev(currentLocNo);
			List<WrkMast> wrkMasts1 = wrkMastService.selectNoShuttleWrkByLev(currentLev);//判断当前穿梭车楼层是否有待分配车辆的任务，如果有则不分配这辆车
			if (wrkMasts1.size() > 0) {
			//存在其他任务，跳过这辆车
			continue;
			}

			//当前穿梭车线程到当前车子所在楼层的提升机口距离
			List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, Utils.levToOutInStaLocNo(currentLev), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), currentLev));//搜索空闲穿梭车，使用正常通道地图
			if (currentShuttlePath == null) {
			continue;
			}

			Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//计算当前路径行走总距离
			if (currentAllDistance < recentAllDistance) {
			//如果当前楼层的车路径更小，则更新最近穿梭车
			recentShuttle = shuttleThread;
			}
			}

			map.put("sameLay", false);//不同层
			map.put("result", recentShuttle);
			}
			return map;
			}

			@@ -1084,30 +965,37 @@
			public synchronized void shuttleFinished() {
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车信息
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			//四向穿梭车状态为等待确认
			//四向穿梭车状态为等待确认、小车处于空闲状态
			if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id //任务完成等待确认
			&& shuttleProtocol.getTaskNo() != 0) {
			&& shuttleProtocol.getTaskNo() != 0
			&& shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id
			) {
			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 9:
			wrkMast.setWrkSts(14L);
			case 5://5.小车搬运中 ==> 9.入库完成
			wrkMast.setWrkSts(9L);
			//任务号清零
			shuttleProtocol.setTaskNo(0);
			break;
			case 5:
			wrkMast.setWrkSts(6L);
			break;
			case 22:
			case 22://22.小车搬运中 ==> 23.小车搬运完成
			wrkMast.setWrkSts(23L);
			break;
			case 26:
			wrkMast.setWrkSts(27L);
			case 102://102.小车到提升机中 ==> 103.小车到提升机完成
			wrkMast.setWrkSts(103L);
			break;
			case 106://106.小车迁出提升机中 ==> 107.小车迁出提升机完成
			wrkMast.setWrkSts(107L);
			break;
			case 108://108.小车移动中 ==> 109.小车移动完成
			wrkMast.setWrkSts(109L);
			break;
			default:
			}
			@@ -1115,14 +1003,10 @@
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//设置四向穿梭车为空闲状态
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
			//任务号清零
			shuttleProtocol.setTaskNo((short) 0);
			//源库位清零
			shuttleProtocol.setSourceLocNo(null);
			//目标库位清零
			shuttleProtocol.setLocNo(null);
			//标记复位
			shuttleProtocol.setPakMk(true);
			//任务指令清零
			shuttleProtocol.setAssignCommand(null);
			News.info("四向穿梭车已确认且任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
			@@ -1131,47 +1015,6 @@
			}
			}

			}

			//四向穿梭车状态为充电状态
			if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id //充电标识
			&& shuttleProtocol.getTaskNo() != 0) {
			//查询是否有充电任务
			WrkCharge wrkCharge = wrkChargeMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
			if (wrkCharge != null) {
			switch (wrkCharge.getWrkSts().intValue()) {
			case 52://四向穿梭车迁移到提升机口
			wrkCharge.setWrkSts(53L);//迁移完成
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
			break;
			case 56:
			if (shuttleProtocol.getBatteryPower() == 1000) {
			wrkCharge.setWrkSts(60L);//充电完成
			}
			break;
			default:
			}

			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			if (wrkCharge.getWrkSts() == 60) {
			//设置四向穿梭车为空闲状态
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
			}
			//任务号清零
			shuttleProtocol.setTaskNo((short) 0);
			//源库位清零
			shuttleProtocol.setSourceLocNo(null);
			//目标库位清零
			shuttleProtocol.setLocNo(null);
			//标记复位
			shuttleProtocol.setPakMk(true);
			//任务指令清零
			shuttleProtocol.setAssignCommand(null);
			News.info("四向穿梭车已确认且任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
			} else {
			News.error("四向穿梭车已确认且任务完成状态,复位失败，但未找到工作档。四向穿梭车号={}，工作号={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
			}
			}
			}

			}
			@@ -1191,106 +1034,159 @@
			continue;
			}

			//判断提升机是否处于空闲状态
			if (!liftProtocol.isIdle()) {
			continue;
			}

			//搜索是否有待处理的任务
			WrkMast wrkMast = wrkMastMapper.selectLiftStep623();
			if (wrkMast == null) {
			List<WrkMast> wrkMasts = wrkMastMapper.selectLiftStep223103();
			if (wrkMasts.isEmpty()) {
			continue;
			}

			//给提升机分配任务
			liftProtocol.setLiftLock(true);//锁定提升机
			liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//设置任务号
			liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//设置四向穿梭车号
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//设置提升机状态为工作中
			for (WrkMast wrkMast : wrkMasts) {
			//搜索是否有其他任务占用了提升机，如果占用提升机的任务和当前任务相同，则运行执行
			WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
			if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) {
			continue;
			}

			//找到四向穿梭车的线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, liftProtocol.getShuttleNo().intValue());
			if (shuttleThread == null) {
			continue;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			boolean stepIn = this.liftIoExecuteStepIn(wrkMast);//提升机入库
			if (!stepIn) {
			continue;
			}

			boolean stepOut = this.liftIoExecuteStepOut(wrkMast);//提升机出库
			if (!stepOut) {
			continue;
			}
			}

			//命令list
			ArrayList<LiftCommand> commands = new ArrayList<>();
			}
			}

			//当前穿梭车库位号
			String currentLocNo = shuttleProtocol.getCurrentLocNo();
			//当前穿梭车楼层
			int currentLocNoLey = Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));
			/**
			* 提升机入库
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean liftIoExecuteStepIn(WrkMast wrkMast) {
			//--------------------------------------提升机入库-----------------------------------------//
			Date now = new Date();

			//工作档目标库位号
			String wrkMastLocNo = wrkMast.getIoType() == 101 ? wrkMast.getSourceLocNo() : wrkMast.getLocNo();
			//工作档目标库位楼层
			int wrkMastLocNoLey = Integer.parseInt(wrkMastLocNo.substring(wrkMastLocNo.length() - 2, wrkMastLocNo.length()));

			//提升机当前楼层
			int liftLev = liftProtocol.getLev().intValue();
			if (liftLev != currentLocNoLey) {
			//不同楼层
			LiftCommand command1 = new LiftCommand();
			command1.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command1.setTaskNo(liftProtocol.getTaskNo());//任务号
			command1.setRun((short) 1);//升降
			command1.setDistPosition((short) currentLocNoLey);//目标楼层(穿梭车所在楼层)
			command1.setLiftLock(true);//锁定提升机

			commands.add(command1);//将命令添加进list
			//2.设备上走 ==> 3.提升机搬运中
			if (wrkMast.getWrkSts() == 2) {
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
			if (liftThread == null) {
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return false;
			}
			if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
			return false;
			}
			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}

			//输送线将四向穿梭车移动进来
			LiftCommand command2 = new LiftCommand();
			command2.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command2.setTaskNo(liftProtocol.getTaskNo());//任务号
			command2.setRun((short) 6);//输送线运作
			command2.setLiftLock(true);//锁定提升机

			commands.add(command2);//将命令添加进list

			//提升机前往目标楼层
			LiftCommand command3 = new LiftCommand();
			command3.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command3.setTaskNo(liftProtocol.getTaskNo());//任务号
			command3.setRun((short) 1);//升降
			command3.setDistPosition((short) wrkMastLocNoLey);//工作档目标楼层
			command3.setLiftLock(true);//锁定提升机

			commands.add(command3);//将命令添加进list

			//提升机到达指定楼层，输送线将四向穿梭车移出去
			//输送线将四向穿梭车移动出去
			LiftCommand command4 = new LiftCommand();
			command4.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command4.setTaskNo(liftProtocol.getTaskNo());//任务号
			command4.setRun((short) 3);//输送线运作
			command4.setLiftLock(true);//锁定提升机

			commands.add(command4);//将命令添加进list

			if (wrkMast.getIoType() == 101) {
			//出库任务
			wrkMast.setWrkSts(24L);//移动任务
			}else {
			//入库任务
			wrkMast.setWrkSts(7L);//移动任务
			//获取源站对应的输送站点
			BasDevp sourceBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getStaNo());
			if (sourceBasDevp == null \|\| targetBasDevp == null) {
			return false;//缺少站点信息
			}
			//所需命令组合完毕，更新数据库，提交到线程去工作

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());

			ArrayList<NyLiftCommand> commands = new ArrayList<>();
			commands.add(liftCommand);

			//提交到线程去工作
			LiftAssignCommand assignCommand = new LiftAssignCommand();
			assignCommand.setCommands(commands);
			assignCommand.setLiftNo(liftProtocol.getLiftNo());
			assignCommand.setTaskNo(liftProtocol.getTaskNo());
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
			assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue());

			wrkMast.setWrkSts(3L);//2.设备上走 ==> 3.提升机搬运中
			wrkMast.setLiftNo(liftThread.getSlave().getId());//任务档绑定提升机号
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}
			return true;
			}

			/**
			* 提升机出库
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean liftIoExecuteStepOut(WrkMast wrkMast) {
			//--------------------------------------提升机出库-----------------------------------------//
			Date now = new Date();

			//23.小车搬运完成 ==> 24.提升机搬运中
			if (wrkMast.getWrkSts() == 23) {
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
			if (liftThread == null) {
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return false;
			}
			if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
			return false;
			}
			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}

			//获取源站对应的输送站点
			BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue());
			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
			if (sourceBasDevp == null \|\| targetBasDevp == null) {
			return false;//缺少站点信息
			}

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());

			ArrayList<NyLiftCommand> commands = new ArrayList<>();
			commands.add(liftCommand);

			//提交到线程去工作
			LiftAssignCommand assignCommand = new LiftAssignCommand();
			assignCommand.setCommands(commands);
			assignCommand.setLiftNo(liftProtocol.getLiftNo());
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
			assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue());

			wrkMast.setWrkSts(24L);//23.小车搬运完成 ==> 24.提升机搬运中
			wrkMast.setLiftNo(liftThread.getSlave().getId());//任务档绑定提升机号
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}
			return true;
			}

			/**
			@@ -1305,17 +1201,25 @@
			continue;
			}

			//提升机为等待确认
			if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id && liftProtocol.getTaskNo() != 0) {
			//提升机为等待确认且空闲
			if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id
			&& liftProtocol.getTaskNo() != 0
			&& !liftProtocol.getBusy()
			) {

			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo724(liftProtocol.getTaskNo().intValue());
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo324104(liftProtocol.getTaskNo().intValue());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 7:
			wrkMast.setWrkSts(8L);
			case 3://3.提升机搬运中 ==> 4.提升机搬运完成
			wrkMast.setWrkSts(4L);
			wrkMast.setLiftNo(null);//释放提升机
			break;
			case 24:
			case 24://24.提升机搬运中 ==> 25.提升机搬运完成
			wrkMast.setWrkSts(25L);
			break;
			case 104://104.提升机搬运中 ==> 105.提升机搬运完成
			wrkMast.setWrkSts(105L);
			break;
			default:
			}
			@@ -1323,330 +1227,59 @@
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//设置提升机为空闲状态
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
			//任务号清零
			liftProtocol.setTaskNo((short) 0);
			//标记复位
			liftProtocol.setPakMk(true);
			//任务指令清零
			liftProtocol.setAssignCommand(null);
			//提升机解锁
			liftProtocol.setLiftLock(false);
			News.info("提升机已确认且任务完成状态,复位。提升机号={}", liftProtocol.getLiftNo());
			News.info("提升机已确认且任务完成状态。提升机号={}", liftProtocol.getLiftNo());
			} else {
			News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
			}
			}

			//查询是否有充电任务
			WrkCharge wrkCharge = wrkChargeMapper.selectByWorkNo(liftProtocol.getTaskNo().intValue());
			if (wrkCharge != null) {
			switch (wrkCharge.getWrkSts().intValue()) {
			case 54://提升机搬运中
			wrkCharge.setWrkSts(55L);//提升机搬运完成
			break;
			default:
			}

			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//设置提升机为空闲状态
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
			//任务号清零
			liftProtocol.setTaskNo((short) 0);
			//标记复位
			liftProtocol.setPakMk(true);
			//任务指令清零
			liftProtocol.setAssignCommand(null);
			//提升机解锁
			liftProtocol.setLiftLock(false);
			News.info("提升机已确认且任务完成状态,复位。提升机号={}", liftProtocol.getLiftNo());
			} else {
			News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
			}
			}
			}
			}
			}

			/**
			* 当前库位组是否存在空闲小车
			* 库位移转
			*/
			public Integer hasCar(String locNo) {
			for (SteSlave ste : slaveProperties.getSte()) {
			// 获取堆垛机信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
			SteProtocol steProtocol = steThread.getSteProtocol();
			BasSte basSte = basSteService.selectById(ste.getId());
			if (Cools.isEmpty(steProtocol, basSte)) { continue; }
			if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(basSte.getRow(), true))
			&& basSte.getBay() == Utils.getBay(locNo)
			&& basSte.getLev() == Utils.getLev(locNo)) {
			return ste.getId();
			}
			}
			return null;
			}

			/**
			* 当前库位组是否存在其他小车
			*/
			public Integer existOtherSte(String locNo, Integer steNo) {
			Integer otherSteNo = null;
			for (SteSlave ste : slaveProperties.getSte()) {
			if (ste.getId().equals(steNo)) { continue; }
			// 获取堆垛机信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.isEnable()) {
			BasSte basSte = basSteService.selectById(ste.getId());
			if (basSte != null) {
			if ((Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(basSte.getRow(), true))
			&& basSte.getBay() == Utils.getBay(locNo)
			&& basSte.getLev() == Utils.getLev(locNo))
			\|\|
			(Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true))
			&& steProtocol.getBay() == Utils.getBay(locNo)
			&& steProtocol.getLev() == Utils.getLev(locNo))
			) {
			otherSteNo = ste.getId();
			break;
			}
			}
			}
			}
			return otherSteNo;
			}

			/**
			* 当前库位组是否存在空闲小车
			*/
			public Integer hasCarOfIdle(String locNo) {
			for (SteSlave ste : slaveProperties.getSte()) {
			// 获取堆垛机信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.isIdle()) {
			if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true))
			&& steProtocol.getBay() == Utils.getBay(locNo)
			&& steProtocol.getLev() == Utils.getLev(locNo)) {
			return steProtocol.getSteNo().intValue();
			}
			}
			}
			return null;
			}

			/**
			* 查找当前库位最适合的穿梭车来作业
			*/
			public SteThread queryIdleCar(WrkMast wrkMast) {
			List<BasSte> basStes = basSteService.selectList(new EntityWrapper<>());
			int val = 0;
			SteThread result = null;
			for (BasSte basSte : basStes) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, basSte.getSteNo());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (!steProtocol.isIdle()) { continue; }
			// if (steProtocol.getRow() == 1) { continue; }
			String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();
			// 如果在同一个库位组
			if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true))
			&& steProtocol.getBay().intValue() == Utils.getBay(locNo)
			&& steProtocol.getLev().intValue() == Utils.getLev(locNo)) {
			return steThread;
			}
			LocMast locMast = locMastService.selectById(locNo);
			int lev = locMast.getLev1();
			int bay = locMast.getBay1();
			int levAbs = Math.abs(lev - steProtocol.getLev());
			int bayAbs = Math.abs(bay - steProtocol.getBay());
			if (val == 0) {
			val = levAbs + bayAbs;
			result = steThread;
			} else {
			if ((levAbs + bayAbs) < val) {
			val = levAbs + bayAbs;
			result = steThread;
			}
			}
			}
			return result;
			}

			public SteThread queryIdleCar(CrnProtocol crnProtocol) {
			List<BasSte> basStes = basSteService.selectList(new EntityWrapper<>());
			int val = 0;
			SteThread result = null;
			for (BasSte basSte : basStes) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, basSte.getSteNo());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (!steProtocol.isIdle()) { continue; }
			if (steProtocol.getRow() == 1) { continue;}
			int lev = crnProtocol.getLevel();
			int bay = crnProtocol.getBay();
			int levAbs = Math.abs(lev - steProtocol.getLev());
			int bayAbs = Math.abs(bay - steProtocol.getBay());
			if (val == 0) {
			val = levAbs + bayAbs;
			result = steThread;
			} else {
			if ((levAbs + bayAbs) < val) {
			val = levAbs + bayAbs;
			result = steThread;
			}
			}
			}
			return result;
			}

			/**
			* 让小车行走至待机位
			*/
			public void letCarBeWaiting(WrkMast wrkMast, Integer steNo, String locNo) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }
			if (steProtocol.isIdle()) {

			// 如果处于待机位
			if (steProtocol.locaType.equals(SteLocaType.A_WAITING) \|\| steProtocol.locaType.equals(SteLocaType.B_WAITING)) {
			// 修改工作档状态绑定穿梭车
			wrkMast.setWrkSts(3L);
			wrkMast.setSteNo(steNo);
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			} else {
			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkMast.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findWaiting(steProtocol.getRow().intValue())); // 任务模式: 行走至待机位

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态绑定穿梭车
			wrkMast.setSteNo(steNo);
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			}
			}
			}

			public void letCarBeWaiting(WrkCharge wrkCharge, Integer steNo) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }

			if (!basSteService.updatePakMk(steNo, "Y")) {
			News.error("修改穿梭车作业状态失败！！，穿梭车={}", steNo);
			public synchronized void locToLocExecute() {
			//获取出入库工作档
			List<WrkMast> wrkMasts = wrkMastMapper.selectInOutWrkMast();
			if (wrkMasts.size() > 0) {
			//有出入库任务，必须等待任务执行完毕再执行库位移转
			return;
			}

			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol.getRow().intValue())); // 任务模式: 去近点等待堆垛机叉取
			//查询库位移转工作档
			List<WrkMast> wrkMasts1 = wrkMastMapper.selectLocToLocWrkMast();
			for (WrkMast wrkMast : wrkMasts1) {

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态绑定穿梭车
			wrkCharge.setSteNo(steNo);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkCharge.getWrkNo());
			boolean step1 = this.locToLocExecuteStep1(wrkMast);//绑定小车
			if (!step1) {
			continue;
			}

			}
			}

			/**
			* 让小车从远点 ====>> 移动到近点
			* 等待堆垛机搬运
			* 绑定小车并调度车
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public void letCarBeReady(WrkMast wrkMast, Integer steNo, String locNo) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }
			if (steProtocol.isIdle()) {

			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkMast.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol)); // 任务模式: 去近点等待堆垛机叉取

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态绑定穿梭车
			wrkMast.setSteNo(steNo);
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			private boolean locToLocExecuteStep1(WrkMast wrkMast) {
			if (wrkMast.getShuttleNo() == null) {//给库位移转绑定穿梭车号
			//寻找最近且空闲的四向穿梭车
			HashMap<String,Object> searchIdleShuttle = this.searchIdleShuttle(wrkMast);
			ShuttleThread shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
			if (shuttleThread == null) {
			//没有找到空闲穿梭车
			return false;
			}
			wrkMast.setShuttleNo(shuttleThread.getSlave().getId());//给工作档分配四向穿梭车号
			wrkMastMapper.updateById(wrkMast);
			}
			}

			/**
			* 让小车从远点 ====>> 移动到近点
			* 等待堆垛机搬运
			*/
			public void letCarBeReady(WrkCharge wrkCharge, Integer steNo) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }
			if (steProtocol.isIdle()) {

			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol)); // 任务模式: 去近点等待堆垛机叉取

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态绑定穿梭车
			wrkCharge.setSteNo(steNo);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			}
			return true;
			}

			/**
			@@ -2036,663 +1669,501 @@
			* 四向穿梭车电量检测 ===>> 发起充电
			*/
			public synchronized void loopShuttleCharge() {
			for (DevpSlave devpSlave : slaveProperties.getDevp()) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devpSlave.getId());
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			//判断当前小车是否满足需要充电要求
			if (!shuttleProtocol.isRequireCharge()) {
			continue;
			}

			WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
			if (wrkCharge != null) {//已有充电任务
			continue;
			}

			ShuttleChargeType shuttleCharge = null;
			String locNo;
			for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
			switch (chargeType.id) {
			case 1:
			if (devpThread.charge0 == false) {
			ShuttleChargeType first = ShuttleChargeType.FIRST;
			locNo = first.locNo;
			if (wrkChargeService.selectWorkingOfCharge(first.id) == null) {
			shuttleCharge = first;
			}
			}
			break;
			default:
			}
			}

			if (shuttleCharge == null) {
			continue;
			}

			String chargeLocNo = shuttleCharge.locNo;
			wrkCharge = new WrkCharge();
			wrkCharge.setShuttleNo(shuttle.getId());
			wrkCharge.setCharge(shuttleCharge.id);
			wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
			wrkCharge.setWrkSts(51L); // 21.准备充电
			wrkCharge.setIoPri((double) 10);
			wrkCharge.setLocNo(chargeLocNo);
			wrkCharge.setMemo("charge");
			wrkCharge.setAppeTime(new Date());
			if (!wrkChargeService.insert(wrkCharge)) {
			News.error("保存{}号四向穿梭车充电任务失败!!!", shuttle.getId());
			continue;
			}

			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//充电中
			News.info("保存{}号四向穿梭车充电任务成功!!!", shuttle.getId());
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车线程
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			//判断当前小车是否满足需要充电要求
			if (!shuttleProtocol.isRequireCharge()) {
			continue;
			}

			WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttleProtocol.getShuttleNo().intValue());
			if (wrkCharge != null) {//已有充电任务
			continue;
			}

			ShuttleChargeType shuttleCharge = null;
			for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
			if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
			shuttleCharge = chargeType;
			break;
			}
			}

			if (shuttleCharge == null) {
			continue;
			}

			String chargeLocNo = shuttleCharge.locNo;
			wrkCharge = new WrkCharge();
			wrkCharge.setShuttleNo(shuttle.getId());
			wrkCharge.setCharge(shuttleCharge.id);
			wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
			wrkCharge.setWrkSts(51L); // 21.准备充电
			wrkCharge.setIoPri((double) 10);
			wrkCharge.setLocNo(chargeLocNo);
			wrkCharge.setMemo("charge");
			wrkCharge.setAppeTime(new Date());
			if (!wrkChargeService.insert(wrkCharge)) {
			News.error("保存{}号四向穿梭车充电任务失败!!!", shuttle.getId());
			continue;
			}

			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//充电中
			News.info("保存{}号四向穿梭车充电任务成功!!!", shuttle.getId());
			}


			}

			/**
			* 执行四向穿梭车充电任务
			*/
			public synchronized void executeShuttleCharge() {
			WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
			if (wrkCharge == null) {
			return;
			}
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttle.getId());
			if (wrkCharge == null) {
			continue;
			}

			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
			if (shuttleThread == null) {
			continue;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
			if (shuttleThread == null) {
			return;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return;
			}
			if (wrkCharge.getWrkSts() == 51) {
			if (!shuttleProtocol.getCurrentLocNo().equals(wrkCharge.getLocNo())) {
			//小车不在充电桩位置
			shuttleDispatchUtils.dispatchShuttle(wrkCharge.getWrkNo(), wrkCharge.getLocNo(), shuttle.getId());//调度小车去充电桩
			continue;
			}

			//当前穿梭车库位号
			String currentLocNo = shuttleProtocol.getCurrentLocNo();
			//小车当前层高
			Integer currentLev = Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));
			//获取提升机
			LiftSlave liftSlave = slaveProperties.getLift().get(0);
			//提升机库位号
			String liftLocNo = liftSlave.getLiftLocNo(currentLev);
			//充电库位号
			String chargeLocNo = wrkCharge.getLocNo();
			//充电库位层高
			Integer chargeLocNoLev = Integer.parseInt(chargeLocNo.substring(chargeLocNo.length() - 2, chargeLocNo.length()));

			if (wrkCharge.getWrkSts() == 51 \|\| wrkCharge.getWrkSts() == 55) {
			if (currentLev == chargeLocNoLev) {
			//同一层无需经过提升机
			//直接计算车到充电库位
			//获取小车到充电库位路径指令
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, ShuttleTaskModeType.PAK_IN.id);
			//进行充电中
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
			//小车已经在充电桩位置，下发充电命令
			NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), true);
			ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>();
			commands.add(chargeCommand);
			//创建分配命令
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			assignCommand.setTaskMode((short) 9);//充电
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
			assignCommand.setCharge(true);//充电任务
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(commands);//运行命令

			//创建充电指令
			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 5);//充电
			command.setShuttleNo(shuttleProtocol.getShuttleNo());
			command.setChargeSwitch((short) 1);//开始充电
			command.setCommandEnd((short) 1);
			commands.add(command);

			//指令集分配
			assignCommand.setCommands(commands);

			wrkCharge.setWrkSts(56L);//充电中状态
			wrkCharge.setWrkSts(52L);//51.生成充电任务 => 52.小车去充电中
			wrkCharge.setModiTime(new Date());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}else {
			//不同层，将目标库位分配成提升机库位号
			} else if (wrkCharge.getWrkSts() == 52) {
			//检测小车是否满电
			if (shuttleProtocol.getPowerPercent() < 100) {
			continue;
			}

			//小车移动到提升机口，计算路径
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, ShuttleTaskModeType.PAK_IN.id);
			//分配目标库位
			shuttleProtocol.setLocNo(liftLocNo);

			//小车满电，结束充电任务
			NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), false);
			ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>();
			commands.add(chargeCommand);
			//创建分配命令
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			assignCommand.setTaskMode((short) 9);//充电
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
			assignCommand.setCharge(true);//充电任务
			//目标库位
			assignCommand.setLocNo(liftLocNo);
			//源库位
			assignCommand.setSourceLocNo(currentLocNo);
			assignCommand.setCommands(commands);
			wrkCharge.setWrkSts(52L);//小车迁移状态
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(commands);//运行命令

			wrkCharge.setWrkSts(53L);//52.小车去充电中 => 53.小车充电完成
			wrkCharge.setModiTime(new Date());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			} else if (wrkCharge.getWrkSts() == 53) {
			boolean result = Utils.searchEmptyGroupToMoveShuttle(Utils.getLev(wrkCharge.getLocNo()), shuttleThread.getSlave().getId(), shuttleThread);
			if (!result) {
			continue;
			}

			wrkCharge.setWrkSts(60L);//53.小车充电完成 => 60.充电任务完成
			wrkCharge.setModiTime(new Date());
			wrkChargeMapper.updateById(wrkCharge);
			}

			}

			}

			/**
			* 执行小车移库任务
			*/
			public synchronized void shuttleMoveExecute() {
			//查询小车移库任务
			List<WrkMast> wrkMasts = wrkMastMapper.selectShuttleMoveWrk();
			for (WrkMast wrkMast : wrkMasts) {
			boolean step1 = this.shuttleMoveExecuteStep1(wrkMast);//小车移动到提升机中
			if (!step1) {
			continue;
			}

			boolean step2 = this.shuttleMoveExecuteStep2(wrkMast);//提升机搬运中
			if (!step2) {
			continue;
			}

			boolean step3 = this.shuttleMoveExecuteStep3(wrkMast);//小车迁出提升机中
			if (!step3) {
			continue;
			}

			boolean step4 = this.shuttleMoveExecuteStep4(wrkMast);//小车移动到目标库位中
			if (!step4) {
			continue;
			}
			}
			}

			/**
			* 小车迁移-小车移动到提升机中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean shuttleMoveExecuteStep1(WrkMast wrkMast) {
			//--------------------------------------小车移动到提升机中-----------------------------------------//
			Date now = new Date();

			//小车移动到提升机中 101.生成小车移库任务 ==> 102.小车到提升机中
			if (wrkMast.getWrkSts() == 101) {
			//获取四向穿梭车线程
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}

			//小车处于空闲状态
			if (!shuttleProtocol.isIdleNoCharge()) {
			return false;
			}

			if (Utils.getLev(wrkMast.getLocNo()) == shuttleProtocol.getPoint().getZ()) {
			//目标库位和小车库位处于同一楼层，需要通过提升机调度
			return true;//直接进入108.小车移动中
			}

			//计算距离小车最近的提升机站点
			//查询小车所在楼层提升机输送站点
			int recentAllDistance = 9999999;//默认最近距离
			BasDevp recentDevp = null;//最近站点
			List<BasDevp> basDevps = basDevpService.selectHasLiftNoByLev(shuttleProtocol.getPoint().getZ());
			for (BasDevp basDevp : basDevps) {
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, basDevp.getLiftNo());
			if (liftThread == null) {
			continue;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}
			if (!liftProtocol.isIdle()) {
			continue;
			}

			//计算路径
			List<NavigateNode> calc = NavigateUtils.calc(shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo(), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), Utils.getLev(shuttleProtocol.getCurrentLocNo())));
			if (calc == null) {
			continue;//计算失败，找下一个站点
			}

			Integer allDistance = NavigateUtils.getOriginPathAllDistance(calc);//根据原始节点结果，计算总行走距离
			if (recentAllDistance > allDistance) {
			recentAllDistance = allDistance;//更新距离
			recentDevp = basDevp;//更新输送站点
			}
			}

			}else if(wrkCharge.getWrkSts() == 53){
			//小车已经达到提升机口
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
			if (recentDevp == null) {
			//没有找到可用输送站点
			return false;//等待下一次轮询
			}

			//获取提升机数据
			BasLift basLift = basLiftService.selectById(recentDevp.getLiftNo());
			if (basLift == null) {
			return false;//没有提升机数据
			}
			if (basLift.getPoint() == null) {
			return false;//没有设置提升机点位坐标
			}
			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(basLift.getLiftNo());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}
			NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
			liftNode.setZ(basLift.getPoint().getZ());

			//获取小车到输送站点行走命令
			NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), recentDevp.getLocNo());
			//获取小车进提升机行走命令
			NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), NavigatePositionConvert.locNoToNode(recentDevp.getLocNo()), liftNode, true);
			if (result.getCommands() == null) {
			return false;//路径计算失败
			}
			List<NyShuttleHttpCommand> commands = result.getCommands();
			commands.add(moveCommand);//添加小车迁入提升机命令

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
			assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setAuto(true);//自动模式
			assignCommand.setCommands(commands);
			assignCommand.setNodes(result.getNodes());

			wrkMast.setWrkSts(102L);//小车移动到提升机中 101.生成小车移库任务 ==> 102.小车到提升机中
			wrkMast.setLiftNo(basLift.getLiftNo());//提升机号(锁定提升机防止被其他任务抢占)
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}
			return true;
			}

			/**
			* 小车迁移-提升机搬运中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean shuttleMoveExecuteStep2(WrkMast wrkMast) {
			//--------------------------------------提升机搬运中-----------------------------------------//
			Date now = new Date();

			//提升机搬运中 103.小车到提升机完成 ==> 104.提升机搬运中
			if (wrkMast.getWrkSts() == 103) {

			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
			if (liftThread == null) {
			return;
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return;
			return false;
			}
			if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
			return false;
			}

			//判断提升机是否处于空闲状态
			if (!liftProtocol.isIdle()) {
			return;
			//获取四向穿梭车线程
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}

			//给提升机分配任务
			liftProtocol.setLiftLock(true);//锁定提升机
			liftProtocol.setTaskNo(wrkCharge.getWrkNo().shortValue());//设置任务号
			liftProtocol.setShuttleNo(wrkCharge.getShuttleNo().shortValue());//设置四向穿梭车号
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//设置提升机状态为工作中

			//命令list
			ArrayList<LiftCommand> commands = new ArrayList<>();

			//提升机当前楼层
			int liftLev = liftProtocol.getLev().intValue();
			if (liftLev != currentLev) {
			//穿梭车和提升机处于不同楼层
			LiftCommand command1 = new LiftCommand();
			command1.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command1.setTaskNo(liftProtocol.getTaskNo());//任务号
			command1.setRun((short) 1);//升降
			command1.setDistPosition(currentLev.shortValue());//目标楼层(穿梭车所在楼层)
			command1.setLiftLock(true);//锁定提升机
			commands.add(command1);//将命令添加进list
			//小车处于空闲状态
			if (!shuttleProtocol.isIdleNoCharge()) {
			return false;
			}

			//输送线将四向穿梭车移动进来
			LiftCommand command2 = new LiftCommand();
			command2.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command2.setTaskNo(liftProtocol.getTaskNo());//任务号
			command2.setRun((short) 6);//输送线运作
			command2.setLiftLock(true);//锁定提升机
			//获取源站对应的输送站点
			BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue());
			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue());
			if (sourceBasDevp == null \|\| targetBasDevp == null) {
			return false;//缺少站点信息
			}

			commands.add(command2);//将命令添加进list
			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());

			//提升机前往目标楼层
			LiftCommand command3 = new LiftCommand();
			command3.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command3.setTaskNo(liftProtocol.getTaskNo());//任务号
			command3.setRun((short) 1);//升降
			command3.setDistPosition(chargeLocNoLev.shortValue());//充电库位目标楼层
			command3.setLiftLock(true);//锁定提升机
			ArrayList<NyLiftCommand> commands = new ArrayList<>();
			commands.add(liftCommand);

			commands.add(command3);//将命令添加进list

			//提升机到达指定楼层，输送线将四向穿梭车移出去
			//输送线将四向穿梭车移动出去
			LiftCommand command4 = new LiftCommand();
			command4.setLiftNo(liftProtocol.getLiftNo());//提升机号
			command4.setTaskNo(liftProtocol.getTaskNo());//任务号
			command4.setRun((short) 3);//输送线运作
			command4.setLiftLock(true);//锁定提升机

			commands.add(command4);//将命令添加进list

			wrkCharge.setWrkSts(54L);//提升机搬运中
			//所需命令组合完毕，更新数据库，提交到线程去工作
			//提交到线程去工作
			LiftAssignCommand assignCommand = new LiftAssignCommand();
			assignCommand.setCommands(commands);
			assignCommand.setLiftNo(liftProtocol.getLiftNo());
			assignCommand.setTaskNo(liftProtocol.getTaskNo());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
			assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_CAR.id.shortValue());

			wrkMast.setWrkSts(104L);//提升机搬运中 103.小车到提升机完成 ==> 104.提升机搬运中
			wrkMast.setLiftNo(liftThread.getSlave().getId());//锁定提升机防止被占用
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}

			} else if (wrkCharge.getWrkSts() == 56) {
			//充电中
			//判断小车是否充满电量，满电1000或电压54V以上
			if (shuttleProtocol.getBatteryPower() >= 1000 \|\| shuttleProtocol.getCurrentVoltage() >= 540) {
			//充满，断开充电
			List<ShuttleCommand> commands = new ArrayList<>();
			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			assignCommand.setTaskMode((short) 0);
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
			assignCommand.setCharge(true);
			}
			return true;
			}

			//创建充电指令
			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 5);//充电
			command.setShuttleNo(shuttleProtocol.getShuttleNo());
			command.setChargeSwitch((short) 2);//断开充电
			command.setCommandEnd((short) 1);
			commands.add(command);
			/**
			* 小车迁移-小车迁出提升机中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean shuttleMoveExecuteStep3(WrkMast wrkMast) {
			//--------------------------------------小车迁出提升机中-----------------------------------------//
			Date now = new Date();

			//指令集分配
			assignCommand.setCommands(commands);
			//小车迁出提升机中 105.提升机搬运完成 ==> 106.小车迁出提升机中
			if (wrkMast.getWrkSts() == 105) {

			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING);
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
			if (liftThread == null) {
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return false;
			}
			if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
			return false;
			}

			//获取四向穿梭车线程
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}

			//小车处于空闲状态
			if (!shuttleProtocol.isIdleNoCharge()) {
			return false;
			}

			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue());
			if (targetBasDevp == null) {
			return false;//缺少站点信息
			}

			//获取提升机数据
			BasLift basLift = basLiftService.selectById(targetBasDevp.getLiftNo());
			if (basLift == null) {
			return false;//没有提升机数据
			}
			if (basLift.getPoint() == null) {
			return false;//没有设置提升机点位坐标
			}
			NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
			liftNode.setZ(basLift.getPoint().getZ());

			List<NyShuttleHttpCommand> commands = new ArrayList<>();
			//获取小车出提升机行走命令
			NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), liftNode, NavigatePositionConvert.locNoToNode(targetBasDevp.getLocNo()), false);
			commands.add(moveCommand);//添加小车迁出提升机命令

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
			assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setAuto(true);//自动模式
			assignCommand.setCommands(commands);
			assignCommand.setNodes(null);

			wrkMast.setWrkSts(106L);//小车迁出提升机中 105.提升机搬运完成 ==> 106.小车迁出提升机中
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}

			if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id) {
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
			}
			}

			return true;
			}

			/**
			* 轮询充电桩是否有空闲小车
			* 小车迁移-小车移动到目标库位中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			@Deprecated
			public synchronized void queryChargeLocOfComplete() {
			// 与充电任务不同步进行
			if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge)) { return; }
			if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset)) { return; }
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			// 检索充电桩
			for (SteChargeType value : SteChargeType.values()) {
			Integer steNo = basSteService.hasCarOfLocNo(value.locNo);
			if (steNo != null) {
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			BasSte basSte = basSteService.selectById(steNo);
			if (Cools.isEmpty(steProtocol, basSte)) {
			continue;
			}
			if (steProtocol.getCharge() < 99) {
			continue;
			}
			if (steProtocol.getMode() == 0) {
			continue;
			}
			if (!steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
			continue;
			}
			// // 1号充电桩
			// if (value.equals(SteChargeType.FIRST) && devpThread.charge0) {
			// continue;
			// }
			// // 2号充电桩
			// if (value.equals(SteChargeType.SECOND) && devpThread.charge1) {
			// continue;
			// }
			// // 3号充电桩
			// if (value.equals(SteChargeType.THIRD) && devpThread.charge2) {
			// continue;
			// }
			// // 小车是否处于充电状态
			// if (steProtocol.getChargeStatus() == 1) {
			// continue;
			// }
			// case 1 : 自动充电开馈电 ×
			// case 2 : 自动充电开满电 ✔
			// case 3 : 自动充电关馈电 ✔
			// case 4 : 自动充电关满电 ✔
			if (basSte.getAutoCharge().equals("Y")
			&& steProtocol.getCharge() < Float.parseFloat(basSte.getChargeLine())) {
			continue;
			}
			private boolean shuttleMoveExecuteStep4(WrkMast wrkMast) {
			//--------------------------------------小车移动到目标库位中-----------------------------------------//
			Date now = new Date();

			WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset);
			//小车移动到目标库位中 107.小车迁出提升机完成 ==> 108.小车移动中
			if (wrkMast.getWrkSts() == 107) {

			if (wrkCharge == null) {
			// 开始穿梭车复位任务
			wrkCharge = new WrkCharge();
			wrkCharge.setSteNo(steNo);
			wrkCharge.setWrkNo(commonService.getChargeWorkNo(6));
			wrkCharge.setWrkSts(41L); // 41.小车准备复位
			wrkCharge.setCrnNo(2); // 固定2号堆垛机
			wrkCharge.setIoPri((double) 10);
			wrkCharge.setSourceLocNo(value.locNo);
			wrkCharge.setLocNo(basSte.getIdleLoc());
			wrkCharge.setMemo("reset");
			wrkCharge.setAppeTime(new Date());
			if (!wrkChargeService.insert(wrkCharge)) {
			News.error("保存{}号穿梭车复位任务失败!!!", steNo);
			} else {
			break;
			}
			}
			//获取四向穿梭车线程
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return false;
			}

			//小车处于空闲状态
			if (!shuttleProtocol.isIdleNoCharge()) {
			return false;
			}

			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), wrkMast.getLiftNo());
			if (targetBasDevp == null) {
			return false;//缺少站点信息
			}

			//获取提升机数据
			BasLift basLift = basLiftService.selectById(targetBasDevp.getLiftNo());
			if (basLift == null) {
			return false;//没有提升机数据
			}
			if (basLift.getPoint() == null) {
			return false;//没有设置提升机点位坐标
			}
			NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
			liftNode.setZ(basLift.getPoint().getZ());

			//获取小车从输送站到目标库位命令
			NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), targetBasDevp.getLocNo(), wrkMast.getLocNo());
			if (result.getCommands() == null) {
			return false;//路径计算失败
			}
			List<NyShuttleHttpCommand> commands = result.getCommands();

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
			assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
			assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
			assignCommand.setAuto(true);//自动模式
			assignCommand.setCommands(commands);
			assignCommand.setNodes(result.getNodes());

			wrkMast.setWrkSts(108L);//小车移动到目标库位中 107.小车迁出提升机完成 ==> 108.小车移动中
			wrkMast.setLiftNo(null);//释放提升机
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}
			return true;
			}

			/**
			* 小车从充电桩至待机库位
			*/
			@Deprecated
			public synchronized void steFromChargeToIdleLoc() {
			WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.reset);
			if (wrkCharge == null) { return; }
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			SteProtocol steProtocol = steThread.getSteProtocol();
			BasSte basSte = basSteService.selectById(wrkCharge.getSteNo());
			if (Cools.isEmpty(steProtocol, basSte)) {
			return;
			}
			// 搬运至固定通道
			if (wrkCharge.getWrkSts() == 41L) {
			// 搬小车至小车走向通道
			List<String> channel = slaveProperties.getChannel();
			for (String channelLocNo : channel) {
			Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo());
			if (null != otherSte) {
			News.warn("{}号小车移入{}库位组失败，原因：存在{}号穿梭车！", wrkCharge.getSteNo(), channelLocNo, otherSte);
			} else {
			// 固定堆垛机
			int crnNo = 1;
			if (null != wrkMastMapper.selectWorkingByCrn(crnNo)) {
			return;
			}

			LocMast channelLoc = locMastService.selectById(channelLocNo);

			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo);
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) { continue; }
			// 只有当堆垛机空闲并且无任务时才继续执行
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnNo); // 堆垛机编号
			crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(steProtocol.getRow()); // 源库位排
			crnCommand.setSourcePosY(steProtocol.getBay()); // 源库位列
			crnCommand.setSourcePosZ(steProtocol.getLev()); // 源库位层
			crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), false).shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(channelLoc.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(channelLoc.getLocNo(), false), channelLoc.getBay1(), channelLoc.getLev1());
			// 修改工作档状态 41.小车准备复位 => 42.吊车搬运
			Date now = new Date();
			wrkCharge.setWrkSts(42L);
			wrkCharge.setCrnStrTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改复位任务状态 41.小车准备复位 => 42.吊车搬运失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			break;
			}

			}
			}
			} else if (wrkCharge.getWrkSts() == 43L) {
			// 小车行驶通道
			if (steProtocol.statusType.equals(SteStatusType.IDLE) && steProtocol.getPakMk().equals("N")) {
			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkCharge.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.BACK_ORIGIN); // 去左端

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());
			if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态 43.小车到达 ===> 44.小车走行
			wrkCharge.setWrkSts(44L);
			Date now = new Date();
			wrkCharge.setCrnEndTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改复位任务状态 43.小车到达 ===> 44.小车走行失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			}
			} else if (wrkCharge.getWrkSts() == 45L) {
			if (null != wrkMastMapper.selectWorkingByCrn(wrkCharge.getCrnNo())) {
			return;
			}

			LocMast idleLoc = locMastService.selectById(basSte.getIdleLoc());

			Integer otherSte = existOtherSte(idleLoc.getLocNo(), wrkCharge.getSteNo());
			if (null != otherSte) {
			News.warn("{}号小车移入{}库位组失败，原因：存在{}号穿梭车！", wrkCharge.getSteNo(), idleLoc.getLocNo(), otherSte);
			} else {
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) { return; }
			// 只有当堆垛机空闲并且无任务时才继续执行
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(wrkCharge.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); // 源库位排
			crnCommand.setSourcePosY(steProtocol.getBay()); // 源库位列
			crnCommand.setSourcePosZ(steProtocol.getLev()); // 源库位层
			crnCommand.setDestinationPosX(Utils.getGroupRow(idleLoc.getLocNo(), true).shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(idleLoc.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(idleLoc.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(idleLoc.getLocNo(), true), idleLoc.getBay1(), idleLoc.getLev1());
			// 修改工作档状态 45.小车待搬 => 46.放至待机位
			Date now = new Date();
			wrkCharge.setWrkSts(46L);
			wrkCharge.setCrnStrTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改工作档状态 45.小车待搬 => 46.放至待机位失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			}

			}
			}
			}

			public List<String> crn2DemoLocs = new ArrayList<String>(); public String crn2LastLoc = "";
			public synchronized void demo() {
			if (Cools.isEmpty(crn2DemoLocs)) {
			crn2DemoLocs = locMastService.getDemoNextLoc(2);
			}
			for (CrnSlave crn : slaveProperties.getCrn()) {
			if (!crn.getDemo()) {
			continue;
			}
			// 必须为演示状态
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) {
			continue;
			}

			// 只有当堆垛机空闲并且无任务时才继续执行
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {

			// filter
			if (wrkChargeService.selectCount(new EntityWrapper<WrkCharge>()
			.eq("crn_no", crn.getId()).between("wrk_sts", 31, 36)) > 0) {
			continue;
			}

			SteThread steThread = queryIdleCar(crnProtocol);
			if (Cools.isEmpty(steThread)) {
			News.warn("没有空闲的小车进行演示功能");
			continue;
			}
			int steNo = steThread.getSlave().getId();
			SteProtocol steProtocol = steThread.getSteProtocol();
			BasSte basSte = basSteService.selectById(steNo);
			if (Cools.isEmpty(steProtocol, basSte)) { continue; }

			// 只有当穿梭车空闲并且无任务时才继续执行
			if (steProtocol.isIdle()) {

			String locNo = null;
			Iterator<String> iterator = crn2DemoLocs.iterator();
			while (iterator.hasNext()) {
			String next = iterator.next();
			if (!Cools.isEmpty(this.hasCar(next))) { continue; }
			String lastLoc = crn2LastLoc;
			if (!Cools.isEmpty(lastLoc)) {
			if (!lastLoc.substring(2, 7).equals(next.substring(2, 7))
			\|\| !Utils.getGroupRow(lastLoc, true).equals(Utils.getGroupRow(next, true))) {
			locNo = next;
			iterator.remove();
			break;
			} else {
			iterator.remove();
			}
			} else {
			locNo = next;
			iterator.remove();
			break;
			}

			}
			if (!Cools.isEmpty(locNo)) {
			crn2LastLoc = locNo;
			}

			News.info("{}号堆垛机对{}库位进行演示", crn.getId(), locNo);

			String sourceLocNo = Utils.getLocNo(steProtocol.getRow(), steProtocol.getBay(), steProtocol.getLev());

			WrkCharge wrkCharge = new WrkCharge();
			wrkCharge.setCrnNo(crn.getId());
			wrkCharge.setSteNo(steNo);
			wrkCharge.setWrkNo(commonService.getChargeWorkNo(5));
			wrkCharge.setWrkSts(31L); // 31.生成演示ID
			wrkCharge.setIoPri((double) 10);
			wrkCharge.setSourceLocNo(sourceLocNo);
			wrkCharge.setLocNo(locNo);
			wrkCharge.setMemo("demo");
			if (!wrkChargeService.insert(wrkCharge)) {
			News.error("生成演示任务失败，堆垛机号：{}，小车：{}，源库位：{}，目标库位：{}", crn.getId(), steNo, sourceLocNo, locNo);
			}
			}
			}
			}
			}

			/**
			* 演示取货
			*/
			private void steMoveDemo(CrnSlave slave, CrnProtocol crnProtocol) {
			// 获取工作档信息
			WrkCharge wrkCharge = wrkChargeService.selectOne(new EntityWrapper<WrkCharge>().eq("crn_no", slave.getId())
			.in("wrk_sts", 31, 33, 35));
			if (null == wrkCharge) {
			return;
			}
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (null == steProtocol) { return; }
			if (steProtocol.isIdle()) {
			// 31.生成演示ID
			if (wrkCharge.getWrkSts() == 31L) {
			this.letCarBeReady(wrkCharge, steProtocol.getSteNo().intValue());
			wrkCharge.setWrkSts(32L);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务{}工作档 31.生成演示ID ==>> 32.小车走行失败!", wrkCharge.getWrkNo());
			}
			// 33.小车待搬
			} else if (wrkCharge.getWrkSts() == 33L) {
			LocMast locMast = locMastService.selectById(wrkCharge.getLocNo());
			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); // 源库位排
			crnCommand.setSourcePosY(steProtocol.getBay()); // 源库位列
			crnCommand.setSourcePosZ(steProtocol.getLev()); // 源库位层
			crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo(), true).shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(locMast.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(locMast.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo(), true), locMast.getBay1(), locMast.getLev1());
			// 修改工作档状态 33.小车待搬 => 34.吊车搬运
			Date now = new Date();
			wrkCharge.setWrkSts(34L);
			wrkCharge.setCrnStrTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务{}工作档 33.小车待搬 => 34.吊车搬运失败!", wrkCharge.getWrkNo());
			}
			}
			// 35.小车就绪
			} else if (wrkCharge.getWrkSts() == 35L) {

			int steNo = steProtocol.getSteNo().intValue();
			if (!basSteService.updatePakMk(steNo, "Y")) {
			News.error("修改穿梭车作业状态失败！！，穿梭车={}", steNo);
			return;
			}

			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			SteTaskModeType originByLoc = SteTaskModeType.findOriginByLoc(steProtocol.getRow().intValue());
			if (originByLoc.equals(SteTaskModeType.GO_ORIGIN)) {
			originByLoc = SteTaskModeType.BACK_ORIGIN;
			} else if (originByLoc.equals(SteTaskModeType.BACK_ORIGIN)) {
			originByLoc = SteTaskModeType.GO_ORIGIN;
			} else {
			return;
			}
			steCommand.setTaskMode(originByLoc);

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态 35.小车就绪 => 36.小车走行
			wrkCharge.setWrkSts(36L);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务{}工作档 35.小车就绪 => 36.小车走行失败!", wrkCharge.getWrkNo());
			}
			}
			}
			}

			}
			/**
			* 出入库模式切换
			*/