zy-wcs.git - Gitblit

			@@ -10,15 +10,11 @@
			import com.zy.asrs.mapper.*;
			import com.zy.asrs.service.*;
			import com.zy.asrs.utils.Utils;
			import com.zy.common.model.LocTypeDto;
			import com.zy.common.model.MatDto;
			import com.zy.common.model.SearchLocParam;
			import com.zy.common.model.StartupDto;
			import com.zy.common.model.*;
			import com.zy.common.model.enums.WrkChargeType;
			import com.zy.common.service.CommonService;
			import com.zy.common.service.erp.ErpService;
			import com.zy.common.utils.CollectionUtils;
			import com.zy.common.utils.HttpHandler;
			import com.zy.common.utils.*;
			import com.zy.core.CrnThread;
			import com.zy.core.DevpThread;
			import com.zy.core.News;
			@@ -26,17 +22,10 @@
			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.SteCommand;
			import com.zy.core.model.protocol.CrnProtocol;
			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.BarcodeThread;
			import com.zy.core.thread.LedThread;
			import com.zy.core.thread.SiemensDevpThread;
			import com.zy.core.thread.SteThread;
			import com.zy.core.thread.*;
			import lombok.extern.slf4j.Slf4j;
			import org.springframework.beans.factory.annotation.Autowired;
			import org.springframework.beans.factory.annotation.Value;
			@@ -79,6 +68,10 @@
			@Autowired
			private BasSteErrLogService basSteErrLogService;
			@Autowired
			private BasShuttleErrLogService basShuttleErrLogService;
			@Autowired
			private BasShuttleErrService basShuttleErrService;
			@Autowired
			private BasCrnErrorMapper basCrnErrorMapper;
			@Autowired
			private BasSteService basSteService;
			@@ -91,11 +84,15 @@
			@Autowired
			private WrkChargeMapper wrkChargeMapper;
			@Autowired
			private BasMapService basMapService;
			@Autowired
			private ErpService erpService;
			@Autowired
			private OrderMapper orderMapper;
			@Autowired
			private OrderDetlMapper orderDetlMapper;
			@Autowired
			private RedisUtil redisUtil;

			/**
			* 组托
			@@ -115,57 +112,51 @@
			staProtocol = staProtocol.clone();
			}
			Short workNo = staProtocol.getWorkNo();
			// 尺寸检测异常
			boolean back = false;
			String errMsg = "异常：";
			if (staProtocol.isFrontErr()) {
			errMsg = errMsg+"前超限；";
			back = true;
			}
			if (staProtocol.isBackErr()) {
			errMsg = errMsg+"后超限";
			back = true;
			}
			if (staProtocol.isHighErr()) {
			errMsg = errMsg+"高超限";
			back = true;
			}
			if (staProtocol.isLeftErr()) {
			errMsg = errMsg+"左超限";
			back = true;
			}
			if (staProtocol.isRightErr()) {
			errMsg = errMsg+"右超限";
			back = true;
			}
			if (staProtocol.isWeightErr()) {
			errMsg = errMsg+"超重";
			back = true;
			}
			if (staProtocol.isBarcodeErr()) {
			errMsg = errMsg+"扫码失败";
			back = true;
			}
			// 退回
			if (back) {
			// led 异常显示
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
			if (ledThread != null) {
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
			}
			continue;
			}
			// 判断是否满足入库条件
			if (staProtocol.isAutoing() && staProtocol.isLoading()
			&& staProtocol.isInEnable()
			&& !staProtocol.isEmptyMk() && (workNo == 0 \|\| (workNo >= 9990 && workNo <= 9999))
			&& staProtocol.isPakMk()) {
			// 尺寸检测异常
			boolean back = false;
			String errMsg = "异常：";
			if (staProtocol.isFrontErr()) {
			errMsg = errMsg+"前超限；";
			back = true;
			}
			if (staProtocol.isBackErr()) {
			errMsg = errMsg+"后超限";
			back = true;
			}
			if (staProtocol.isHighErr()) {
			errMsg = errMsg+"高超限";
			back = true;
			}
			if (staProtocol.isLeftErr()) {
			errMsg = errMsg+"左超限";
			back = true;
			}
			if (staProtocol.isRightErr()) {
			errMsg = errMsg+"右超限";
			back = true;
			}
			if (staProtocol.isWeightErr()) {
			errMsg = errMsg+"超重";
			back = true;
			}
			if (staProtocol.isBarcodeErr()) {
			errMsg = errMsg+"扫码失败";
			back = true;
			}
			// 退回
			if (back) {
			News.warn("扫码入库失败，{}入库站因{}异常，托盘已被退回", inSta.getStaNo(), errMsg);
			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());
			if (ledThread != null) {
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
			}
			continue;
			}

			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
			@@ -555,612 +546,838 @@
			}

			/**
			* 堆垛机站出库到出库站
			* 初始化实时地图
			*/
			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());
			public synchronized void initRealtimeBasMap() {
			for (int i = 1; i <= 4; 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);//获取完整地图(包括入库出库)

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

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

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

			/**
			* 从redis中重启任务
			*/
			public synchronized void restartTaskFromRedis() {
			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.isIdle()) {
			continue;
			}

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

			}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();
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo.intValue());
			if (shuttleThread == null) {
			continue;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (!shuttleProtocol.isIdle()) {
			continue;
			}

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

			}

			/**
			* 入库 ===>> 四向穿梭车入库作业下发
			*/
			public synchronized void shuttleIoInExecute() {
			// 根据输送线plc遍历
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历入库站
			for (DevpSlave.StaRack rackInStn : devp.getRackInStn()) {
			// 获取入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());

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

			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			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) {
			Short workNo = staProtocol.getWorkNo();

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

			// 下发站点信息
			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());
			}

			}

			}
			}
			}
			}

			/**
			* 入出库 ===>> 堆垛机入出库作业下发
			*/
			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;
			}

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

			}

			// 目标库位 ===>> 非最外层库位
			} 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) {
			if (shuttleThread == 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;

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

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

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

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

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

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

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

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

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

			}
			// 没有小车
			} 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;
			}
			}

			}
			}

			}

			//获取起点-终点指令。mapType：1=》无货地图，2=》有货地图
			public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String locNo, Integer mapType, ShuttleAssignCommand assignCommand, ShuttleThread shuttleThread) {
			//计算小车起点到中点所需命令
			List<NavigateNode> calc = NavigateUtils.calc(startLocNo, locNo, mapType);
			List<ShuttleCommand> commands = new ArrayList<>();
			if (calc == null) {
			return null;
			}

			List<NavigateNode> allNode = new ArrayList<>();
			allNode.addAll(calc);

			//获取分段路径
			ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc);
			//将每一段路径分成command指令
			for (ArrayList<NavigateNode> nodes : data) {
			//开始路径
			NavigateNode startPath = nodes.get(0);
			//目标路径
			NavigateNode endPath = nodes.get(nodes.size() - 1);
			Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//计算当前路径行走总距离
			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			//获取移动命令
			ShuttleCommand command = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id);
			commands.add(command);
			}

			assignCommand.setNodes(allNode);//当前任务所占用的节点list
			//所使用的路径进行锁定禁用
			NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(startLocNo));
			navigateMapData.writeNavigateNodeToRedisMap(allNode, true);////所使用的路径进行锁定禁用

			return commands;
			}

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

			List<NavigateNode> allNode = new ArrayList<>();
			allNode.addAll(calc);

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

			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			//获取移动命令
			ShuttleCommand command = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id);
			commands.add(command);
			}

			//小车指令到达目标位置后，再发出一条顶升指令
			commands.add(shuttleThread.getPalletCommand((short) 1));

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

			allNode.addAll(calc2);

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

			//通过xy坐标小车二维码
			Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());
			//通过xy坐标小车二维码
			Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());
			ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id);
			commands.add(moveCommand);
			}

			//小车指令到达目标位置后，再发出一条托盘下降指令
			commands.add(shuttleThread.getPalletCommand((short) 2));

			assignCommand.setNodes(allNode);//当前任务所占用的节点list
			//所使用的路径进行锁定禁用
			NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(startLocNo));
			navigateMapData.writeNavigateNodeToRedisMap(allNode, true);////所使用的路径进行锁定禁用

			return commands;
			}

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

			}

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

			if (shuttleThread == null) {
			continue;
			}

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

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

			if (outStaLocNo == null) {
			continue;
			}

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

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

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

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

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

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

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

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

			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}
			}
			}
			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());
			public HashMap<String,Object> searchIdleShuttle(WrkMast wrkMast) {
			HashMap<String, Object> map = new HashMap<>();
			String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();//库位号
			LocMast locMast = locMastService.queryByLoc(locNo);//找到库位记录
			String lay = locNo.substring(locNo.length() - 2, locNo.length());//当前工作档库位层高
			ShuttleThread recentShuttle = null;//当前距离最近的四向穿梭车线程

			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}
			if (!shuttleProtocol.isIdle()) {
			continue;
			}

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

			//更新当前最近的四向穿梭车
			if (recentShuttle == null) {
			recentShuttle = shuttleThread;
			}else {
			ShuttleProtocol recentShuttleProtocol = recentShuttle.getShuttleProtocol();//目前最近穿梭车
			String recentShuttleLocNo = recentShuttleProtocol.getCurrentLocNo();//二维码对应库位号
			String recentShuttleLocNoLay = recentShuttleLocNo.substring(recentShuttleLocNo.length() - 2, recentShuttleLocNo.length());//库位号对应层高

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

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

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

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

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

			/**
			* 四向穿梭车任务完成
			*/
			public synchronized void shuttleFinished() {
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车信息
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			//四向穿梭车状态为等待确认
			if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id //任务完成等待确认
			&& shuttleProtocol.getTaskNo() != 0) {
			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 9://9.小车入库搬运中 ==> 14.入库完成
			wrkMast.setWrkSts(14L);
			break;
			case 5://5.迁移小车至提升机口 ==> 6.迁移小车至提升机口完成
			wrkMast.setWrkSts(6L);
			break;
			case 22://22.迁移小车至提升机口 ==> 23.迁移小车至提升机口完成
			wrkMast.setWrkSts(23L);
			break;
			case 26://26.小车出库搬运中 ==> 27.小车出库搬运完成
			wrkMast.setWrkSts(27L);
			break;
			default:
			}

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

			}

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

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

			}
			}

			/**
			* 提升机任务
			*/
			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 (!liftProtocol.isIdle()) {
			continue;
			}

			//搜索是否有待处理的任务
			WrkMast wrkMast = wrkMastMapper.selectLiftStep262327();
			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<String> groupLocNo = Utils.getGroupLocNo(wrkMast.getSourceLocNo());
			if (!Cools.isEmpty(groupLocNo)) {
			if (null != wrkMastMapper.selectPakinWorkingByGroupLoc(groupLocNo)) {
			//给提升机分配任务
			liftProtocol.setLiftLock(true);//锁定提升机
			liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//设置任务号
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//设置提升机状态为工作中

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

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

			//提升机当前楼层
			int liftLev = liftProtocol.getLev().intValue();
			if (liftLev != 1) {
			//提升机不在1层，获取到1层的提升机命令
			LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), (short) 1);
			commands.add(command1);//将命令添加进list
			}

			//输送线将货物运进来(正转)
			LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
			commands.add(command2);//将命令添加进list

			//提升机前往目标楼层(工作档目标楼层)
			LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), (short) wrkMastLocNoLey);
			commands.add(command3);//将命令添加进list

			//提升机到达指定楼层，输送线将货物移出去(反转)
			//输送线将货物移出去
			LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
			commands.add(command4);//将命令添加进list
			}else {
			liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//设置四向穿梭车号

			//找到四向穿梭车的线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
			if (shuttleThread == null) {
			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) {
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}

			// 过滤
			if (null != wrkMastMapper.selectPakin(slave.getId(), null)) {
			News.error("{}出库任务无法作业，因存在入库中任务!", wrkMast.getWrkNo());
			continue;
			//当前穿梭车库位号
			String currentLocNo = shuttleProtocol.getCurrentLocNo();
			//当前穿梭车楼层
			int currentLocNoLey = Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));

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

			//提升机当前楼层
			int liftLev = liftProtocol.getLev().intValue();
			if (liftLev != currentLocNoLey) {
			//不同楼层
			//获取目标楼层(穿梭车所在楼层)命令
			LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), (short) currentLocNoLey);
			commands.add(command1);//将命令添加进list
			}

			// 置顶任务
			if (wrkMast.getIoPri()<8000){
			wrkMast.setIoPri(wrkMast.getIoPri()+8999d);
			//输送线将四向穿梭车移动进来(正转)
			LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
			commands.add(command2);//将命令添加进list

			if (liftLev != currentLocNoLey) {
			//提升机前往目标楼层(工作档目标楼层)
			LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), (short) wrkMastLocNoLey);
			commands.add(command3);//将命令添加进list
			}
			wrkMastMapper.updateById(wrkMast);

			// 最外层库位，直接堆垛机出库
			if (locMastService.isOutMost(wrkMast.getSourceLocNo(), false)) {
			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			continue;
			}
			//提升机到达指定楼层，输送线将四向穿梭车移出去
			//输送线将四向穿梭车移动出去(反转)
			LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
			commands.add(command4);//将命令添加进list
			}

			// 堆垛机出库命令下发区 --------------------------------------------------------------------------
			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));
			} 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;
			}
			}
			// 不是最外层库位，需要使用穿梭车搬运后，再堆垛机出库
			} else {
			// 当前组库位是否有穿梭车
			Integer steNo = this.hasCarOfIdle(wrkMast.getSourceLocNo());
			// 有小车
			if (steNo != null) {
			if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 2://2.设备上走
			wrkMast.setWrkSts(3L);//3.提升机搬运中
			break;//3.提升机搬运中
			case 6://6.迁移小车至提升机口完成
			wrkMast.setWrkSts(7L);//7.提升机迁移小车中
			break;
			case 23://23.迁移小车至提升机口完成
			wrkMast.setWrkSts(24L);//24.提升机迁移小车中
			break;
			case 27://27.小车出库搬运完成
			wrkMast.setWrkSts(28L);//28.提升机搬运中
			break;
			}

			// 给穿梭车下发命令让其将货物挪至堆垛机搬运点
			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());

			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 (wrkMast.getWrkSts() == 15L) {
			// 已经存在吊车执行任务时，则过滤
			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(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;
			}
			}
			}

			// 没有小车
			} 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;
			}
			}
			}
			//所需命令组合完毕，更新数据库，提交到线程去工作
			LiftAssignCommand assignCommand = new LiftAssignCommand();
			assignCommand.setCommands(commands);
			assignCommand.setLiftNo(liftProtocol.getLiftNo());
			assignCommand.setTaskNo(liftProtocol.getTaskNo());
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}
			}
			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")) {
			return;
			}
			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 (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			return;
			}
			//提升机为等待确认
			if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id && liftProtocol.getTaskNo() != 0) {
			//将任务档标记为完成
			WrkMast wrkMast = wrkMastMapper.selectByWorkNo372428(liftProtocol.getTaskNo().intValue());
			if (wrkMast != null) {
			switch (wrkMast.getWrkSts().intValue()) {
			case 3://3.提升机搬运中 ==> 4.提升机搬运完成
			wrkMast.setWrkSts(4L);
			break;
			case 7://7.提升机迁移小车中 ==> 8.提升机迁移小车完成
			wrkMast.setWrkSts(8L);
			break;
			case 24://24.提升机迁移小车中 ==> 25.提升机迁移小车完成
			wrkMast.setWrkSts(25L);
			break;
			case 28://28.提升机搬运中 ==> 29.提升机搬运完成
			wrkMast.setWrkSts(29L);
			wrkMast.setWrkSts(34L);//34.出库完成，暂时先直接完成出库工作档，后续需要根据输送线给出的状态来确定34.出库完成状态
			break;
			default:
			}

			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			return;
			}
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			//设置提升机为空闲状态
			liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
			//任务号清零
			liftProtocol.setTaskNo((short) 0);
			//标记复位
			liftProtocol.setPakMk(true);
			//任务指令清零
			liftProtocol.setAssignCommand(null);
			//提升机解锁
			liftProtocol.setLiftLock(false);
			News.info("提升机已确认且任务完成状态,复位。提升机号={}", liftProtocol.getLiftNo());
			} else {
			News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
			}
			}

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

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

			}

			/**
			@@ -1446,730 +1663,59 @@
			}

			/**
			* 入出库 ===>> 堆垛机搬入小车
			*/
			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());
			}
			}
			}
			}

			}
			}

			/**
			* 入库 ===>> 堆垛机搬出小车
			*/
			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());
			}
			}
			}
			}
			}


			/**
			* 执行对工作档的完成操作
			*/
			@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());
			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());
			}
			}
			}
			}
			}
			}

			/**
			* 执行对工作档的完成操作
			*/
			public synchronized void carGenerateStore() {
			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;
			}
			}
			}
			}
			}

			/**
			* 异常信息记录
			*/
			public void recErr() {
			try {
			this.recCrnErr();
			this.recSteErr();
			this.recShuttleErr();
			} catch (Exception e) {
			News.error("recErr fail", e);
			}
			}

			/**
			* 堆垛机异常信息记录
			* 四向穿梭车异常信息记录
			*/
			private void recCrnErr(){
			private void recShuttleErr() {
			Date now = new Date();
			for (CrnSlave crn : slaveProperties.getCrn()) {
			for (ShuttleSlave shuttleSlave : slaveProperties.getShuttle()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			if (crnProtocol == null) {
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleSlave.getId());
			if (shuttleThread == null) {
			continue;
			}
			// 有任务
			if (crnProtocol.getTaskNo() != 0) {
			BasErrLog latest = basErrLogService.findLatestByTaskNo(crn.getId(), crnProtocol.getTaskNo().intValue());
			// 有异常
			if (latest == null) {
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			WrkMast wrkMast = wrkMastMapper.selectById(crnProtocol.getTaskNo());
			if (wrkMast == null) {
			continue;
			}
			BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
			String errName = crnError==null? "未知异常":crnError.getErrName();
			BasErrLog basErrLog = new BasErrLog(
			null, // 编号
			wrkMast.getWrkNo(), // 工作号
			now, // 发生时间
			null, // 结束时间
			wrkMast.getWrkSts(), // 工作状态
			wrkMast.getIoType(), // 入出库类型
			crn.getId(), // 堆垛机
			null, // plc
			wrkMast.getLocNo(), // 目标库位
			wrkMast.getStaNo(), // 目标站
			wrkMast.getSourceStaNo(), // 源站
			wrkMast.getSourceLocNo(), // 源库位
			wrkMast.getBarcode(), // 条码
			(int) crnProtocol.getAlarm(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			null, // 添加人员
			now, // 修改时间
			null, // 修改人员
			"任务中异常" // 备注
			);
			if (!basErrLogService.insert(basErrLog)) {
			News.error("堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			}
			}
			} else {
			// 异常修复
			if (crnProtocol.getAlarm() == null \|\| crnProtocol.getAlarm() == 0) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basErrLogService.updateById(latest)) {
			News.error("堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.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());
			}
			}
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}
			}
			}

			/**
			* 穿梭车异常信息记录
			*/
			private void recSteErr(){
			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.getTaskNo() != 0) {
			BasSteErrLog latest = basSteErrLogService.findLatestByTaskNo(ste.getId(), steProtocol.getTaskNo().intValue());
			if (shuttleProtocol.getTaskNo() != 0) {
			//有任务
			BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(shuttleSlave.getId(), shuttleProtocol.getTaskNo().intValue());
			// 有异常
			if (latest == null) {
			if (steProtocol.getAlarm() != null && steProtocol.isAlarm()) {
			WrkMast wrkMast = wrkMastMapper.selectById(steProtocol.getTaskNo());
			if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) {
			WrkMast wrkMast = wrkMastMapper.selectById(shuttleProtocol.getTaskNo());
			if (wrkMast == null) {
			continue;
			}
			BasSteErr steErr = basSteErrService.selectById(steProtocol.getAlarm());
			String errName = steErr==null? "未知异常":steErr.getErrName();
			BasSteErrLog basSteErrLog = new BasSteErrLog(
			BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue());
			String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
			BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
			null, // 编号
			wrkMast.getWrkNo(), // 工作号
			now, // 发生时间
			null, // 结束时间
			wrkMast.getWrkSts(), // 工作状态
			wrkMast.getIoType(), // 入出库类型
			ste.getId(), // 堆垛机
			shuttleSlave.getId(), // 四向穿梭车
			null, // plc
			wrkMast.getLocNo(), // 目标库位
			wrkMast.getStaNo(), // 目标站
			wrkMast.getSourceStaNo(), // 源站
			wrkMast.getSourceLocNo(), // 源库位
			wrkMast.getBarcode(), // 条码
			(int) steProtocol.getAlarm(), // 异常码
			(int) shuttleProtocol.getStatusErrorCode(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			@@ -2178,45 +1724,45 @@
			null, // 修改人员
			"任务中异常" // 备注
			);
			if (!basSteErrLogService.insert(basSteErrLog)) {
			News.error("穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", ste.getId(), errName);
			if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
			News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
			}
			}
			} else {
			// 异常修复
			if (steProtocol.getAlarm() == null \|\| !steProtocol.isAlarm()) {
			if (shuttleProtocol.getStatusErrorCode() == null \|\| shuttleProtocol.getStatusErrorCode() == 0) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basSteErrLogService.updateById(latest)) {
			News.error("穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", ste.getId(), latest.getId());
			if (!basShuttleErrLogService.updateById(latest)) {
			News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
			}
			}
			}
			// 无任务
			} else {
			BasSteErrLog latest = basSteErrLogService.findLatest(ste.getId());
			}else {
			//无任务
			BasShuttleErrLog latest = basShuttleErrLogService.findLatest(shuttleSlave.getId());
			// 有异常
			if (steProtocol.getAlarm() != null && steProtocol.isAlarm()) {
			if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) {
			// 记录新异常
			if (latest == null \|\| (latest.getErrCode() != steProtocol.getAlarm().intValue())) {
			BasSteErr steErr = basSteErrService.selectById(steProtocol.getAlarm());
			String errName = steErr==null? "未知异常":steErr.getErrName();
			BasSteErrLog basSteErrLog = new BasSteErrLog(
			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, // 入出库类型
			ste.getId(), // 堆垛机
			shuttleSlave.getId(), // 四向穿梭车
			null, // plc
			null, // 目标库位
			null, // 目标站
			null, // 源站
			null, // 源库位
			null, // 条码
			(int)steProtocol.getAlarm(), // 异常码
			(int)shuttleProtocol.getStatusErrorCode(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			@@ -2225,8 +1771,8 @@
			null, // 修改人员
			"无任务异常" // 备注
			);
			if (!basSteErrLogService.insert(basSteErrLog)) {
			News.error("穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", ste.getId(), errName);
			if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
			News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
			}
			}
			// 无异常
			@@ -2236,15 +1782,14 @@
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basSteErrLogService.updateById(latest)) {
			News.error("穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", ste.getId(), latest.getId());
			if (!basShuttleErrLogService.updateById(latest)) {
			News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
			}
			}
			}
			}
			}
			}


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

			@@ -2501,304 +2046,249 @@
			}

			/**
			* 小车电量检测 ===>> 发起充电
			* 四向穿梭车电量检测 ===>> 发起充电
			*/
			@SuppressWarnings("serial")
			public synchronized void loopSteCharge() {
			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
			) {
			public synchronized void loopShuttleCharge() {
			for (DevpSlave devpSlave : slaveProperties.getDevp()) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devpSlave.getId());
			for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
			//获取四向穿梭车线程
			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			continue;
			}
			if (!steProtocol.isEnable()) {

			//判断当前小车是否满足需要充电要求
			if (!shuttleProtocol.isRequireCharge()) {
			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());
			}

			break;
			if (wrkCharge != null) {//已有充电任务
			continue;
			}
			} catch (Exception e) {
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			News.error("loopSteCharge fail", e);

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

			if (shuttleCharge == null) {
			continue;
			}

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

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


			}

			/**
			* 执行小车充电任务
			* 执行四向穿梭车充电任务
			*/
			public synchronized void executeSteCharge() {
			public synchronized void executeShuttleCharge() {
			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));
			}
			if (wrkCharge == null) {
			return;
			}


			ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
			if (shuttleThread == null) {
			return;
			}
			ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
			if (shuttleProtocol == null) {
			return;
			}

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

			if (wrkCharge.getWrkSts() == 51 \|\| wrkCharge.getWrkSts() == 55) {
			if (currentLev == chargeLocNoLev) {
			//同一层无需经过提升机
			//直接计算车到充电库位

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();

			//获取小车到充电库位路径指令
			List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
			//进行充电中
			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);

			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			assignCommand.setTaskMode((short) 9);//充电
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
			assignCommand.setCharge(true);//充电任务

			//创建充电指令
			ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 1);//开始充电
			commands.add(command);

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

			wrkCharge.setWrkSts(56L);//充电中状态
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}catch (Exception e){
			}else {
			//不同层，将目标库位分配成提升机库位号

			ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();

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


			assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
			assignCommand.setTaskMode((short) 9);//充电
			assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
			assignCommand.setCharge(true);//充电任务
			//目标库位
			assignCommand.setLocNo(liftLocNo);
			//源库位
			assignCommand.setSourceLocNo(currentLocNo);
			assignCommand.setCommands(commands);
			wrkCharge.setWrkSts(52L);//小车迁移状态
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}
			}

			}else if(wrkCharge.getWrkSts() == 53){
			//小车已经达到提升机口
			LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
			if (liftThread == null) {
			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) {
			LiftProtocol liftProtocol = liftThread.getLiftProtocol();
			if (liftProtocol == null) {
			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());
			}
			}
			}

			} 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));
			}
			}
			}
			//判断提升机是否处于空闲状态
			if (!liftProtocol.isIdle()) {
			return;
			}
			} catch (Exception e) {
			News.error("executeSteCharge fail", e);

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

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

			//提升机当前楼层
			int liftLev = liftProtocol.getLev().intValue();
			if (liftLev != currentLev) {
			//穿梭车和提升机处于不同楼层
			//获取目标楼层(穿梭车所在楼层)命令
			LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), currentLev.shortValue());
			commands.add(command1);//将命令添加进list
			}

			//输送线将四向穿梭车移动进来(正转)
			LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
			commands.add(command2);//将命令添加进list

			//提升机前往目标楼层
			//获取充电库位目标楼层命令
			LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), chargeLocNoLev.shortValue());
			commands.add(command3);//将命令添加进list

			//提升机到达指定楼层，输送线将四向穿梭车移出去
			//输送线将四向穿梭车移动出去(反转)
			LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
			commands.add(command4);//将命令添加进list

			wrkCharge.setWrkSts(54L);//提升机搬运中
			//所需命令组合完毕，更新数据库，提交到线程去工作
			LiftAssignCommand assignCommand = new LiftAssignCommand();
			assignCommand.setCommands(commands);
			assignCommand.setLiftNo(liftProtocol.getLiftNo());
			assignCommand.setTaskNo(liftProtocol.getTaskNo());
			if (wrkChargeMapper.updateById(wrkCharge) > 0) {
			//下发任务
			MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
			}

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

			//创建充电指令
			ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 2);//断开充电
			commands.add(command);

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

			shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING);
			//下发任务
			MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
			}

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

			}

			/**
			@@ -3014,131 +2504,6 @@
			}

			}
			}
			}


			/**
			* 因双深库位阻塞，对浅库位进行移转（出库版)
			* 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();
			}
			}