zy-wcs.git - Gitblit

			@@ -3,33 +3,26 @@
			import com.alibaba.fastjson.JSON;
			import com.alibaba.fastjson.JSONObject;
			import com.baomidou.mybatisplus.mapper.EntityWrapper;
			import com.baomidou.mybatisplus.mapper.Wrapper;
			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;
			import com.zy.core.cache.SlaveConnection;
			import com.zy.core.enums.*;
			import com.zy.core.model.*;
			import com.zy.core.model.command.CrnCommand;
			import com.zy.core.model.command.LedCommand;
			import com.zy.core.model.command.ShuttleCommand;
			import com.zy.core.model.command.SteCommand;
			import com.zy.core.model.protocol.CrnProtocol;
			import com.zy.core.model.protocol.ShuttleProtocol;
			import com.zy.core.model.protocol.StaProtocol;
			import com.zy.core.model.protocol.SteProtocol;
			import com.zy.core.model.command.*;
			import com.zy.core.model.protocol.*;
			import com.zy.core.properties.SlaveProperties;
			import com.zy.core.thread.*;
			import lombok.extern.slf4j.Slf4j;
			@@ -58,6 +51,8 @@
			@Autowired
			private WrkMastMapper wrkMastMapper;
			@Autowired
			private WrkMastService wrkMastService;
			@Autowired
			private WrkDetlService wrkDetlService;
			@Autowired
			private LocMastService locMastService;
			@@ -66,13 +61,19 @@
			@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
			private BasLiftErrLogService basLiftErrLogService;
			@Autowired
			private BasShuttleErrService basShuttleErrService;
			@Autowired
			private BasCrnErrorMapper basCrnErrorMapper;
			@Autowired
			@@ -86,13 +87,22 @@
			@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;
			@Autowired
			private WrkMastLocMapper wrkMastLocMapper;


			/**
			* 组托
			@@ -152,11 +162,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());
			@@ -167,10 +178,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());
			@@ -181,10 +192,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());
			@@ -196,16 +207,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);
			@@ -213,7 +225,7 @@
			param.setBarcode(barcode);
			param.setIoType(1);
			param.setSourceStaNo(inSta.getStaNo());
			// param.setLocType1(locTypeDto.getLocType1());
			param.setLocType1(locTypeDto.getLocType1());
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/pakin/loc/v1")
			@@ -227,14 +239,26 @@
			StartupDto dto = jsonObject.getObject("data", StartupDto.class);
			// plc 处理
			barcodeThread.setBarcode("");
			staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			staProtocol.setStaNo(dto.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			// staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			// staProtocol.setStaNo(dto.getStaNo().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			//
			// boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// if (!result) {
			// throw new CoolException("更新plc站点信息失败");
			// }

			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			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");
			@@ -244,10 +268,10 @@
			}
			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());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// staProtocol.setWorkNo((short) 32002);
			// staProtocol.setRollback102(1);//102站回退信号
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(5, staProtocol));

			// led 异常显示
			if (ledThread != null) {
			@@ -366,6 +390,7 @@
			/**
			* 拣料、并板、盘点再入库
			*/
			@Transactional
			public synchronized void stnToCrnStnPick(){
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历拣料入库口
			@@ -381,25 +406,20 @@
			}
			if (staProtocol.isAutoing()
			&& staProtocol.isLoading()
			&& staProtocol.isInEnable()
			// 0 - 9990 或者 9996
			&& (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9990)
			&& staProtocol.getStaNo().equals(staProtocol.getSiteId().shortValue())
			// && (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) {
			@@ -439,6 +459,7 @@
			// News.error("{}条码错误，暂无拣料任务！", barcode);
			// }
			// }

			if ((wrkMast.getIoType() != 103 && wrkMast.getIoType() != 104 && wrkMast.getIoType() != 107)
			\|\| Cools.isEmpty(wrkMast.getStaNo()) \|\| Cools.isEmpty(wrkMast.getSourceStaNo()) ) {
			continue;
			@@ -487,14 +508,20 @@
			}

			String sourceLocNo = wrkMast.getSourceLocNo().trim();
			LiftStaProtocol liftStaProtocol = NyLiftUtils.getLiftStaByLev(pickSta.getLiftNo(), Utils.getLev(sourceLocNo));//获取回库提升机目标站
			if (liftStaProtocol == null) {
			continue;
			}

			// 更新工作档数据状态
			wrkMast.setIoType(wrkMast.getIoType() - 50); // 入出库类型: 103->53,104->54,107->57
			wrkMast.setWrkSts(2L); // 工作状态: 2.设备上走
			wrkMast.setSourceStaNo(pickSta.getStaNo()); // 源站
			wrkMast.setStaNo(dto.getStaNo()); // 目标站
			wrkMast.setCrnNo(dto.getCrnNo());
			wrkMast.setLocNo(dto.getLocNo()); // 目标库位 = 出库时的源库位
			wrkMast.setSourceLocNo(""); // 源库位清空
			// wrkMast.setStaNo(dto.getStaNo()); // 目标站
			// wrkMast.setCrnNo(dto.getCrnNo());
			wrkMast.setStaNo(liftStaProtocol.getStaNo());//目标站
			wrkMast.setLocNo(sourceLocNo); // 目标库位 = 出库时的源库位
			wrkMast.setShuttleNo(null); // 穿梭车清空
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
			@@ -503,14 +530,24 @@
			throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
			}

			// 更新站点信息且下发plc命令
			staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			News.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
			// 修改库位状态 Q.拣料/盘点/并板再入库
			LocMast locMast = locMastService.selectById(sourceLocNo);
			locMast.setLocSts("Q");
			locMast.setModiTime(new Date());
			if (!locMastService.updateById(locMast)) {
			throw new CoolException("修改库位状态失败");
			}

			// // 更新站点信息且下发plc命令
			// staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
			// staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// if (!result) {
			// News.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
			// }

			barcodeThread.setBarcode("");//清理条码

			} else if (code == 500){
			if (ledThread != null) {
			@@ -521,10 +558,10 @@
			}
			News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			} else {
			staProtocol.setWorkNo((short) 32002);
			staProtocol.setStaNo(pickSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// staProtocol.setWorkNo((short) 32002);
			// staProtocol.setStaNo(pickSta.getBackSta().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));

			// led 异常显示
			if (ledThread != null) {
			@@ -546,1647 +583,1071 @@
			}

			/**
			* 堆垛机站出库到出库站
			* 初始化实时地图
			*/
			public void crnStnToOutStn() {
			for (CrnSlave crnSlave : slaveProperties.getCrn()) {
			// 遍历堆垛机出库站
			for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
			// 获取堆垛机出库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			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("地图数据存储失败");
			}
			}
			if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 \|\| staProtocol.getStaNo() == null)) {
			// 查询工作档
			WrkMast wrkMast = wrkMastMapper.selectPakOutStep16(staProtocol.getSiteId());
			if (wrkMast == null) {
			continue;
			}
			// 判断工作档条件
			if (wrkMast.getIoType() < 100 \|\| wrkMast.getStaNo() == null \|\| wrkMast.getSourceStaNo() == null) {
			continue;
			}
			// 判断吊车是否实际已完成，且电脑状态在move中，以备电脑进行更新工作档
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkMast.getCrnNo());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol.statusType == CrnStatusType.FETCHING \|\| crnProtocol.statusType == CrnStatusType.PUTTING) {
			// 移动中
			continue;
			}
			// 判断堆垛机状态等待确认
			if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast.getWrkNo().shortValue())
			&& crnProtocol.statusType == CrnStatusType.WAITING
			&& crnProtocol.forkPosType == CrnForkPosType.HOME) {

			// 命令下发区 --------------------------------------------------------------------------

			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
			continue;
			}

			// 更新工作档状态为 17.出库完成
			wrkMast.setWrkSts(17L);
			wrkMast.setCrnEndTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) != 0) {
			// 复位堆垛机
			crnThread.setResetFlag(true);
			} else {
			News.error("更新工作档的工作状态为 17.出库完成失败！！！ [工作号:{}]", wrkMast.getWrkNo());
			}

			}

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

			/**
			* 入出库 ===>> 四向穿梭车入出库作业下发
			* 从redis中重启任务
			*/
			public synchronized void shuttleIoExecute() {
			public synchronized void restartTaskFromRedis() {
			HashMap<Object, Object> map = redisUtil.getRedis();
			for (Object key : map.keySet()) {
			if (key.toString().contains("lift_wrk_no_")) {//提升机任务
			LiftRedisCommand redisCommand = JSON.parseObject(map.get(key).toString(), LiftRedisCommand.class);
			if (redisCommand == null) {
			continue;
			}

			Short liftNo = redisCommand.getLiftNo();
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftNo.intValue());
			if (liftThread == null) {
			continue;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}
			if (!liftProtocol.isIdle()) {
			continue;
			}

			//提升机处于空闲状态，进行任务的恢复
			liftProtocol.setTaskNo(redisCommand.getWrkNo());//将提升机线程分配任务号
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//工作状态

			}else if(key.toString().contains("shuttle_wrk_no_")){//四向穿梭车任务
			ShuttleRedisCommand redisCommand = JSON.parseObject(map.get(key).toString(), ShuttleRedisCommand.class);
			if (redisCommand == null) {
			continue;
			}

			Short shuttleNo = redisCommand.getShuttleNo();
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo.intValue());
			if (shuttleThread == null) {
			continue;
			}
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}
			if (!shuttleProtocol.isIdle()) {
			continue;
			}

			//四向穿梭车处于空闲状态，进行任务的恢复
			shuttleProtocol.setTaskNo(redisCommand.getWrkNo().intValue());//将四向穿梭车线程分配任务号
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WORKING);//工作状态
			}
			}

			}

			/**
			* 入库 ===>> 四向穿梭车入库作业下发
			*/
			public synchronized void shuttleInExecute() {
			List<WrkMast> wrkMasts = wrkMastMapper.selectInStep4();
			for (WrkMast wrkMast : wrkMasts) {
			//获取源站
			BasDevp sourceBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
			if (sourceBasDevp == null) {
			continue;//站点不存在
			}

			//获取目标站
			LiftStaProtocol liftStaProtocol = NyLiftUtils.getLiftStaByLev(sourceBasDevp.getLiftNo(), Utils.getLev(wrkMast.getLocNo()));
			if (liftStaProtocol == null) {
			continue;//站点不存在
			}

			// 判断是否满足入库条件，自动、空闲、有物
			if (!(liftStaProtocol.getModel() && !liftStaProtocol.getBusy() && liftStaProtocol.getHasTray())) {
			continue;
			}

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

			// /**
			// * 入库 ===>> 四向穿梭车入库作业下发
			// */
			// public synchronized void shuttleInExecute() {
			// // 根据输送线plc遍历
			// for (DevpSlave devp : slaveProperties.getDevp()) {
			// // 遍历入库站
			// for (DevpSlave.StaRack staRack : devp.getRackInStn()) {
			// // 获取入库站信息
			// DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			// 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 (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isShuttleTakeEnable())) {
			// continue;
			// }
			//
			// WrkMast wrkMast = wrkMastMapper.selectRackInStep4(workNo, staProtocol.getSiteId());
			// if (wrkMast == null) {
			// continue;
			// }
			//
			// boolean step1 = this.shuttleInExecuteStep1(wrkMast, basDevp);//小车搬入库中
			// if (!step1) {
			// continue;
			// }
			//
			// }
			// }
			//
			// }

			/**
			* 入库-小车搬入库中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public boolean shuttleInExecuteStep1(WrkMast wrkMast, LiftStaProtocol liftStaProtocol) {
			if (wrkMast.getWrkSts() == 4) {
			if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), liftStaProtocol.getLocNo());//调度小车到货物所在输送站点进行取货
			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.isIdle()) {
			return false;
			}
			//判断小车令牌是否未被占领
			if (shuttleProtocol.getToken() != 0) {
			return false;//小车已被独占，禁止再派发任务
			}

			//判断小车是否存在移动任务
			WrkMast hasMoveWorking = wrkMastMapper.selectShuttleHasMoveWorking(wrkMast.getShuttleNo());
			if (hasMoveWorking != null) {
			return false;//存在移动任务，禁止执行入库任务
			}

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

			//小车已抵达输送站点位置，进行搬运货物
			NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), 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());
			shuttleProtocol.setToken(wrkMast.getWrkNo());//独占小车令牌
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}
			return true;
			}

			/**
			* 出库 ===>> 四向穿梭车出库作业下发
			*/
			public synchronized void shuttleOutExecute() {
			for (WrkMast wrkMast : wrkMastMapper.selectBy2125()) {
			boolean step1 = this.shuttleOutExecuteStep1(wrkMast);//小车搬出库中
			if (!step1) {
			continue;
			}
			}
			}

			/**
			* 出库-小车搬出库中
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public boolean shuttleOutExecuteStep1(WrkMast wrkMast) {
			//21.生成出库任务 => 22.小车搬运中
			if (wrkMast.getWrkSts() == 21) {
			EntityWrapper<StaDesc> wrapper = new EntityWrapper<>();
			wrapper.eq("type_no", wrkMast.getIoType());//路径类型
			wrapper.eq("stn_no", wrkMast.getStaNo());//出库站点编号
			StaDesc staDesc = staDescService.selectOne(wrapper);
			if (staDesc == null) {
			return false;//出库路径不存在
			}

			//获取出库站点
			BasDevp basDevp = basDevpService.selectById(wrkMast.getStaNo());
			if (basDevp == null) {
			return false;//出库站点不存在
			}

			if (!basDevp.getOutEnable().equals("Y")) {
			return false;//出库站点不可出
			}

			//获取源站
			LiftStaProtocol liftStaProtocol = NyLiftUtils.getLiftStaByLev(basDevp.getLiftNo(), Utils.getLev(wrkMast.getSourceLocNo()));
			if (liftStaProtocol == null) {
			return false;//找不到站点
			}

			if (!(liftStaProtocol.getModel() && !liftStaProtocol.getBusy() && !liftStaProtocol.getHasTray())) {
			return false;//站点必须自动、空闲、没有托盘
			}

			if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到货物所在库位进行取货
			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.isIdle()) {
			return false;
			}
			//判断小车令牌是否未被占领
			if (shuttleProtocol.getToken() != 0) {
			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(), wrkMast.getSourceLocNo(), liftStaProtocol.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());
			shuttleProtocol.setToken(wrkMast.getWrkNo());//独占小车令牌
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			return false;
			}
			return true;
			}

			/**
			* 四向穿梭车任务完成
			*/
			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.getBusyStatusType() == ShuttleStatusType.IDLE && shuttleProtocol.getTaskNo() == 0) {
			//入出库逻辑
			for (WrkMast wrkSts : wrkMastMapper.selectList(new EntityWrapper<WrkMast>().eq("wrk_sts", 2))) {
			//分配任务号
			shuttleProtocol.setTaskNo(wrkSts.getWrkNo().shortValue());
			//分配源库位
			shuttleProtocol.setSourceLocNo(wrkSts.getSourceLocNo());
			//分配目标库位
			shuttleProtocol.setLocNo(wrkSts.getLocNo());
			//四向穿梭车状态为等待确认、小车处于空闲状态

			//计算路径
			List<NavigateNode> calc = NavigateUtils.calc(wrkSts.getSourceLocNo(), wrkSts.getLocNo(), "in");
			//获取分段路径
			ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc);
			//将此map存入redis中
			HashMap<String, Object> map = new HashMap<>();
			//执行步序
			map.put("step", 0);
			//路径数据
			map.put("path", data);
			//工作号
			map.put("wrk_no", wrkSts.getWrkNo());
			//任务数据保存到redis
			redisUtil.set("wrk_no_" + wrkSts.getWrkNo().shortValue(), JSON.toJSONString(map));
			}

			} else if (shuttleProtocol.getBusyStatusType() == ShuttleStatusType.IDLE && shuttleProtocol.getTaskNo() != 0) {
			//四向穿梭车空闲并且有任务
			Object o = redisUtil.get("wrk_no_" + shuttleProtocol.getTaskNo());
			HashMap map = JSON.parseObject(o.toString(), HashMap.class);
			//当前步序
			int step = Integer.parseInt(map.get("step").toString());
			//当前路径数据
			Object data = map.get("path");
			ArrayList pathList = JSON.parseObject(data.toString(), ArrayList.class);
			//取第一条路径
			Object o1 = pathList.get(step);
			ArrayList path = JSON.parseObject(o1.toString(), ArrayList.class);

			int size = path.size();
			//开始路径
			JSONObject startPath = JSON.parseObject(path.get(0).toString());
			System.out.println(startPath);
			//目标路径
			JSONObject endPath = JSON.parseObject(path.get(size - 1).toString());
			System.out.println(endPath);

			//下发命令
			ShuttleCommand command = new ShuttleCommand();
			command.setCommandWord((short) 1);
			command.setStartCodeNum(NavigatePositionConvert.xyToPosition(startPath.getIntValue("x"), startPath.getIntValue("y")));
			command.setMiddleCodeNum((short) 0);
			command.setDistCodeNum(NavigatePositionConvert.xyToPosition(endPath.getIntValue("x"), endPath.getIntValue("y")));
			command.setStartToDistDistance(1000);
			command.setMiddleToDistDistance(1000);
			command.setRunDirection(ShuttleRunDirection.get(startPath.get("direction").toString()).id);
			command.setPalletLift((short) 1);
			command.setForceMoveDistance(1000);
			command.setChargeSwitch((short) 2);
			command.setIOControl((short) 0);
			command.setRunSpeed((short) 1000);
			command.setRadarTmp((short) 0);
			command.setCommandEnd((short) 1);

			if (!MessageQueue.offer(SlaveType.Shuttle, shuttleProtocol.getShuttleNo().intValue(), new Task(2, command))) {
			News.error("四向穿梭车命令下发失败，穿梭车号={}，任务数据={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command));
			} else {
			News.info("四向穿梭车命令下发成功，穿梭车号={}，任务数据={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command));

			//判断数据是否执行完成
			if (step < size) {
			//更新redis数据
			//步序增加
			step++;
			map.put("step", step);
			//任务数据保存到redis
			redisUtil.set("wrk_no_" + map.get("wrk_no").toString(), JSON.toJSONString(map));
			}else {
			//已执行完成
			//保存数据到数据库做流水
			//删除redis
			redisUtil.del("wrk_no_" + map.get("wrk_no").toString());

			//。。。
			//1、命令下方需要判断小车空闲状态
			//2、
			}

			}
			}
			}

			}

			/**
			* 入出库 ===>> 堆垛机入出库作业下发
			*/
			public synchronized void crnIoExecute(){
			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) { continue; }
			BasCrnp basCrnp = basCrnpService.selectById(crn.getId());
			if (basCrnp == null) {
			News.error("{}号堆垛机尚未在数据库进行维护！", crn.getId());
			continue;
			}
			// 只有当堆垛机空闲并且无任务时才继续执行
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
			// 如果最近一次是入库模式
			if (crnProtocol.getLastIo().equals("I")) {
			if (basCrnp.getInEnable().equals("Y")) {
			// 入库
			if (this.crnStnToLoc(crn, crnProtocol)) {
			}
			crnProtocol.setLastIo("O");
			} else if (basCrnp.getOutEnable().equals("Y")) {
			// 出库
			if (this.locToCrnStn(crn, crnProtocol)) {
			}
			crnProtocol.setLastIo("I");
			}
			}
			// 如果最近一次是出库模式
			else if (crnProtocol.getLastIo().equals("O")) {
			if (basCrnp.getOutEnable().equals("Y")) {
			// 出库
			if (this.locToCrnStn(crn, crnProtocol)) {
			}
			crnProtocol.setLastIo("I");
			} else if (basCrnp.getInEnable().equals("Y")) {
			// 入库
			if (this.crnStnToLoc(crn, crnProtocol)) {
			}
			crnProtocol.setLastIo("O");
			}
			}
			// 库位移转
			// this.locToLoc(crn, crnProtocol);
			// 演示
			// this.steMoveDemo(crn, crnProtocol);
			}
			}
			}

			/**
			* 入库 ===>> 堆垛机站到库位
			*/
			public boolean crnStnToLoc(CrnSlave slave, CrnProtocol crnProtocol){
			for (CrnSlave.CrnStn crnStn : slave.getCrnInStn()) {
			boolean flag = false;
			// 获取堆垛机入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			News.error("入库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			continue;
			}
			// 获取工作状态为 2,3,4,5,6 的入库工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep23456(slave.getId(), staProtocol.getWorkNo().intValue(), crnStn.getStaNo());
			if(null == wrkMast) {
			// News.error("{}站点查询无待入库数据工作号={}", crnStn.getStaNo(), staProtocol.getWorkNo());
			continue;
			}

			// 同库位组进行校验
			List<String> groupLocNo = Utils.getGroupLocNo(wrkMast.getLocNo());
			if (!Cools.isEmpty(groupLocNo)) {
			if (null != wrkMastMapper.selectPakoutWorkingByGroupLoc(groupLocNo)) {
			continue;
			}
			}

			if (wrkMast.getWrkSts() < 3) {
			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
			&& staDetl.getCanining()!=null && staDetl.getCanining().equals("Y")) {
			flag = true;
			}
			if (!flag) {
			continue;
			}
			}
			// 获取库位信息
			LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
			if (locMast == null) {
			News.error("查询库存无数据--库位号{}", wrkMast.getLocNo());
			continue;
			}
			if (!locMast.getLocSts().equals("S") && !locMast.getLocSts().equals("Q")) {
			News.error("入库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), locMast.getLocSts());
			continue;
			}

			List<LocMast> locMasts = null;
			boolean sign=false;
			if (locMast.getRow1()>=5){
			locMasts=locMastService.selectList(new EntityWrapper<LocMast>().ge("row1", 5)
			.eq("bay1",locMast.getBay1()).eq("lev1",locMast.getLev1()));
			for (LocMast locMast1:locMasts){
			if (locMast1.getRow1()>locMast.getRow1()){
			if (!locMast1.getLocSts().equals("F") && !locMast1.getLocSts().equals("D")){
			if (!locMast1.getLocSts().equals("X")){
			sign=true;
			break;
			if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id //任务完成等待确认
			&& shuttleProtocol.getTaskNo() != 0
			&& shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id
			) {
			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 5://5.小车搬运中 ==> 9.入库完成
			wrkMast.setWrkSts(9L);
			shuttleProtocol.setTaskNo(0);
			if (shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放小车令牌
			shuttleProtocol.setToken(0);
			}
			}
			}else if (locMast1.getRow1()<locMast.getRow1()){
			if (locMast1.getLocSts().equals("F") \|\| locMast1.getLocSts().equals("D")){
			News.error("当前工作档目标库位所在排前边存在货物！", wrkMast.getWrkNo());
			sign=true;
			break;
			}
			}
			}
			}else {
			locMasts=locMastService.selectList(new EntityWrapper<LocMast>().le("row1", 4)
			.eq("bay1",locMast.getBay1()).eq("lev1",locMast.getLev1()));
			for (LocMast locMast1:locMasts){
			if (locMast1.getRow1()>locMast.getRow1()){
			if (locMast1.getLocSts().equals("F") \|\| locMast1.getLocSts().equals("D")){
			News.error("当前工作档目标库位所在排前边存在货物！", wrkMast.getWrkNo());
			sign=true;
			case 22://22.小车搬运中 ==> 23.小车搬运完成
			wrkMast.setWrkSts(23L);
			shuttleProtocol.setTaskNo(0);
			if (shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放小车令牌
			shuttleProtocol.setToken(0);
			}
			break;
			}
			}else if (locMast1.getRow1()<locMast.getRow1()){
			if (!locMast1.getLocSts().equals("F") && !locMast1.getLocSts().equals("D")){
			if (!locMast1.getLocSts().equals("X")){
			sign=true;
			break;
			}
			}
			}
			}
			}
			if (sign){
			continue;
			}

			// 检测是否存在出库任务
			if (null != wrkMastMapper.selectPakout(slave.getId(), null)) {
			News.error("{}入库任务无法作业，因存在出库中任务!", wrkMast.getWrkNo());
			continue;
			}

			// 置顶任务
			if (wrkMast.getIoPri()<8000){
			wrkMast.setIoPri(wrkMast.getIoPri()+9000d);
			}
			wrkMastMapper.updateById(wrkMast);

			// 目标库位 ===>> 最外层库位
			if (locMastService.isOutMost(wrkMast.getLocNo(), true)) {
			// 判断小车是否在最外层库位，如果是则搬走，如果不是，则直接堆垛机入库
			Integer steNo = this.hasCar(wrkMast.getLocNo());
			// 有小车
			if (steNo != null) {
			// 小车行走到堆垛机待搬移点
			if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
			// 没有其他任务
			if (null == wrkMastMapper.selectPakin(slave.getId(), steNo)) {
			this.letCarBeReady(wrkMast, steNo, wrkMast.getLocNo());
			return true;
			}
			}
			// 小车搬走
			if (wrkMast.getWrkSts() == 3L) {
			this.carMoveOut(wrkMast, steNo, crnProtocol);
			return true;
			}
			// 没有小车
			} else {

			// 当前入库库位组没有小车堆垛机则去站点取货入库
			// case 1：从始至终库位组都没有小车，没有迁出小车动作，所以工作状态 = 2
			// case 2：堆垛机已经搬出小车，有迁出小车动作，所以工作状态 = 6
			if ((wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) \|\| wrkMast.getWrkSts() == 6L) {

			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			continue;
			}

			// 堆垛机入库命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(crnStn.getRow().shortValue()); // 源库位排
			crnCommand.setSourcePosY(crnStn.getBay().shortValue()); // 源库位列
			crnCommand.setSourcePosZ(crnStn.getLev().shortValue()); // 源库位层
			crnCommand.setDestinationPosX(locMast.getRow1().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(locMast.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(locMast.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 7.吊车入库中
			Date now = new Date();
			wrkMast.setWrkSts(7L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 {} => 7.吊车入库中失败！！，工作号={}", wrkMast.getWrkSts$(), wrkMast.getWrkNo());
			} else {
			return true;
			}
			}
			}

			}

			// 目标库位 ===>> 非最外层库位
			} else {
			// 判断小车是否在当前组库位，如果是则将穿梭车移至最外层，等待堆垛机放货；如果不是，则堆垛机寻找穿梭车，并放置当前组最外层
			Integer steNo = this.hasCarOfIdle(wrkMast.getLocNo());
			// 有小车
			if (steNo != null) {
			// 小车行走到待机位
			if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
			// 没有其他任务
			if (null == wrkMastMapper.selectPakin(slave.getId(), steNo)) {
			this.letCarBeWaiting(wrkMast, steNo, wrkMast.getLocNo());
			} else {
			return true;
			}
			}
			// 堆垛机将货放至小车上 3.小车待搬（小车不用搬运，已经在当前组库位） / 6.小车待入 ===>> 7.吊车入库中
			if (wrkMast.getWrkSts() == 3L \|\| wrkMast.getWrkSts() == 6L) {
			// 小车处于空闲
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.isIdle()) {

			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			continue;
			}
			// 堆垛机入库命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(crnStn.getRow().shortValue()); // 源库位排
			crnCommand.setSourcePosY(crnStn.getBay().shortValue()); // 源库位列
			crnCommand.setSourcePosZ(crnStn.getLev().shortValue()); // 源库位层
			crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo(), true).shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(locMast.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(locMast.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 3.小车待搬 ===>> 7.吊车入库中
			Date now = new Date();
			wrkMast.setWrkSts(7L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 3.小车待搬/6.小车待入 => 7.吊车入库中失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			return true;
			}
			}
			}
			}
			// 没有小车
			} else {
			if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
			// 寻找当前堆垛机对应的小车
			SteThread steThread = queryIdleCar(wrkMast);
			if (steThread != null) {
			// 没有其他任务
			if (null == wrkMastMapper.selectPakin(slave.getId(), steNo)) {
			// 让小车等待搬运待续
			this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getLocNo());
			return true;
			}
			}
			}
			// 堆垛机搬运小车
			if (wrkMast.getWrkSts() == 3L) {
			this.carMoveIn(wrkMast, wrkMast.getSteNo(), crnProtocol);
			return true;
			}
			}
			}
			}
			return false;
			}

			/**
			* 出库 ===>> 库位到堆垛机站
			*/
			public synchronized boolean locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol){
			for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
			// 获取工作状态为11（生成出库ID）的出库工作档
			WrkMast wrkMast = wrkMastMapper.selectPakOutStep111215(slave.getId(), crnStn.getStaNo());
			if (wrkMast == null) {
			continue;
			}
			// 工作档状态判断
			if (wrkMast.getIoType() < 100 \|\| wrkMast.getSourceStaNo() == null){
			News.error("查询工作档数据不符合条件--入出类型/站点, 工作号={}，源库位={}，入出类型={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getIoType());
			continue;
			}
			// 获取源库位信息
			LocMast sourceSta = locMastService.selectById(wrkMast.getSourceLocNo());
			if (!sourceSta.getLocSts().equals("R") &&!sourceSta.getLocSts().equals("P")) {
			News.error("出库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), sourceSta.getLocSts());
			continue;
			}
			List<LocMast> locMasts = null;
			boolean sign=false;
			if (sourceSta.getRow1()>=5){
			locMasts=locMastService.selectList(new EntityWrapper<LocMast>().ge("row1", 5)
			.eq("bay1",sourceSta.getBay1()).eq("lev1",sourceSta.getLev1()));
			for (LocMast locMast1:locMasts){
			if (locMast1.getRow1()<sourceSta.getRow1()){
			if (!locMast1.getLocSts().equals("O")){
			News.error("当前工作档源库位所在排前边存在货物！", wrkMast.getWrkNo());
			sign=true;
			case 102://102.小车移动至站点 ==> 103.小车移动至站点完成
			wrkMast.setWrkSts(103L);
			break;
			}
			}
			}
			}else {
			locMasts=locMastService.selectList(new EntityWrapper<LocMast>().le("row1", 4)
			.eq("bay1",sourceSta.getBay1()).eq("lev1",sourceSta.getLev1()));
			for (LocMast locMast1:locMasts){
			if (locMast1.getRow1()>sourceSta.getRow1()){
			if (!locMast1.getLocSts().equals("O")){
			News.error("当前工作档目标库位所在排前边存在货物！", wrkMast.getWrkNo());
			sign=true;
			case 104://104.小车迁入提升机中 ==> 105.小车迁入提升机完成
			wrkMast.setWrkSts(105L);
			shuttleProtocol.setTaskNo(0);//清理工作号
			break;
			case 108://108.小车迁出提升机中 ==> 109.小车迁出提升机完成
			wrkMast.setWrkSts(109L);
			break;
			case 110://110.小车移动中 ==> 111.小车移动完成
			wrkMast.setWrkSts(111L);
			shuttleProtocol.setTaskNo(0);
			if (shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放小车令牌
			shuttleProtocol.setToken(0);
			}
			break;
			default:
			}

			if (wrkMastMapper.updateById(wrkMast) > 0) {
			if (wrkMast.getWrkSts() == 111) {
			// 保存工作主档历史档
			if (wrkMastLocMapper.save(wrkMast.getWrkNo()) <= 0) {
			log.info("保存工作历史档[workNo={0}]失败", wrkMast.getWrkNo());
			}
			// 删除工作主档
			if (!wrkMastService.deleteById(wrkMast)) {
			log.info("删除工作主档[workNo={0}]失败", wrkMast.getWrkNo());
			}
			}
			}
			}
			}
			if (sign){
			continue;
			}

			// 同库位组进行校验
			List<String> groupLocNo = Utils.getGroupLocNo(wrkMast.getSourceLocNo());
			if (!Cools.isEmpty(groupLocNo)) {
			if (null != wrkMastMapper.selectPakinWorkingByGroupLoc(groupLocNo)) {
			continue;
			}
			}

			// 判断是否有同库位组的出库任务，如果有，则暂停
			List<String> outsideLoc = Utils.getGroupOutsideLoc(wrkMast.getSourceLocNo());
			if (!Cools.isEmpty(outsideLoc)) {
			if (!Cools.isEmpty(wrkMastMapper.selectWorkingOfPakOutBySource(outsideLoc))) {
			// News.warn("{}工作档出库失败，原因：外层库位{}正在执行出库任务！", wrkMast.getWrkNo(), JSON.toJSONString(outsideLoc));
			continue;
			}
			}

			// 获取堆垛机出库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			News.error("出库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			continue;
			}
			// 判断堆垛机出库站状态
			if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() !=null && staDetl.getCanouting().equals("Y")
			&& staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {
			// 命令下发区 --------------------------------------------------------------------------

			// 堆垛机控制过滤
			if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			continue;
			}

			// 过滤
			if (null != wrkMastMapper.selectPakin(slave.getId(), null)) {
			News.error("{}出库任务无法作业，因存在入库中任务!", wrkMast.getWrkNo());
			continue;
			}

			// 置顶任务
			if (wrkMast.getIoPri()<8000){
			wrkMast.setIoPri(wrkMast.getIoPri()+8999d);
			}
			wrkMastMapper.updateById(wrkMast);

			// 最外层库位，直接堆垛机出库
			if (locMastService.isOutMost(wrkMast.getSourceLocNo(), false)) {
			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			continue;
			}

			// 堆垛机出库命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(sourceSta.getRow1().shortValue()); // 源库位排
			crnCommand.setSourcePosY(sourceSta.getBay1().shortValue()); // 源库位列
			crnCommand.setSourcePosZ(sourceSta.getLev1().shortValue()); // 源库位层
			crnCommand.setDestinationPosX(crnStn.getRow().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(crnStn.getBay().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(crnStn.getLev().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			//设置四向穿梭车为空闲状态
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
			//源库位清零
			shuttleProtocol.setSourceLocNo(null);
			//目标库位清零
			shuttleProtocol.setLocNo(null);
			//任务指令清零
			shuttleProtocol.setAssignCommand(null);
			News.info("四向穿梭车已确认且任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
			} else {
			// 修改工作档状态 11.生成出库ID => 16.吊车出库中
			Date now = new Date();
			wrkMast.setWrkSts(16L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 11.生成出库ID => 16.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			return true;
			}
			News.error("四向穿梭车已确认且任务完成状态,复位失败，但未找到工作档。四向穿梭车号={}，工作号={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
			}
			// 不是最外层库位，需要使用穿梭车搬运后，再堆垛机出库
			} else {
			// 当前组库位是否有穿梭车
			Integer steNo = this.hasCarOfIdle(wrkMast.getSourceLocNo());
			// 有小车
			if (steNo != null) {
			if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
			}else {
			ShuttleAssignCommand assignCommand = shuttleProtocol.getAssignCommand();
			if (!assignCommand.getAuto()) {
			//手动模式
			//工作号清零
			shuttleProtocol.setTaskNo(0);
			//设置四向穿梭车为空闲状态
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
			//源库位清零
			shuttleProtocol.setSourceLocNo(null);
			//目标库位清零
			shuttleProtocol.setLocNo(null);
			//任务指令清零
			shuttleProtocol.setAssignCommand(null);
			//清零令牌
			shuttleProtocol.setToken(0);
			News.info("四向穿梭车已确认且任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
			}
			}

			// 给穿梭车下发命令让其将货物挪至堆垛机搬运点
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.isIdle()) {
			}

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

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());
			steCommand.setBay(steProtocol.getBay());
			steCommand.setLev(steProtocol.getLev());
			/**
			* 提升机任务
			*/
			public synchronized void liftIoExecute() {
			for (LiftSlave liftSlave : slaveProperties.getLift()) {
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
			if (liftThread == null) {
			continue;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}

			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 14.小车搬出库
			Date now = new Date();
			wrkMast.setWrkSts(14L);
			wrkMast.setSteNo(steNo);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			LocMast locMast = locMastService.selectById(wrkMast.getSourceLocNo());
			Integer outCrnNo = locMastService.getOutCrnNo(locMast);
			wrkMast.setCrnNo(outCrnNo);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 11.生成出库ID => 14.小车搬出库失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			return true;
			}
			}
			if (!liftProtocol.isIdle()) {
			continue;
			}

			//判断提升机令牌是否被占用
			if (liftProtocol.getToken() != 0) {
			continue;
			}

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

			for (WrkMast wrkMast : wrkMasts) {
			//搜索是否有其他任务占用了提升机，如果占用提升机的任务和当前任务相同，则运行执行
			WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
			if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) {
			continue;
			}

			boolean stepIn = this.liftIoExecuteStepIn(wrkMast);//提升机入库
			if (!stepIn) {
			continue;
			}

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

			}
			}

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

			//2.设备上走 ==> 3.提升机搬运中
			if (wrkMast.getWrkSts() == 2) {
			//获取源站
			BasDevp sourceBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
			if (sourceBasDevp == null) {
			return false;//找不到站点
			}

			if (!sourceBasDevp.getInEnable().equals("Y")) {
			return false;//站点不可入
			}

			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, sourceBasDevp.getLiftNo());
			if (liftThread == null) {
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return false;
			}
			if (!liftProtocol.isIdle()) {
			return false;
			}
			//判断提升机令牌是否未被占领
			if (liftProtocol.getToken() != 0) {
			return false;//提升机已被独占，禁止再派发任务
			}

			//判断提升机内是否有小车
			if (liftProtocol.getHasCar()) {
			return false;//有小车，禁止派发
			}

			//判断提升机内是否有托盘
			if (liftProtocol.getHasTray()) {
			return false;//有托盘，禁止派发
			}

			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}

			//获取源站对应的牛眼提升机站点编号(起点编号)
			Integer startSta = Integer.parseInt(sourceBasDevp.getQrCodeValue());
			//获取提升机站点
			LiftStaProtocol targetStaProtocol = NyLiftUtils.getLiftStaByLev(liftThread.getSlave().getId(), Utils.getLev(wrkMast.getLocNo()));
			if (targetStaProtocol == null) {
			return false;//站点不存在
			}

			if (targetStaProtocol.getHasTray()) {
			return false;//提升机站点有托盘，禁止派发
			}

			Integer targetSta = targetStaProtocol.getStaNo();

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, startSta, targetSta, wrkMast.getWrkNo());
			if (wrkMast.getIoType() == 53) {
			//拣料再回库，重新分配设备工作号
			Random random = new Random();
			int deviceWrk = Math.abs((liftCommand.getTaskNo().intValue() + random.nextInt(9999)));//获取设备工作号
			liftCommand.setTaskNo((short) deviceWrk);
			}
			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(3L);//2.设备上走 ==> 3.提升机搬运中
			wrkMast.setLiftNo(liftThread.getSlave().getId());//任务档绑定提升机号
			wrkMast.setModiTime(now);
			liftProtocol.setToken(wrkMast.getWrkNo());//独占提升机令牌
			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) {
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			return false;
			}

			//获取出库站点(目标站)
			BasDevp basDevp = basDevpService.selectById(wrkMast.getStaNo());
			if (basDevp == null) {
			return false;//出库站点不存在
			}

			//获取源站对应的牛眼提升机站点编号(起点编号)
			LiftStaProtocol liftStaProtocol = NyLiftUtils.getLiftStaByLev(basDevp.getLiftNo(), Utils.getLev(wrkMast.getSourceLocNo()));
			if (liftStaProtocol == null) {
			return false;//找不到站点
			}
			Integer startSta = liftStaProtocol.getStaNo();

			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol.getCurrentLocNo().equals(liftStaProtocol.getLocNo())) {
			//小车还在输送站点
			//调度小车避让
			boolean result = Utils.searchEmptyGroupToMoveShuttle(Utils.getLev(wrkMast.getSourceLocNo()), wrkMast.getShuttleNo(), shuttleThread);
			if (!result) {
			return false;
			}
			}

			if (!basDevp.getOutEnable().equals("Y")) {
			return false;//出库站点不可出
			}

			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, basDevp.getLiftNo());
			if (liftThread == null) {
			return false;
			}
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			return false;
			}

			if (!liftProtocol.isIdle()) {
			return false;
			}
			//判断提升机令牌是否未被占领
			if (liftProtocol.getToken() != 0) {
			return false;//提升机已被独占，禁止再派发任务
			}
			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}

			//获目标站源站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getStaNo());
			if (targetBasDevp == null) {
			return false;//站点不存在
			}
			//获取牛眼提升机站点编号(目标编号)
			Integer targetSta = Integer.parseInt(targetBasDevp.getQrCodeValue());

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftThread.getSlave().getId(), NyLiftTaskModelType.MOVE_TRAY.id, startSta, targetSta, 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);
			liftProtocol.setToken(wrkMast.getWrkNo());//独占提升机令牌
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}
			return true;
			}

			/**
			* 提升机任务完成
			*/
			public synchronized void liftFinished() {
			for (LiftSlave liftSlave : slaveProperties.getLift()) {
			//获取提升机信息
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}

			//提升机为等待确认且空闲
			if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id
			&& liftProtocol.getTaskNo() != 0
			&& !liftProtocol.getBusy()
			) {
			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo324104(liftProtocol.getTaskNo().intValue());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 3://3.提升机搬运中 ==> 4.提升机搬运完成
			wrkMast.setWrkSts(4L);
			wrkMast.setLiftNo(null);//释放提升机
			if (liftProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放提升机令牌
			liftProtocol.setToken(0);
			}
			}
			if (wrkMast.getWrkSts() == 15L) {
			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			continue;
			break;
			case 24://24.提升机搬运中 ==> 25.提升机搬运完成
			wrkMast.setWrkSts(25L);
			if (wrkMast.getIoType() == 11) {//库位移转
			wrkMast.setWrkSts(4L);//4.提升机搬运完成
			}
			if (liftProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放提升机令牌
			liftProtocol.setToken(0);
			}

			// 堆垛机出库命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(Utils.getGroupRow(sourceSta.getRow1(), false).shortValue()); // 源库位排
			crnCommand.setSourcePosY(sourceSta.getBay1().shortValue()); // 源库位列
			crnCommand.setSourcePosZ(sourceSta.getLev1().shortValue()); // 源库位层
			crnCommand.setDestinationPosX(crnStn.getRow().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(crnStn.getBay().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(crnStn.getLev().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 15.等待吊车 => 16.吊车出库中
			Date now = new Date();
			wrkMast.setWrkSts(16L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 15.等待吊车 => 16.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			return true;
			}
			if (wrkMast.getMk() == null \|\| !wrkMast.getMk().equals("Y")) {
			//不需要用到机械臂，直接转29.出库完成
			wrkMast.setWrkSts(29L);
			}
			}

			// 没有小车
			break;
			case 106://106.提升机搬运中 ==> 107.提升机搬运完成
			wrkMast.setWrkSts(107L);
			break;
			default:
			}

			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//设置提升机为空闲状态
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
			//任务指令清零
			liftProtocol.setAssignCommand(null);
			News.info("提升机已确认且任务完成状态。提升机号={}", liftProtocol.getLiftNo());
			} else {
			if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
			// 寻找最近的小车
			SteThread steThread = queryIdleCar(wrkMast);
			if (steThread != null) {
			// 没有其他任务
			if (null == wrkMastMapper.selectPakout(slave.getId(), steNo)) {
			// 让小车等待搬运待续
			this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getSourceLocNo());
			return true;
			}
			}
			}
			// 堆垛机搬运小车
			if (wrkMast.getWrkSts() == 12L) {
			this.carMoveIn(wrkMast, wrkMast.getSteNo(), crnProtocol);
			return true;
			News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
			}
			}else {
			LiftAssignCommand assignCommand = liftProtocol.getAssignCommand();
			if (assignCommand != null) {
			if (!assignCommand.getAuto()) {
			//手动操作
			//设置提升机为空闲状态
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
			//任务指令清零
			liftProtocol.setAssignCommand(null);
			News.info("提升机已确认手动操作。提升机号={}", liftProtocol.getLiftNo());
			}
			}
			}
			}
			}
			return false;
			}

			/**
			* 库位移转
			*/
			@Deprecated
			public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol){
			// 获取工作档信息
			WrkMast wrkMast = wrkMastMapper.selectLocMove(slave.getId());
			if (null == wrkMast) {
			return;
			}
			// 获取源库位信息
			LocMast sourceLoc = locMastService.selectById(wrkMast.getSourceLocNo());
			if (null == sourceLoc) {
			News.error("工作档库位移转失败，原因：检索源库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo());
			return;
			}
			// 源库位库位状态判断
			if (!sourceLoc.getLocSts().equals("R") && !sourceLoc.getLocSts().equals("S")) {
			return;
			}
			// 获取目标库位信息
			LocMast loc = locMastService.selectById(wrkMast.getLocNo());
			if (null == loc) {
			News.error("工作档库位移转失败，原因：检索目标库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getLocNo());
			return;
			}
			// 获取堆垛机信息并判断是否可入出
			BasCrnp basCrnp = basCrnpService.selectById(slave.getId());
			if (!basCrnp.getInEnable().equals("Y") && !basCrnp.getOutEnable().equals("Y")) {
			public synchronized void locToLocExecute() {
			//获取出入库工作档
			List<WrkMast> wrkMasts = wrkMastMapper.selectInOutWrkMast();
			if (wrkMasts.size() > 0) {
			//有出入库任务，必须等待任务执行完毕再执行库位移转
			return;
			}

			// 堆垛机控制过滤
			if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			return;
			}

			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			return;
			}

			// 置顶任务
			wrkMast.setIoPri((double) 9999);
			wrkMastMapper.updateById(wrkMast);

			// 命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX(sourceLoc.getRow1().shortValue()); // 源库位排
			crnCommand.setSourcePosY(sourceLoc.getBay1().shortValue()); // 源库位列
			crnCommand.setSourcePosZ(sourceLoc.getLev1().shortValue()); // 源库位层
			crnCommand.setDestinationPosX(loc.getRow1().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(loc.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(loc.getLev1().shortValue()); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 16.吊车出库中
			Date now = new Date();
			wrkMast.setWrkSts(16L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("【库位移转】修改工作档状态 11.生成出库ID => 16.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}

			}

			/**
			* 当前库位组是否存在空闲小车
			*/
			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;
			}
			//查询库位移转工作档
			List<WrkMast> wrkMasts1 = wrkMastMapper.selectLocToLocWrkMast();
			for (WrkMast wrkMast : wrkMasts1) {
			if (Utils.getLev(wrkMast.getSourceLocNo()) == Utils.getLev(wrkMast.getLocNo())) {
			boolean step1 = this.locToLocExecuteStep1(wrkMast);//同楼层库位移转
			if (!step1) {
			continue;
			}
			}
			}
			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();
			}else {
			//跨楼层库位移转
			boolean step2 = this.locToLocExecuteStep2(wrkMast);//调度车辆取货并运送到出库口
			if (!step2) {
			continue;
			}
			}
			}
			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;
			boolean step3 = this.locToLocExecuteStep3(wrkMast);//提升机搬运货物
			if (!step3) {
			continue;
			}
			}
			}
			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;
			boolean step4 = this.locToLocExecuteStep4(wrkMast);//调度车辆取货并运送到目标库位
			if (!step4) {
			continue;
			}
			}
			}
			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);
			return;
			}

			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(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 {
			// 修改工作档状态绑定穿梭车
			wrkCharge.setSteNo(steNo);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改工作档状态绑定穿梭车失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			}

			/**
			* 让小车从远点 ====>> 移动到近点
			* 等待堆垛机搬运
			*/
			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());
			}
			}
			}
			}

			/**
			* 让小车从远点 ====>> 移动到近点
			* 等待堆垛机搬运
			*/
			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());
			}
			}
			}
			}

			/**
			* 入出库 ===>> 堆垛机搬入小车
			*/
			public void carMoveIn(WrkMast wrkMast, Integer steNo, CrnProtocol crnProtocol) {
			// 获取堆垛机信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }
			if (steProtocol.isIdle()) {
			// 堆垛机空闲
			if (crnProtocol.getStatusType().equals(CrnStatusType.IDLE) && crnProtocol.getTaskNo() == 0) {
			LocMast locMast;
			// 入库搬
			if (wrkMast.getWrkSts() <= 10) {

			// 判断被移库位是否存在其他小车
			Integer otherSte = existOtherSte(wrkMast.getLocNo(), steNo);
			if (otherSte != null) {
			News.warn("{}号小车移入{}库位组失败，原因：存在{}号穿梭车！", steNo, wrkMast.getLocNo(), otherSte);
			return;
			}

			locMast = locMastService.selectById(wrkMast.getLocNo());
			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.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, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo(), true), locMast.getBay1(), locMast.getLev1());
			// 修改工作档状态 3.小车待搬 => 4.迁入小车
			Date now = new Date();
			wrkMast.setWrkSts(4L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 3.小车待搬 => 4.迁入小车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			// 出库搬
			} else {
			// 判断被移库位是否存在其他小车
			Integer otherSte = existOtherSte(wrkMast.getSourceLocNo(), steNo);
			if (otherSte != null) {
			News.warn("{}号小车移入{}库位组失败，原因：存在{}号穿梭车！", steNo, wrkMast.getSourceLocNo(), otherSte);
			return;
			}

			locMast = locMastService.selectById(wrkMast.getSourceLocNo());
			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.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, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo(), true), locMast.getBay1(), locMast.getLev1());
			// 修改工作档状态 12.小车待搬 => 13.迁入小车
			Date now = new Date();
			wrkMast.setWrkSts(13L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 12.小车待搬 => 13.迁入小车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			}
			}

			}
			}

			/**
			* 入库 ===>> 堆垛机搬出小车
			* 同楼层库位移转
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public void carMoveOut(WrkMast wrkMast, Integer steNo, CrnProtocol crnProtocol) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { return; }
			// 穿梭车空闲
			if (steProtocol.isIdle()) {
			// 堆垛机空闲
			if (crnProtocol.getStatusType().equals(CrnStatusType.IDLE) && crnProtocol.getTaskNo() == 0) {

			BasSte basSte = basSteService.selectById(steNo);
			if (basSte == null) {
			News.error("{}号穿梭车在数据库不存在！！！", steNo);
			return;
			}

			String idleLocNo = basSte.getIdleLoc();

			// 判断被移库位是否存在其他小车
			Integer otherSte = existOtherSte(idleLocNo, steNo);
			if (otherSte != null) {
			News.warn("{}号小车移入{}库位组失败，原因：存在{}号穿梭车！", steNo, idleLocNo, otherSte);
			return;
			}

			// 堆垛机命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo(wrkMast.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(idleLocNo, true).shortValue()); // 目标库位排
			crnCommand.setDestinationPosY((short) Utils.getBay(idleLocNo)); // 目标库位列
			crnCommand.setDestinationPosZ((short) Utils.getLev(idleLocNo)); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			News.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改穿梭车运行中排列层
			steThread.modifyPos(Utils.getGroupRow(idleLocNo, true), Utils.getBay(idleLocNo), Utils.getLev(idleLocNo));
			// 修改工作档状态 3.小车待搬 => 5.迁出小车
			Date now = new Date();
			wrkMast.setWrkSts(5L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 3.小车待搬 => 5.迁出小车失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			private boolean locToLocExecuteStep1(WrkMast wrkMast) {
			if (wrkMast.getWrkSts() == 21) {//21.生成出库任务
			if (wrkMast.getShuttleNo() == null) {
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到源库位进行取货
			return false;
			}
			}
			}


			/**
			* 执行对工作档的完成操作
			*/
			@Transactional
			public void storeFinished() {
			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) { continue; }
			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			// 获取入库待确认工作档
			WrkMast wrkMast = wrkMastMapper.selectCrnWaiting(crnProtocol.getTaskNo().intValue());
			if (wrkMast == null) {

			// 充电任务
			WrkCharge wrkCharge = wrkChargeService.selectById(crnProtocol.getTaskNo());
			if (wrkCharge == null) {
			News.error("堆垛机处于等待确认且任务完成状态，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			wrkMast = wrkMastMapper.selectCrnWaiting2(crnProtocol.getTaskNo().intValue());
			if (wrkMast.getIoType() != 11) {
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			News.error("堆垛机处于等待确认且任务完成状态,复位，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			} else {
			News.error("堆垛机处于等待确认且任务完成状态,复位失败，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			}
			}
			continue;
			} else {
			// 小车搬至指定库位完成
			if (wrkCharge.getWrkSts() == 23) {
			// 23.吊车搬运 ===>> 24.小车到达
			wrkCharge.setWrkSts(24L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 23.吊车搬运 ===>> 24.小车到达失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业充电任务号：{}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
			}
			}
			} else if (wrkCharge.getWrkSts() == 27) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			if (steThread.confirmPos()) {
			// 27.放至充电位 ===>> 28.充电就绪
			wrkCharge.setWrkSts(28L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 27.放至充电位 ===>> 28.充电就绪失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			} else {
			News.error("{}号穿梭车重新定位失败！作业充电任务号：{}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
			}
			} else if (wrkCharge.getWrkSts() == 34) {
			// 34.吊车搬运 ===>> 35.小车就绪
			wrkCharge.setWrkSts(35L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 34.吊车搬运 ===>> 35.小车就绪失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业充电任务号：{}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
			}
			}
			} else if (wrkCharge.getWrkSts() == 42) {
			// 42.吊车搬运 ===>> 43.小车到达
			wrkCharge.setWrkSts(43L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改复位任务状态 42.吊车搬运 ===>> 43.小车到达失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业复位任务号：{}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
			}
			}
			} else if (wrkCharge.getWrkSts() == 46) {
			// 46.放至待机位 ===>> 47.复位成功
			wrkCharge.setWrkSts(47L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改复位任务状态 46.放至待机位 ===>> 47.复位成功失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业复位任务号：{}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
			}
			}
			}
			}

			}
			if (wrkMast == null) { continue; }
			if (wrkMast.getIoType() != 11) {
			// 入库 ==>> 货物搬入库
			if (wrkMast.getWrkSts() == 7){
			// 判断是否需要小车入库
			if (locMastService.isOutMost(wrkMast.getLocNo(), true)) {
			// ==> 9.入库完成
			wrkMast.setWrkSts(9L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			} else {
			News.error("修改工作档状态 7.吊车入库中 => 9.入库完成失败！！，工作号={}", wrkMast.getWrkNo());
			}
			} else {
			// 给穿梭车下发命令
			Integer steNo = wrkMast.getSteNo();
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.isIdle()) {
			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkMast.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findInByLoc(wrkMast.getLocNo())); // 任务模式: 搬入库
			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 修改工作档状态 7.吊车入库中 => 8.小车搬入库
			wrkMast.setWrkSts(8L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			} else {
			News.error("修改工作档状态 7.吊车入库中 => 8.小车搬入库失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			}
			}
			// 入库 ===>> 迁入小车完成
			} else if (wrkMast.getWrkSts() == 4) {
			// 4.迁入小车 ==> 6.小车待入
			wrkMast.setWrkSts(6L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkMast.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业工作档任务号：{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
			}
			// 穿梭车去待机位
			BasSte basSte = basSteService.selectById(wrkMast.getSteNo());
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkMast.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(9999); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findWaiting(basSte.getRow())); // 任务模式: 去近点等待堆垛机叉取
			// steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
			// steCommand.setBay(steProtocol.getBay());
			// steCommand.setLev(steProtocol.getLev());
			if (!MessageQueue.offer(SlaveType.Ste, wrkMast.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车待机位命令下发失败，穿梭车号={}，任务数据={}", wrkMast.getSteNo(), JSON.toJSON(steCommand));
			}
			} else {
			News.error("修改工作档状态 4.迁入小车 => 6.小车待入失败！！，工作号={}", wrkMast.getWrkNo());
			}
			// 入库 ===>> 迁出小车完成
			} else if (wrkMast.getWrkSts() == 5) {
			// 5.迁出小车 ==> 6.小车待入
			wrkMast.setWrkSts(6L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			// 穿梭车重新定位排列层
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkMast.getSteNo());
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业工作档任务号：{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
			}
			// 穿梭车去待机位
			BasSte basSte = basSteService.selectById(wrkMast.getSteNo());
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkMast.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(9999); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findWaiting(basSte.getRow())); // 任务模式: 去近点等待堆垛机叉取
			// steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
			// steCommand.setBay(steProtocol.getBay());
			// steCommand.setLev(steProtocol.getLev());
			if (!MessageQueue.offer(SlaveType.Ste, wrkMast.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车待机位命令下发失败，穿梭车号={}，任务数据={}", wrkMast.getSteNo(), JSON.toJSON(steCommand));
			}
			} else {
			News.error("修改工作档状态 5.迁出小车 => 6.小车待入失败！！，工作号={}", wrkMast.getWrkNo());
			}
			// 出库 ===>> 迁入小车完成
			} else if (wrkMast.getWrkSts() == 13) {
			// 给穿梭车下发命令
			Integer steNo = wrkMast.getSteNo();
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			// 穿梭车重新定位排列层
			if (!steThread.confirmPos()) {
			News.error("{}号穿梭车重新定位失败！作业工作档任务号：{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
			}
			// 命令下发区 --------------------------------------------------------------------------
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(steNo); // 穿梭车编号
			steCommand.setTaskNo(wrkMast.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.findOutByLoc(wrkMast.getSourceLocNo())); // 任务模式: 搬出库
			if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", steNo, JSON.toJSON(steCommand));
			} else {
			// 13.迁入小车 ==> 14.小车搬出库
			wrkMast.setWrkSts(14L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			LocMast locMast = locMastService.selectById(wrkMast.getSourceLocNo());
			Integer outCrnNo = locMastService.getOutCrnNo(locMast);
			wrkMast.setCrnNo(outCrnNo);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			} else {
			News.error("修改工作档状态 13.迁入小车 ==> 14.小车搬出库失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			// 移库 ===>> 堆垛机搬至目标库位组完成
			} else if (wrkMast.getWrkSts() == 16) {
			// 16.吊车出库中 ==> 17.出库完成
			wrkMast.setWrkSts(17L);
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			LocMast locMast = locMastService.selectById(wrkMast.getSourceLocNo());
			Integer outCrnNo = locMastService.getOutCrnNo(locMast);
			wrkMast.setCrnNo(outCrnNo);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			crnThread.setResetFlag(true);
			} else {
			News.error("修改工作档状态 16.吊车出库中 ==> 17.出库完成失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			}
			//获取四向穿梭车线程
			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.isIdle()) {
			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(), wrkMast.getSourceLocNo(), 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);//21.生成出库任务 => 5.小车搬运中
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}

			return false;
			}
			return true;
			}

			/**
			* 执行对工作档的完成操作
			* 跨楼层库位移转-调度车辆取货并运送到出库口
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			public synchronized void carGenerateStore() {
			private boolean locToLocExecuteStep2(WrkMast wrkMast) {
			if (wrkMast.getWrkSts() == 21) {//21.生成出库任务
			if (wrkMast.getShuttleNo() == null) {
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到源库位进行取货
			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.isIdle()) {
			return false;
			}

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

			//获取穿梭车最近且空闲的提升机输送站点
			LiftStaProtocol liftSta = shuttleDispatchUtils.getRecentLiftSta(shuttleThread.getSlave().getId());
			if (liftSta == null) {
			return false;//没有可用且空闲的输送站点
			}
			//源站
			Integer sourceStaNo = liftSta.getStaNo();
			//提升机号*100+目标楼层=目标站点
			Integer staNo = liftSta.getLiftNo() * 100 + Utils.getLev(wrkMast.getLocNo());//目标站

			//小车已抵达源库位，将货物搬运到输送站点
			NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), liftSta.getLocNo());
			if (result == null) {//路径计算失败
			return false;
			}

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

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

			return false;
			}
			return true;
			}

			/**
			* 跨楼层库位移转-提升机搬运货物
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean locToLocExecuteStep3(WrkMast wrkMast) {
			Date now = new Date();
			for (SteSlave ste : slaveProperties.getSte()) {
			// 获取穿梭车信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) { continue; }
			if (steProtocol.getWaiting() && steProtocol.getTaskNo() != 0) {
			if (steProtocol.getTaskNo() == 9999) {
			steThread.setResetFlag(true);
			} else {
			// 查询是否有待入库的任务
			WrkMast wrkMast = wrkMastMapper.selectCarWaiting(steProtocol.getTaskNo().intValue());
			if (wrkMast == null) {
			// 充电任务
			WrkCharge wrkCharge = wrkChargeService.selectById(steProtocol.getTaskNo());
			if (wrkCharge == null) {
			continue;
			} else {
			if (wrkCharge.getWrkSts() == 21) {
			// 21.准备充电 ===>> 22.小车待搬
			wrkCharge.setWrkSts(22L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 21.准备充电 ===>> 22.小车待搬失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			} else if (wrkCharge.getWrkSts() == 25) {
			// 25.小车走行 ===>> 26.等待充电
			wrkCharge.setWrkSts(26L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 25.小车走行 ===>> 26.等待充电失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			}
			// else if (wrkCharge.getWrkSts() == 29) {
			// // 29.开始充电 ===>> 30.完成充电
			// wrkCharge.setWrkSts(30L);
			// if (!wrkChargeService.updateById(wrkCharge)) {
			// News.error("修改充电任务状态 29.开始充电 ===>> 30.完成充电失败！！，工作号={}", wrkCharge.getWrkNo());
			// } else {
			// steThread.setResetFlag(true);
			// }
			// }
			else if (wrkCharge.getWrkSts() == 32) {
			// 32.小车走行 ===>> 33.小车待搬
			wrkCharge.setWrkSts(33L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务状态 32.小车走行 ===>> 33.小车待搬失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			} else if (wrkCharge.getWrkSts() == 36) {
			// 36.小车走行 ===>> 37.演示完成
			wrkCharge.setWrkSts(37L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务状态 36.小车走行 ===>> 37.演示完成失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			} else if (wrkCharge.getWrkSts() == 44) {
			// 44.小车走行 ===>> 45.小车待搬
			wrkCharge.setWrkSts(45L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务状态 44.小车走行 ===>> 45.小车待搬失败！！，工作号={}", wrkCharge.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			}
			}
			}

			if (wrkMast == null) { continue; }
			switch (wrkMast.getWrkSts().intValue()) {
			case 2:
			// 修改工作档状态 2.设备上走 => 3.小车待搬
			wrkMast.setWrkSts(3L);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 2.设备上走 => 3.小车待搬失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			break;
			case 8:
			// 修改工作档状态 8.小车搬入库 => 9.入库完成
			wrkMast.setWrkSts(9L);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 8.小车搬入库 => 9.入库完成失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			break;
			case 11:
			if (wrkMast.getIoType() != 11) {
			// 修改工作档状态 11.生成出库ID => 12.小车待搬
			wrkMast.setWrkSts(12L);
			} else {
			if (Cools.isEmpty(wrkMast.getMk())) {
			News.error("移库工作档没有流程标记！！，工作号={}", wrkMast.getWrkNo());
			} else {
			if (wrkMast.getMk().equals("I")) {
			String locNo = wrkMast.getLocNo();
			if (Utils.getGroupRow(locNo, false).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), false))
			&& steProtocol.getBay() == Utils.getBay(locNo)
			&& steProtocol.getLev() == Utils.getLev(locNo)) {
			// 修改工作档状态 11.生成出库ID => 6.小车待入
			wrkMast.setWrkSts(6L);
			} else {
			// 修改工作档状态 11.生成出库ID => 3.小车待搬
			wrkMast.setWrkSts(3L);
			}
			} else if (wrkMast.getMk().equals("O")) {
			// 修改工作档状态 11.生成出库ID => 12.小车待搬
			wrkMast.setWrkSts(12L);
			}
			}
			}
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 11.生成出库ID => 12.小车待搬失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			break;
			case 14:
			// 修改工作档状态 14.小车搬出库 => 15.等待吊车
			wrkMast.setWrkSts(15L);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			News.error("修改工作档状态 14.小车搬出库 => 15.等待吊车失败！！，工作号={}", wrkMast.getWrkNo());
			} else {
			steThread.setResetFlag(true);
			}
			break;
			}
			}
			if (wrkMast.getWrkSts() == 23) {//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()) {
			return false;
			}

			//搜索是否有其他任务占用了提升机，如果占用提升机的任务和当前任务相同，则运行执行
			WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
			if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) {
			return false;
			}

			//源站
			Integer sourceStaNo = wrkMast.getSourceStaNo();
			//目标站
			Integer staNo = wrkMast.getStaNo();
			if (sourceStaNo == null \|\| staNo == null) {
			return false;//源站或目标站为空
			}

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceStaNo, staNo, 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.setShuttleNo(null);//清空小车号，等货物搬运完成后，到目标楼层重新搜索小车
			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 locToLocExecuteStep4(WrkMast wrkMast) {
			if (wrkMast.getWrkSts() == 4) {//4.提升机搬运完成
			//获取目标站对应的输送站点
			BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), wrkMast.getLiftNo());
			if (targetBasDevp == null) {
			return false;//缺少站点信息
			}

			if (wrkMast.getShuttleNo() == null) {
			shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), targetBasDevp.getLocNo());//调度小车到目标输送站点进行取货
			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.isIdle()) {
			return false;
			}

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

			//小车已抵达目标输送站点，将货物搬运到目标库位
			NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), targetBasDevp.getLocNo(), wrkMast.getLocNo());
			if (result == null) {//路径计算失败
			return false;
			}

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

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

			return false;
			}
			return true;
			}

			/**
			@@ -2194,241 +1655,216 @@
			*/
			public void recErr() {
			try {
			this.recCrnErr();
			this.recSteErr();
			this.recShuttleErr();
			this.recLiftErr();
			} catch (Exception e) {
			News.error("recErr fail", e);
			}
			}

			/**
			* 堆垛机异常信息记录
			* 四向穿梭车异常信息记录
			*/
			private void recCrnErr(){
			private void recShuttleErr() {
			Date now = new Date();
			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) {
			for (ShuttleSlave shuttleSlave : slaveProperties.getShuttle()) {
			// 获取四向穿梭车信息
			NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleSlave.getId());
			if (shuttleThread == null) {
			continue;
			}
			// 有任务
			if (crnProtocol.getTaskNo() != 0) {
			BasErrLog latest = basErrLogService.findLatestByTaskNo(crn.getId(), crnProtocol.getTaskNo().intValue());
			NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			if (shuttleProtocol.getTaskNo() != 0) {
			//有任务
			BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(shuttleSlave.getId(), shuttleProtocol.getTaskNo());
			// 有异常
			if (latest == null) {
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			WrkMast wrkMast = wrkMastMapper.selectById(crnProtocol.getTaskNo());
			if (shuttleProtocol.getErrState() != null && shuttleProtocol.getErrState() == 1) {
			WrkMast wrkMast = wrkMastMapper.selectById(shuttleProtocol.getTaskNo());
			if (wrkMast == null) {
			continue;
			}
			BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
			String errName = crnError==null? "未知异常":crnError.getErrName();
			BasErrLog basErrLog = new BasErrLog(
			BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getErrCode());
			String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
			BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
			null, // 编号
			wrkMast.getWrkNo(), // 工作号
			now, // 发生时间
			null, // 结束时间
			wrkMast.getWrkSts(), // 工作状态
			wrkMast.getIoType(), // 入出库类型
			crn.getId(), // 堆垛机
			shuttleSlave.getId(), // 四向穿梭车
			null, // plc
			wrkMast.getLocNo(), // 目标库位
			wrkMast.getStaNo(), // 目标站
			wrkMast.getSourceStaNo(), // 源站
			wrkMast.getSourceLocNo(), // 源库位
			wrkMast.getBarcode(), // 条码
			(int) crnProtocol.getAlarm(), // 异常码
			shuttleProtocol.getErrCode(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			null, // 添加人员
			now, // 修改时间
			null, // 修改人员
			"任务中异常" // 备注
			"任务中异常", // 备注
			JSON.toJSONString(shuttleProtocol) // 系统状态数据
			);
			if (!basErrLogService.insert(basErrLog)) {
			News.error("堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
			News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
			}
			}
			} else {
			// 异常修复
			if (crnProtocol.getAlarm() == null \|\| crnProtocol.getAlarm() == 0) {
			if (shuttleProtocol.getErrState() == null \|\| shuttleProtocol.getErrState() == 0) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basErrLogService.updateById(latest)) {
			News.error("堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			if (!basShuttleErrLogService.updateById(latest)) {
			News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
			}
			}
			}
			// 无任务
			} else {
			BasErrLog latest = basErrLogService.findLatest(crn.getId());
			// 有异常
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			// 记录新异常
			if (latest == null \|\| (latest.getErrCode() != crnProtocol.getAlarm().intValue())) {
			BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
			String errName = crnError==null? "未知异常":crnError.getErrName();
			BasErrLog basErrLog = new BasErrLog(
			null, // 编号
			null, // 工作号
			now, // 发生时间
			null, // 结束时间
			null, // 工作状态
			null, // 入出库类型
			crn.getId(), // 堆垛机
			null, // plc
			null, // 目标库位
			null, // 目标站
			null, // 源站
			null, // 源库位
			null, // 条码
			(int)crnProtocol.getAlarm(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			null, // 添加人员
			now, // 修改时间
			null, // 修改人员
			"无任务异常" // 备注
			);
			if (!basErrLogService.insert(basErrLog)) {
			News.error("堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			}
			}
			// 无异常
			} else {
			// 异常修复
			if (latest != null && latest.getStatus() == 1) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basErrLogService.updateById(latest)) {
			News.error("堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			}
			}
			}
			}else {
			// //无任务
			// BasShuttleErrLog latest = basShuttleErrLogService.findLatest(shuttleSlave.getId());
			// // 有异常
			// if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) {
			// // 记录新异常
			// if (latest == null \|\| (latest.getErrCode() != shuttleProtocol.getStatusErrorCode().intValue())) {
			// BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue());
			// String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
			// BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
			// null, // 编号
			// null, // 工作号
			// now, // 发生时间
			// null, // 结束时间
			// null, // 工作状态
			// null, // 入出库类型
			// shuttleSlave.getId(), // 四向穿梭车
			// null, // plc
			// null, // 目标库位
			// null, // 目标站
			// null, // 源站
			// null, // 源库位
			// null, // 条码
			// (int)shuttleProtocol.getStatusErrorCode(), // 异常码
			// errName, // 异常
			// 1, // 异常情况
			// now, // 添加时间
			// null, // 添加人员
			// now, // 修改时间
			// null, // 修改人员
			// "无任务异常" // 备注
			// );
			// if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
			// News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
			// }
			// }
			// // 无异常
			// } else {
			// // 异常修复
			// if (latest != null && latest.getStatus() == 1) {
			// latest.setEndTime(now);
			// latest.setUpdateTime(now);
			// latest.setStatus(2);
			// if (!basShuttleErrLogService.updateById(latest)) {
			// News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
			// }
			// }
			// }
			}
			}
			}

			/**
			* 穿梭车异常信息记录
			* 提升机异常信息记录
			*/
			private void recSteErr(){
			private void recLiftErr() {
			Date now = new Date();
			for (SteSlave ste : slaveProperties.getSte()) {
			// 获取堆垛机信息
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (steProtocol == null) {
			for (LiftSlave liftSlave : slaveProperties.getLift()) {
			// 获取提升机信息
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
			if (liftThread == null) {
			continue;
			}
			// 有任务
			if (steProtocol.getTaskNo() != 0) {
			BasSteErrLog latest = basSteErrLogService.findLatestByTaskNo(ste.getId(), steProtocol.getTaskNo().intValue());
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			continue;
			}

			if (liftProtocol.getTaskNo() != 0) {
			//有任务
			BasLiftErrLog latest = basLiftErrLogService.findLatestByTaskNo(liftSlave.getId(), liftProtocol.getTaskNo().intValue());
			// 有异常
			if (latest == null) {
			if (steProtocol.getAlarm() != null && steProtocol.isAlarm()) {
			WrkMast wrkMast = wrkMastMapper.selectById(steProtocol.getTaskNo());
			if (liftProtocol.getDeviceError() != null && liftProtocol.getDeviceError()) {
			WrkMast wrkMast = wrkMastMapper.selectById(liftProtocol.getTaskNo());
			if (wrkMast == null) {
			continue;
			}
			BasSteErr steErr = basSteErrService.selectById(steProtocol.getAlarm());
			String errName = steErr==null? "未知异常":steErr.getErrName();
			BasSteErrLog basSteErrLog = new BasSteErrLog(

			String errName = "";
			if (liftProtocol.getFrontOverrun()) {
			errName = "前超限";
			} else if (liftProtocol.getBackOverrun()) {
			errName = "后超限";
			} else if (liftProtocol.getLeftOverrun()) {
			errName = "左超限";
			} else if (liftProtocol.getRightOverrun()) {
			errName = "右超限";
			} else if (liftProtocol.getOverHeight()) {
			errName = "超高";
			} else if (liftProtocol.getOverWeight()) {
			errName = "超重";
			}

			BasLiftErrLog basLiftErrLog = new BasLiftErrLog(
			null, // 编号
			wrkMast.getWrkNo(), // 工作号
			now, // 发生时间
			null, // 结束时间
			wrkMast.getWrkSts(), // 工作状态
			wrkMast.getIoType(), // 入出库类型
			ste.getId(), // 堆垛机
			liftSlave.getId(), // 提升机
			null, // plc
			wrkMast.getLocNo(), // 目标库位
			wrkMast.getStaNo(), // 目标站
			wrkMast.getSourceStaNo(), // 源站
			wrkMast.getSourceLocNo(), // 源库位
			wrkMast.getBarcode(), // 条码
			(int) steProtocol.getAlarm(), // 异常码
			null, // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			null, // 添加人员
			now, // 修改时间
			null, // 修改人员
			"任务中异常" // 备注
			"任务中异常", // 备注
			JSON.toJSONString(liftProtocol) // 系统状态数据
			);
			if (!basSteErrLogService.insert(basSteErrLog)) {
			News.error("穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", ste.getId(), errName);
			if (!basLiftErrLogService.insert(basLiftErrLog)) {
			News.error("提升机plc异常记录失败 ===>> [id:{}] [error:{}]", liftSlave.getId(), errName);
			}
			}
			} else {
			// 异常修复
			if (steProtocol.getAlarm() == null \|\| !steProtocol.isAlarm()) {
			if (liftProtocol.getDeviceError() == null \|\| !liftProtocol.getDeviceError()) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basSteErrLogService.updateById(latest)) {
			News.error("穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", ste.getId(), latest.getId());
			}
			}
			}
			// 无任务
			} else {
			BasSteErrLog latest = basSteErrLogService.findLatest(ste.getId());
			// 有异常
			if (steProtocol.getAlarm() != null && steProtocol.isAlarm()) {
			// 记录新异常
			if (latest == null \|\| (latest.getErrCode() != steProtocol.getAlarm().intValue())) {
			BasSteErr steErr = basSteErrService.selectById(steProtocol.getAlarm());
			String errName = steErr==null? "未知异常":steErr.getErrName();
			BasSteErrLog basSteErrLog = new BasSteErrLog(
			null, // 编号
			null, // 工作号
			now, // 发生时间
			null, // 结束时间
			null, // 工作状态
			null, // 入出库类型
			ste.getId(), // 堆垛机
			null, // plc
			null, // 目标库位
			null, // 目标站
			null, // 源站
			null, // 源库位
			null, // 条码
			(int)steProtocol.getAlarm(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			null, // 添加人员
			now, // 修改时间
			null, // 修改人员
			"无任务异常" // 备注
			);
			if (!basSteErrLogService.insert(basSteErrLog)) {
			News.error("穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", ste.getId(), errName);
			}
			}
			// 无异常
			} else {
			// 异常修复
			if (latest != null && latest.getStatus() == 1) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basSteErrLogService.updateById(latest)) {
			News.error("穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", ste.getId(), latest.getId());
			if (!basLiftErrLogService.updateById(latest)) {
			News.error("提升机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", liftSlave.getId(), latest.getId());
			}
			}
			}
			}
			}
			}


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

			@@ -2468,6 +1904,13 @@
			}
			}

			if (!Cools.isEmpty(barcode)) {
			WrkMast wrkMast = wrkMastMapper.selectByBarcode(barcode);//条码存在工作档
			if (wrkMast != null) {
			continue;
			}
			}

			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, emptyInSta.getLed());

			try {
			@@ -2490,15 +1933,15 @@
			Integer code = jsonObject.getInteger("code");
			if (code.equals(200)) {
			StartupDto dto = jsonObject.getObject("data", StartupDto.class);

			// 更新站点信息且下发plc命令
			staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			staProtocol.setStaNo(dto.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}
			barcodeThread.setBarcode("");
			// // 更新站点信息且下发plc命令
			// staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			// staProtocol.setStaNo(dto.getStaNo().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// if (!result) {
			// throw new CoolException("更新plc站点信息失败");
			// }
			} else {
			if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			@@ -2516,6 +1959,248 @@
			}


			}
			}
			}

			/**
			* AGV补货 => 机械臂拣料
			*/
			public void agvRestockByRobot() {
			//检测300站是否自动、有物、工作号
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 获取入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(300);
			if (staProtocol == null) {
			continue;
			}
			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() != 0) {
			//查询是否有工作档
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(staProtocol.getWorkNo().intValue());
			if (wrkMast == null) {
			continue;
			}

			if (wrkMast.getWrkSts() != 25) {//25.提升机搬运完成
			continue;
			}

			if (wrkMast.getMk() != null && wrkMast.getMk().equals("Y")) {//标记为Y表示需要用到机械臂拣料
			Short targetSta = null;//目标站
			//判断机械臂拣料站是否空闲
			StaProtocol staProtocol303 = devpThread.getStation().get(303);
			StaProtocol staProtocol317 = devpThread.getStation().get(317);
			if (staProtocol303.isAutoing() && !staProtocol303.isLoading()) {
			//自动、无物
			targetSta = (short) 303;
			} else if (staProtocol317.isAutoing() && !staProtocol317.isLoading()) {
			//自动、无物
			targetSta = (short) 317;
			}else {
			continue;//没有空闲站点
			}

			targetSta = (short) 317;

			if (wrkMast.getStaNo() != 303 && wrkMast.getStaNo() != 317) {
			//向AGV发起组托请求
			// try {
			// HashMap<String, Object> param = new HashMap<>();
			// param.put("wrkNo", wrkMast.getWrkNo());
			// String response = new HttpHandler.Builder()
			// .setUri(wmsUrl)
			// .setPath("/openAGV")
			// .setJson(JSON.toJSONString(param))
			// .build()
			// .doPost();
			// JSONObject jsonObject = JSON.parseObject(response);
			// Integer code = jsonObject.getInteger("code");
			// if (code.equals(200)) {//AGV组托成功
			// //覆盖工作档目标站
			// wrkMast.setStaNo(targetSta.intValue());
			// wrkMast.setShuttleNo(null);//释放小车
			// if (wrkMastMapper.updateById(wrkMast) > 0) {
			// //向300站写入目标站
			// staProtocol = staProtocol.clone();
			// staProtocol.setStaNo(targetSta);//移动到目标站
			// boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// try {
			// Thread.sleep(500);
			// } catch (Exception e) {
			// e.printStackTrace();
			// }
			// continue;
			// }
			// }
			// } catch (Exception e) {
			// e.printStackTrace();
			// TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			// }

			//覆盖工作档目标站
			wrkMast.setStaNo(targetSta.intValue());
			wrkMast.setShuttleNo(null);//释放小车
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//向300站写入目标站
			staProtocol = staProtocol.clone();
			staProtocol.setStaNo(targetSta);//移动到目标站
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			try {
			Thread.sleep(500);
			} catch (Exception e) {
			e.printStackTrace();
			}
			continue;
			}
			}
			}
			}

			StaProtocol staProtocol303 = devpThread.getStation().get(303);
			StaProtocol staProtocol317 = devpThread.getStation().get(317);
			if (staProtocol303.isAutoing() && staProtocol303.isLoading() && staProtocol303.getWorkNo() != 0) {
			//调度机械臂
			//查询是否有工作档
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(staProtocol303.getWorkNo().intValue());
			if (wrkMast == null) {
			continue;
			}
			List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
			if (wrkDetls.isEmpty()) {
			continue;
			}

			if (wrkMast.getInvWh() == null) {
			wrkMast.setInvWh("Y");//标记已经下发机械臂任务
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			RobotUtils.sendTask(staProtocol303.getWorkNo().toString(), wrkDetls.size(), "303");
			}
			}
			}else if (staProtocol317.isAutoing() && staProtocol317.isLoading() && staProtocol317.getWorkNo() != 0) {
			//调度机械臂
			//查询是否有工作档
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(staProtocol317.getWorkNo().intValue());
			if (wrkMast == null) {
			continue;
			}
			List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
			if (wrkDetls.isEmpty()) {
			continue;
			}
			if (wrkMast.getInvWh() == null) {
			wrkMast.setInvWh("Y");//标记已经下发机械臂任务
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			RobotUtils.sendTask(staProtocol317.getWorkNo().toString(), wrkDetls.size(), "317");
			}
			}
			}
			}
			}

			/**
			* AGV补货(通知AGV取货)
			*/
			public void agvRestockInto() {
			//检测309和312站是否自动、有物
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 获取入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol309 = devpThread.getStation().get(309);
			StaProtocol staProtocol312 = devpThread.getStation().get(312);
			if (staProtocol309 == null \|\| staProtocol312 == null) {
			continue;
			}

			if (staProtocol309.isAutoing() && staProtocol309.isLoading()) {
			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, 11);//308站条码器
			if (barcodeThread == null) {
			continue;
			}
			String barcode = barcodeThread.getBarcode();
			if(!Cools.isEmpty(barcode)) {
			//通知AGV取货
			agvRestockCall("CS-301-001-01@3", barcode);
			}
			} else if (staProtocol312.isAutoing() && staProtocol312.isLoading()) {
			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, 12);//311站条码器
			if (barcodeThread == null) {
			continue;
			}
			String barcode = barcodeThread.getBarcode();
			if(!Cools.isEmpty(barcode)) {
			//通知AGV取货
			agvRestockCall("CS-302-001-01@3", barcode);
			}
			}
			}
			}

			//通知AGV取货
			private boolean agvRestockCall(String staNo, String barcode) {
			try {
			HashMap<String, Object> param = new HashMap<>();
			param.put("staNo", staNo);
			param.put("barcode", barcode);
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/callAGV")
			.setJson(JSON.toJSONString(param))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			Integer code = jsonObject.getInteger("code");
			if (code.equals(200)) {//呼叫AGV
			return true;
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			return false;
			}

			// 300站拣料
			public void pick300() {
			//检测300站是否自动、有物、工作号
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 获取入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(300);
			if (staProtocol == null) {
			continue;
			}
			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() != 0) {
			//查询是否有工作档
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(staProtocol.getWorkNo().intValue());
			if (wrkMast == null) {
			continue;
			}

			if (wrkMast.getWrkSts() != 25) {//25.提升机搬运完成
			continue;
			}

			if (wrkMast.getMk() == null) {
			Integer sourceStaNo = wrkMast.getSourceStaNo();//源站
			Integer staNo = wrkMast.getStaNo();//目标站
			//覆盖工作档目标站
			wrkMast.setStaNo(sourceStaNo);
			wrkMast.setSourceStaNo(staNo);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//向300站写入目标站
			staProtocol = staProtocol.clone();
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());//移动到目标站
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			try {
			Thread.sleep(500);
			} catch (Exception e) {
			e.printStackTrace();
			}
			}
			}
			}
			}
			}
			@@ -2685,827 +2370,848 @@
			}

			/**
			* 小车电量检测 ===>> 发起充电
			* 四向穿梭车电量检测 ===>> 发起充电
			*/
			@SuppressWarnings("serial")
			public synchronized void loopSteCharge() {
			if (!Cools.isEmpty(wrkMastMapper.selectAllC())){
			return;
			}
			if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset)) {
			return;
			}
			if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge)) {
			return;
			}
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			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; }
			try {
			// 在线空闲无作业标记不在充电
			if (steProtocol.getMode() == 0
			\|\| !steProtocol.statusType.equals(SteStatusType.IDLE)
			\|\| basSte.getPakMk().equals("Y")
			\|\| basSte.getAutoCharge().equals("N")
			// \|\| steProtocol.getChargeStatus() == 1
			) {
			continue;
			public synchronized void loopShuttleCharge() {
			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;
			}

			//小车所在楼层
			int lev = Utils.getLev(shuttleProtocol.getCurrentLocNo());
			ShuttleChargeType shuttleCharge = null;

			//搜索小车所在楼层有没有充电桩
			for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
			if (lev != Utils.getLev(chargeType.locNo)) {
			continue;//小车和充电桩不在同一层
			}
			if (!steProtocol.isEnable()) {
			continue;
			}
			if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())) {
			continue;
			}
			WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);

			if (wrkCharge == null && steProtocol.getChargeStatus() == 0) {
			// 寻找空闲充电桩
			SteChargeType steCharge = null;
			do {
			String locNo;
			if (devpThread.charge0) {
			SteChargeType first = SteChargeType.FIRST;
			locNo = first.locNo;
			if (basSteService.hasCarOfLocNo(locNo) == null
			&& wrkChargeService.selectWorkingOfCharge(first.ssbm) == null) {
			steCharge = first;
			break;
			}
			}
			// if (!devpThread.charge1) {
			// SteChargeType second = SteChargeType.SECOND;
			// locNo = second.locNo;
			// if (basSteService.hasCarOfLocNo(locNo) == null
			// && wrkChargeService.selectWorkingOfCharge(second.ssbm) == null) {
			// steCharge = second;
			// break;
			// }
			// }
			// if (!devpThread.charge2) {
			// SteChargeType third = SteChargeType.THIRD;
			// locNo = third.locNo;
			// if (basSteService.hasCarOfLocNo(locNo) == null
			// && wrkChargeService.selectWorkingOfCharge(third.ssbm) == null) {
			// steCharge = third;
			// break;
			// }
			// }
			break;
			} while (false);

			if (steCharge == null) {
			// News.warn("{}号小车【电量：{}】充电失败，原因：没有空闲充电桩。", ste.getId(), steProtocol.getCharge());
			continue;
			}
			String chargeLocNo = steCharge.locNo;
			wrkCharge = new WrkCharge();
			wrkCharge.setSteNo(ste.getId());
			wrkCharge.setCharge(steCharge.ssbm);
			wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
			wrkCharge.setWrkSts(21L); // 21.准备充电
			wrkCharge.setCrnNo(1); // 固定1号堆垛机
			wrkCharge.setIoPri((double) 10);
			wrkCharge.setLocNo(chargeLocNo);
			wrkCharge.setMemo("charge");
			wrkCharge.setAppeTime(new Date());
			if (!wrkChargeService.insert(wrkCharge)) {
			News.error("保存{}号穿梭车充电任务失败!!!", ste.getId());
			continue;
			}

			// 处于充电库位组
			if ( 0<steProtocol.getRow().intValue() && steProtocol.getRow().intValue()<=4
			&& steProtocol.getBay().intValue() == Utils.getBay(chargeLocNo)
			&& steProtocol.getLev().intValue() == Utils.getLev(chargeLocNo)) {
			// 修改工作档状态 21.准备充电 => 24.小车到达
			wrkCharge.setWrkSts(24L);
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 21.准备充电 => 24.小车到达失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			} else {
			this.letCarBeWaiting(wrkCharge, ste.getId());
			}

			//小车和充电桩在同一层
			if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
			shuttleCharge = chargeType;
			break;
			}
			} catch (Exception e) {
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			News.error("loopSteCharge fail", e);
			}
			}
			}

			/**
			* 执行小车充电任务
			*/
			public synchronized void executeSteCharge() {
			WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
			SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, 1);
			SteProtocol steProtocol = steThread.getSteProtocol();
			if (null == wrkCharge) {
			try{
			if (steProtocol.getChargeStatus()==(short)0 && steProtocol.isBrushConnect()){
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(1); // 穿梭车编号
			steCommand.setTaskNo(10060); // 工作号
			steCommand.setTaskMode(SteTaskModeType.CLOSE_CHARGE); // 任务模式: 断开充电
			if (!MessageQueue.offer(SlaveType.Ste, 1, new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			}
			}
			}catch (Exception e){
			return;
			}
			return;
			}
			Integer steNo = wrkCharge.getSteNo();

			BasSte basSte = basSteService.selectById(steNo);
			if (Cools.isEmpty(steProtocol, basSte)) { return; }
			if (steProtocol.getMode() == 0
			\|\| !steProtocol.statusType.equals(SteStatusType.IDLE)
			\|\| basSte.getPakMk().equals("Y")
			\|\| basSte.getAutoCharge().equals("N")
			// \|\| steProtocol.getChargeStatus() == 1
			) {
			return;
			}
			if (!steProtocol.isEnable()) {
			return;
			}
			if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())+40) {
			MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 999));//中断充电标记
			wrkCharge.setWrkSts(30L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 29.开始充电 ===>> 30.完成充电失败！！，工作号={}", wrkCharge.getWrkNo());
			}else {
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkCharge.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.CLOSE_CHARGE); // 任务模式: 断开充电
			if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			}
			}
			return;
			}else if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine()) && steProtocol.getChargeStatus()==(short)0 && steProtocol.isBrushConnect()) {
			MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 999));//中断充电标记
			wrkCharge.setWrkSts(30L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 29.开始充电 ===>> 30.完成充电失败！！，工作号={}", wrkCharge.getWrkNo());
			}else {
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkCharge.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.CLOSE_CHARGE); // 任务模式: 断开充电
			if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			}
			}
			return;
			}
			try {
			// filter
			if (wrkCharge.getWrkSts() < 28 && steProtocol.getChargeStatus() == 1) {
			return;
			}

			// 22.小车待搬
			if (wrkCharge.getWrkSts() == 22) {

			// 入出库任务优先
			if (null != wrkMastMapper.selectWorkingByCrn(wrkCharge.getCrnNo())) {
			return;
			}

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

			// 搬小车至小车走向通道
			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(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());
			// 修改工作档状态 22.小车待搬 => 23.吊车搬运
			Date now = new Date();
			wrkCharge.setWrkSts(23L);
			wrkCharge.setCrnStrTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改工作档状态 22.小车待搬 => 23.吊车搬运失败！！，工作号={}", wrkCharge.getWrkNo());
			if (shuttleCharge == null) {
			//同楼层没有找到充电桩，找可用充电桩
			//小车同楼层没有充电桩，只要充电桩可用就生成充电任务
			for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
			if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
			//判断当前充电桩楼层是否有小车，如有小车，不分配该充电桩
			int chargeLev = Utils.getLev(chargeType.locNo);//充电桩楼层
			boolean checkLevHasShuttle = Utils.checkLevHasShuttle(chargeLev);//检测楼层是否有穿梭车
			if (checkLevHasShuttle) {
			//当前充电桩楼层有穿梭车，不分配该充电桩
			continue;
			}
			}
			}

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

			steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).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 {
			// 修改工作档状态 24.小车到达 ===> 25.小车走行
			wrkCharge.setWrkSts(25L);
			Date now = new Date();
			wrkCharge.setCrnEndTime(now);
			wrkCharge.setModiTime(now);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 24.小车到达 ===> 25.小车走行失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			}
			} else if (wrkCharge.getWrkSts() == 26) {
			//26.等待充电 ===>
			// 穿梭车下发充电任务
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkCharge.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.CHARGE_LEFT); // 任务模式: 充电
			if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			} else {
			// 28.充电就绪 ===>> 29.开始充电
			wrkCharge.setWrkSts(29L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 28.充电就绪 ===>> 29.开始充电失败！！，工作号={}", wrkCharge.getWrkNo());
			}
			}
			} else if (wrkCharge.getWrkSts() == 29) {
			Float idle2 = steProtocol.isIdle2();
			String chargeLine = SpringUtils.getBean(BasSteService.class).selectById(1).getChargeLine();
			if (idle2<(Float.parseFloat(chargeLine)+2)){
			MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 666));//充电标记
			}else if (idle2 >= 100f){
			MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 999));//中断充电标记
			// 29.开始充电 ===>> 30.完成充电
			wrkCharge.setWrkSts(30L);
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改充电任务状态 29.开始充电 ===>> 30.完成充电失败！！，工作号={}", wrkCharge.getWrkNo());
			}else {
			SteCommand steCommand = new SteCommand();
			steCommand.setSteNo(wrkCharge.getSteNo()); // 穿梭车编号
			steCommand.setTaskNo(wrkCharge.getWrkNo()); // 工作号
			steCommand.setTaskMode(SteTaskModeType.CLOSE_CHARGE); // 任务模式: 断开充电
			if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
			News.error("穿梭车命令下发失败，穿梭车号={}，任务数据={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
			}
			}
			}
			}
			} catch (Exception e) {
			News.error("executeSteCharge fail", e);
			}
			}

			/**
			* 轮询充电桩是否有空闲小车
			*/
			@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;
			}

			WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset);

			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 {
			shuttleCharge = chargeType;
			break;
			}
			}
			}
			}
			}

			/**
			* 小车从充电桩至待机库位
			*/
			@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());
			}
			}
			}

			}
			}
			}


			/**
			* 因双深库位阻塞，对浅库位进行移转（出库版)
			* tip：同步
			*/
			private void moveLocForDeepLoc(CrnSlave crn, LocMast shallowLoc){
			try {
			List<Integer> rows = locMastService.queryDistinctRow(crn.getId());
			LocMast loc = null;
			for (Integer row : rows) {
			if (Utils.isDeepLoc(slaveProperties, row)) {
			loc = locMastService.queryFreeLocMast(row, shallowLoc.getLocType1());

			if (loc != null) {
			if (Utils.isDeepLoc(slaveProperties, loc.getLocNo())) {
			String shallowLocNo = Utils.getShallowLoc(slaveProperties, loc.getLocNo());
			LocMast shallowLoc1 = locMastService.selectById(shallowLocNo);
			if (!shallowLoc1.getLocSts().equals("O")) {
			loc = null;
			}
			}
			}

			if (null != loc) {
			break;
			}
			}
			}
			if (null == loc) {
			for (Integer row : rows) {
			if (Utils.isShallowLoc(slaveProperties, row)) {
			loc = locMastService.queryFreeLocMast(row, shallowLoc.getLocType1());

			if (null != loc) {//对应深库位非在库状态,不能移库
			String deepLoc = Utils.getDeepLoc(slaveProperties, loc.getLocNo());
			LocMast deepLoc1 = locMastService.selectById(deepLoc);
			if (!deepLoc1.getLocSts().equals("F") && !deepLoc1.getLocSts().equals("D")) {
			loc = null;
			}
			}

			if (null != loc) {
			break;
			}
			}
			}
			}
			if (null == loc) {
			News.error("双深库位 --- 浅库位阻塞异常！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("双深库位 --- 浅库位阻塞异常！待移转浅库位：" + shallowLoc.getLocNo());
			}

			// 获取工作号
			int workNo = commonService.getWorkNo(0);
			// 保存工作档
			WrkMast wrkMast = new WrkMast();
			wrkMast.setWrkNo(workNo);
			wrkMast.setIoTime(new Date());
			wrkMast.setWrkSts(11L); // 工作状态：11.生成出库ID
			wrkMast.setIoType(11); // 入出库状态： 11.库格移载
			wrkMast.setIoPri(20D);
			wrkMast.setCrnNo(crn.getId());
			wrkMast.setSourceLocNo(shallowLoc.getLocNo()); // 源库位
			wrkMast.setLocNo(loc.getLocNo()); // 目标库位
			wrkMast.setFullPlt(shallowLoc.getFullPlt()); // 满板
			wrkMast.setPicking("N"); // 拣料
			wrkMast.setExitMk("N"); // 退出
			wrkMast.setEmptyMk(shallowLoc.getLocSts().equals("D") ? "Y" : "N"); // 空板
			wrkMast.setBarcode(shallowLoc.getBarcode()); // 托盘码
			wrkMast.setLinkMis("N");
			wrkMast.setAppeTime(new Date());
			wrkMast.setModiTime(new Date());
			int res = wrkMastMapper.insert(wrkMast);
			if (res == 0) {
			News.error("双深库位 --- 保存工作档失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("保存工作档失败");
			}
			// 工作档明细保存
			if (shallowLoc.getLocSts().equals("F")) {
			List<LocDetl> locDetls = locDetlService.selectList(new EntityWrapper<LocDetl>().eq("loc_no", shallowLoc.getLocNo()));
			for (LocDetl locDetl : locDetls) {
			WrkDetl wrkDetl = new WrkDetl();
			wrkDetl.sync(locDetl);
			wrkDetl.setWrkNo(workNo);
			wrkDetl.setIoTime(new Date());
			wrkDetl.setAnfme(locDetl.getAnfme());
			wrkDetl.setAppeTime(new Date());
			wrkDetl.setModiTime(new Date());
			if (!wrkDetlService.insert(wrkDetl)) {
			News.error("双深库位 --- 保存工作档明细失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("保存工作档明细失败");
			}
			}
			}
			// 修改源库位状态
			if (shallowLoc.getLocSts().equals("D") \|\| shallowLoc.getLocSts().equals("F")) {
			shallowLoc.setLocSts("R"); // R.出库预约
			shallowLoc.setModiTime(new Date());
			if (!locMastService.updateById(shallowLoc)) {
			News.error("双深库位 --- 更新源库位状态失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("更新源库位状态失败");
			}
			} else {
			News.error("双深库位 --- 源库位出库失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("源库位出库失败");
			}
			// 修改目标库位状态
			if (loc.getLocSts().equals("O")) {
			loc.setLocSts("S"); // S.入库预约
			loc.setModiTime(new Date());
			if (!locMastService.updateById(loc)) {
			News.error("双深库位 --- 更新目标库位状态失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("更新目标库位状态失败");
			}
			} else {
			News.error("双深库位 --- 移转失败！待移转浅库位：" + shallowLoc.getLocNo());
			throw new CoolException("移转失败");
			}
			} catch (Exception e) {
			News.error("双深库位阻塞，对浅库位进行移转失败", e);
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			}

			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) {
			if (shuttleCharge == 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);
			}
			}
			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;
			}

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

			/**
			* 演示取货
			* 执行四向穿梭车充电任务
			*/
			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);
			public synchronized void executeShuttleCharge() {
			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;
			}

			if (wrkCharge.getWrkSts() == 51) {
			if (!shuttleProtocol.isIdleNoCharge()) {
			continue;
			}

			if (!shuttleProtocol.getCurrentLocNo().equals(wrkCharge.getLocNo())) {
			//小车不在充电桩位置
			shuttleDispatchUtils.dispatchShuttle(wrkCharge.getWrkNo(), wrkCharge.getLocNo(), shuttle.getId());//调度小车去充电桩
			continue;
			}

			//小车已经在充电桩位置，下发充电命令
			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.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(commands);//运行命令

			wrkCharge.setWrkSts(52L);//51.生成充电任务 => 52.小车去充电中
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务{}工作档 31.生成演示ID ==>> 32.小车走行失败!", wrkCharge.getWrkNo());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			// 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());
			} else if (wrkCharge.getWrkSts() == 52) {
			//检测小车是否满电
			int maxPower = 95;
			if (shuttleProtocol.getPowerPercent() < maxPower) {
			continue;
			}

			//小车满电，结束充电任务
			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.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
			assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
			assignCommand.setCommands(commands);//运行命令

			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			try {
			Thread.sleep(3000);
			} catch (Exception e) {
			e.printStackTrace();
			}

			wrkCharge.setWrkSts(53L);//52.小车去充电中 => 53.小车充电完成
			wrkCharge.setModiTime(new Date());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE.id);
			shuttleProtocol.setTaskNo(0);
			shuttleProtocol.setPakMk(false);
			}
			} else if (wrkCharge.getWrkSts() == 53) {
			if (shuttleProtocol.getChargState() == 0) {//小车处于未充电状态
			boolean result = Utils.searchEmptyGroupToMoveShuttle(Utils.getLev(wrkCharge.getLocNo()), shuttleThread.getSlave().getId(), shuttleThread);
			if (!result) {
			continue;
			}
			}
			// 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.setWrkSts(60L);//53.小车充电完成 => 60.充电任务完成
			wrkCharge.setModiTime(new Date());
			if (!wrkChargeService.updateById(wrkCharge)) {
			News.error("修改演示任务{}工作档 35.小车就绪 => 36.小车走行失败!", wrkCharge.getWrkNo());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {

			}
			}
			}

			}

			}

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

			boolean stepIntoLift = this.shuttleMoveExecuteStepIntoLift(wrkMast);//小车迁入提升机
			if (!stepIntoLift) {
			continue;
			}

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

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

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

			// this.shuttleMoveExecuteStepClearWrkMast(wrkMast);//清理111.小车移动完成

			}
			}

			/**
			* 小车迁移-小车移动到站点
			* 如需主方法执行continue，请返回false
			* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
			*/
			private boolean shuttleMoveExecuteStepMoveSta(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(wrkMast.getWrkNo())) {
			return false;
			}

			//判断小车令牌是否未被占领
			if (shuttleProtocol.getToken() != 0) {
			return false;//小车已被独占，禁止再派发任务
			}

			if (Utils.getLev(wrkMast.getLocNo()) == shuttleProtocol.getPoint().getZ()) {
			//目标库位和小车库位处于同一楼层，不需要通过提升机调度
			wrkMast.setWrkSts(109L);// 109.小车迁出提升机完成 ==> 110.小车移动中
			wrkMast.setModiTime(now);
			shuttleProtocol.setToken(wrkMast.getWrkNo());//独占该小车令牌
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			return true;//直接进入109.小车迁出提升机完成 ==> 110.小车移动中
			}
			return false;
			}

			//获取源输送站
			LiftStaProtocol liftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
			if (liftSta == null) {
			return false;//找不到站点
			}

			//判断提升机是否有其他任务(该任务需要换层必须提前独占提升机)
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftSta.getLiftNo());
			if (liftWrkMast != null) {
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}

			//获取小车到输送站点行走命令
			NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), liftSta.getLocNo(), NavigationMapType.NORMAL.id);
			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(102L);//小车移动到提升机中 101.生成小车移库任务 ==> 102.小车移动至站点
			wrkMast.setModiTime(now);
			wrkMast.setLiftNo(liftSta.getLiftNo());//提前锁定提升机
			shuttleProtocol.setToken(wrkMast.getWrkNo());//独占该小车令牌
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			return false;
			}
			return false;
			}
			return true;
			}

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

			//小车移动到提升机中 103.小车移动至站点完成 ==> 104.小车迁入提升机中
			if (wrkMast.getWrkSts() == 103) {
			//获取源站
			LiftStaProtocol sourceLiftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
			if (sourceLiftSta == null) {
			return false;//找不到站点
			}

			//获取目标输送站
			LiftStaProtocol liftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
			if (liftSta == null) {
			return false;//找不到站点
			}

			//获取提升机数据
			BasLift basLift = basLiftService.selectById(liftSta.getLiftNo());
			if (basLift == null) {
			return false;//没有提升机数据
			}

			if (basLift.getPoint() == null) {
			return false;//没有设置提升机点位坐标
			}

			//判断提升机是否有其他任务
			WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(basLift.getLiftNo());
			if (liftWrkMast != null) {
			if (!liftWrkMast.getWrkNo().equals(wrkMast.getWrkNo())) {//提升机任务和当前任务不相同
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}
			}

			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSta.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(wrkMast.getWrkNo())) {
			return false;
			}

			//小车令牌是否被任务独占
			if (!shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			return false;
			}

			//判断提升机楼层
			if (liftProtocol.getLev().intValue() != shuttleProtocol.getPoint().getZ()) {
			//提升机不在小车楼层
			//调度提升机

			if (liftProtocol.getToken() != 0) {
			return false;//提升机令牌被占用
			}

			//获取提升机命令，调度提升机到源站位置
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceLiftSta.getStaNo(), sourceLiftSta.getStaNo(), wrkMast.getWrkNo());

			Random random = new Random();
			int deviceWrk = Math.abs((liftCommand.getTaskNo().intValue() + random.nextInt(9999)));//获取设备工作号
			liftCommand.setTaskNo((short) deviceWrk);//更换随机任务号

			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_CAR.id.shortValue());
			assignCommand.setAuto(false);

			wrkMast.setLiftNo(liftThread.getSlave().getId());//锁定提升机防止被占用
			wrkMast.setModiTime(now);
			liftProtocol.setToken(wrkMast.getShuttleNo());//提升机令牌绑定当前小车
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}
			return false;//等待提升机到小车楼层
			}

			if (liftProtocol.getToken() == 0) {//提升机令牌未被占用
			//独占提升机
			liftProtocol.setToken(wrkMast.getShuttleNo());
			return false;//等待下一次执行
			}

			//判断提升机令牌是否为当前小车
			if (!liftProtocol.getToken().equals(wrkMast.getShuttleNo())) {
			return false;//提升机已被独占，禁止再派发任务
			}

			//判断小车是否为当前任务独占
			if (!shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			return false;
			}

			//站点节点
			NavigateNode staNode = NavigatePositionConvert.locNoToNode(sourceLiftSta.getLocNo());

			//提升机节点
			NavigateNode liftNode = new NavigateNode(basLift.getPoint$().getX(), basLift.getPoint$().getY());
			liftNode.setZ(staNode.getZ());

			//获取小车进提升机行走命令
			NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), staNode, liftNode, true);
			List<NyShuttleHttpCommand> commands = new ArrayList<>();
			commands.add(moveCommand);
			List<NavigateNode> nodes = new ArrayList<>();//行走节点路径
			nodes.add(staNode);
			nodes.add(liftNode);

			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(nodes);

			wrkMast.setWrkSts(104L);//小车移动到提升机中 103.小车移动至站点完成 ==> 104.小车迁入提升机中
			wrkMast.setModiTime(now);
			wrkMast.setLiftNo(liftThread.getSlave().getId());//锁定提升机防止被占用
			liftProtocol.setToken(wrkMast.getShuttleNo());//提升机令牌绑定当前小车
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			return false;
			}
			return false;
			}

			return true;
			}

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

			//提升机搬运中 105.小车迁入提升机完成 ==> 106.提升机搬运中
			if (wrkMast.getWrkSts() == 105) {

			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) {
			if (!liftWrkMast.getWrkNo().equals(wrkMast.getWrkNo())) {//提升机任务和当前任务不相同
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}
			}

			//判断提升机令牌是否为当前小车
			if (!liftProtocol.getToken().equals(wrkMast.getShuttleNo())) {
			return false;//提升机令牌和当前小车不一致，禁止派发
			}

			//判断提升机内是否有小车
			if (!liftProtocol.getHasCar()) {
			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;
			}

			//判断小车是否为当前任务独占
			if (!shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			return false;
			}

			//获取源站
			LiftStaProtocol sourceLiftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
			//获取目标站
			LiftStaProtocol liftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
			if (sourceLiftSta == null \|\| liftSta == null) {
			return false;//缺少站点信息
			}

			//获取提升机命令
			NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceLiftSta.getStaNo(), liftSta.getStaNo(), 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_CAR.id.shortValue());

			wrkMast.setWrkSts(106L);//提升机搬运中 105.小车迁入提升机完成 ==> 106.提升机搬运中
			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 true;
			}

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

			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) {
			if (!liftWrkMast.getWrkNo().equals(wrkMast.getWrkNo())) {//提升机任务和当前任务不相同
			return false;//当前提升机存在未完成任务，等待下一次轮询
			}
			}

			//判断提升机令牌是否为当前小车
			if (!liftProtocol.getToken().equals(wrkMast.getShuttleNo())) {
			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;
			}

			//判断小车是否为当前任务独占
			if (!shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			return false;
			}

			//获取目标站
			LiftStaProtocol liftSta = NyLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
			if (liftSta == null) {
			return false;//找不到站点
			}

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

			List<NyShuttleHttpCommand> commands = new ArrayList<>();
			//获取小车更新楼层命令
			NyShuttleHttpCommand updateZCommand = NyHttpUtils.getUpdateZCommand(shuttleThread.getSlave().getId(), liftProtocol.getLev().intValue(), wrkMast.getWrkNo());
			commands.add(updateZCommand);

			//获取小车出提升机行走命令
			NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), liftNode, NavigatePositionConvert.locNoToNode(liftSta.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(108L);//小车迁出提升机中 107.提升机搬运完成 ==> 108.小车迁出提升机中
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			return false;
			}
			return false;
			}
			return true;
			}

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

			//小车移动到目标库位中 109.小车迁出提升机完成 ==> 110.小车移动中
			if (wrkMast.getWrkSts() == 109) {

			//获取四向穿梭车线程
			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(wrkMast.getWrkNo())) {
			return false;
			}

			//判断小车令牌是否为当前任务
			if (shuttleProtocol.getToken() != 0 && !shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			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());

			//小车已经在目标库位，直接认定小车移动任务完成
			if (shuttleProtocol.getCurrentLocNo().equals(wrkMast.getLocNo())) {
			if (shuttleProtocol.getToken().equals(wrkMast.getWrkNo())) {
			//释放小车令牌
			shuttleProtocol.setToken(0);
			}
			wrkMast.setWrkSts(111L);//111.小车移动完成
			wrkMast.setLiftNo(null);//释放提升机
			wrkMast.setModiTime(now);
			wrkMastMapper.updateById(wrkMast);

			shuttleProtocol.setShuttleNo((short) 0);//释放小车
			shuttleProtocol.setToken(0);//释放小车

			if (wrkMast.getWrkSts() == 111) {
			// 保存工作主档历史档
			if (wrkMastLocMapper.save(wrkMast.getWrkNo()) <= 0) {
			log.info("保存工作历史档[workNo={0}]失败", wrkMast.getWrkNo());
			}
			// 删除工作主档
			if (!wrkMastService.deleteById(wrkMast)) {
			log.info("删除工作主档[workNo={0}]失败", wrkMast.getWrkNo());
			}
			}
			return false;
			}

			//获取小车到目标库位命令
			NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getLocNo(), NavigationMapType.NORMAL.id);
			if (result == 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());
			assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位
			assignCommand.setLocNo(wrkMast.getLocNo());//目标库位

			if (wrkMast.getLiftNo() != null) {
			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.getToken().equals(shuttleProtocol.getShuttleNo().intValue())) {
			liftProtocol.setToken(0);//释放提升机令牌
			}
			}

			wrkMast.setWrkSts(110L);//小车移动到目标库位中 109.小车迁出提升机完成 ==> 110.小车移动中
			wrkMast.setLiftNo(null);//释放提升机
			wrkMast.setModiTime(now);

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

			/**
			* 小车迁移-清理111.小车移动完成
			*/
			private boolean shuttleMoveExecuteStepClearWrkMast(WrkMast wrkMast) {
			if (wrkMast.getWrkSts() == 111) {
			//获取四向穿梭车线程
			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(wrkMast.getWrkNo())) {
			return false;
			}

			Object o = redisUtil.get("shuttle_wrk_no_" + shuttleProtocol.getTaskNo());
			if (o != null) {
			ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class);
			ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand();
			int size = assignCommand.getCommands().size();
			NyShuttleHttpCommand command = assignCommand.getCommands().get(size - 1);//获取最后一段命令
			if (!command.getComplete()) {
			return false;//最后一段命令还未完成，不做操作
			}
			NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(shuttleProtocol.getCurrentLocNo()));
			navigateMapData.writeNavigateNodeToRedisMap(assignCommand.getNodes(), false);//解锁路径

			//删除redis
			redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo());
			}

			// 保存工作主档历史档
			if (wrkMastLocMapper.save(wrkMast.getWrkNo()) <= 0) {
			log.info("保存工作历史档[workNo={0}]失败", wrkMast.getWrkNo());
			}
			// 删除工作主档
			if (!wrkMastService.deleteById(wrkMast)) {
			log.info("删除工作主档[workNo={0}]失败", wrkMast.getWrkNo());
			}

			//设置四向穿梭车为空闲状态
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
			//源库位清零
			shuttleProtocol.setSourceLocNo(null);
			//目标库位清零
			shuttleProtocol.setLocNo(null);
			//任务指令清零
			shuttleProtocol.setAssignCommand(null);
			//工作号清零
			shuttleProtocol.setTaskNo(0);
			//清除令牌
			shuttleProtocol.setToken(0);
			News.info("四向穿梭车已确认且移动任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
			}

			return true;
			}

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