zy-wcs.git - Gitblit

			@@ -8,10 +8,9 @@
			import com.core.common.DateUtils;
			import com.core.exception.CoolException;
			import com.zy.asrs.entity.*;
			import com.zy.asrs.mapper.BasCrnErrorMapper;
			import com.zy.asrs.mapper.WaitPakinMapper;
			import com.zy.asrs.mapper.WrkMastMapper;
			import com.zy.asrs.mapper.*;
			import com.zy.asrs.service.*;
			import com.zy.asrs.utils.RouteUtils;
			import com.zy.asrs.utils.Utils;
			import com.zy.asrs.utils.VersionUtils;
			import com.zy.common.model.LocTypeDto;
			@@ -21,22 +20,23 @@
			import com.zy.common.service.CommonService;
			import com.zy.common.utils.CollectionUtils;
			import com.zy.common.utils.HttpHandler;
			import com.zy.common.utils.News;
			import com.zy.core.CrnThread;
			import com.zy.core.DevpThread;
			import com.zy.core.cache.MessageQueue;
			import com.zy.core.cache.SlaveConnection;
			import com.zy.core.enums.*;
			import com.zy.core.model.CrnSlave;
			import com.zy.core.model.DevpSlave;
			import com.zy.core.model.LedSlave;
			import com.zy.core.model.Task;
			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.RgvCommand;
			import com.zy.core.model.protocol.CrnProtocol;
			import com.zy.core.model.protocol.RgvProtocol;
			import com.zy.core.model.protocol.StaProtocol;
			import com.zy.core.properties.SlaveProperties;
			import com.zy.core.thread.BarcodeThread;
			import com.zy.core.thread.LedThread;
			import com.zy.core.thread.RgvThread;
			import com.zy.core.thread.SiemensDevpThread;
			import lombok.extern.slf4j.Slf4j;
			import org.springframework.beans.factory.annotation.Autowired;
			@@ -45,10 +45,7 @@
			import org.springframework.transaction.annotation.Transactional;
			import org.springframework.transaction.interceptor.TransactionAspectSupport;

			import java.util.ArrayList;
			import java.util.Date;
			import java.util.List;
			import java.util.Set;
			import java.util.*;
			import java.util.stream.Collectors;

			/**
			@@ -86,26 +83,38 @@
			private BasErrLogService basErrLogService;
			@Autowired
			private BasCrnErrorMapper basCrnErrorMapper;
			@Autowired
			private WrkMastStaMapper wrkMastStaMapper;
			@Autowired
			private BasRgvService basRgvService;
			@Autowired
			private BasRgvMapMapper basRgvMapMapper;
			@Autowired
			private WrkMastService wrkMastService;
			@Autowired
			private BasRgvMapService basRgvMapService;

			@Value("${wms.url}")
			private String wmsUrl;
			@Value("${inventory.number}")
			private Integer inventoryNumber;

			public Integer wrkNo = 10000;

			/**
			* 组托
			* 入库站，根据条码扫描生成入库工作档，工作状态 2
			*/
			public synchronized void generateStoreWrkFile() {
			public synchronized void generateStoreWrkFile(Integer mark) {
			String methodName = Thread.currentThread().getStackTrace()[1].getMethodName();
			// 根据输送线plc遍历
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历入库口
			for (DevpSlave.Sta inSta : devp.getInSta()) {
			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
			if (barcodeThread == null) {
			continue;
			}

			// 获取入库站信息
			BarcodeThread barcodeThreadMat = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcodeMat());
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
			if (staProtocol == null) {
			@@ -114,73 +123,146 @@
			staProtocol = staProtocol.clone();
			}

			//LED
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
			// 入出库模式判断
			// if ( inSta.getStaNo()==203 && devpThread.ioModeOf2F != IoModeType.PAKIN_MODE) { continue; }
			// if (inSta.getStaNo() == 203 && devpThread.ioModeOf2F == IoModeType.PAKOUT_MODE) {
			// continue;
			// }
			if (barcodeThread == null) {
			continue;
			}

			if (barcodeThreadMat == null) {
			continue;
			}

			String barcode = barcodeThread.getBarcode();

			String barcodeMat = barcodeThreadMat.getBarcode();
			// 尺寸检测异常
			boolean back = false;
			String errMsg = "";
			if (staProtocol.isFrontErr()) {
			errMsg = "前超限";
			back = true;
			}
			if (!back && staProtocol.isBackErr()) {
			errMsg = "后超限";
			back = true;
			}
			if (!back && staProtocol.isHighErr()) {
			errMsg = "高超限";
			back = true;
			}
			if (!back && staProtocol.isLeftErr()) {
			errMsg = "左超限";
			back = true;
			}
			if (!back && staProtocol.isRightErr()) {
			errMsg = "右超限";
			back = true;
			}
			if (!back && staProtocol.isWeightErr()) {
			errMsg = "超重";
			back = true;
			}
			if (!back && staProtocol.isBarcodeErr()) {
			errMsg = "扫码失败";
			log.error("物料码扫码失败");
			back = true;
			}
			// 退回
			if (back) {
			// News.warn("扫码入库失败，{}入库站因{}异常，托盘已被退回", inSta.getStaNo(), errMsg);
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));

			if (!staProtocol.isLoading()){
			continue;
			}
			if (!staProtocol.isPakMk()) {
			continue;
			}
			// led 异常显示
			if (ledThread != null) {
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
			}
			staProtocol.setWorkNo(wrkNo);
			News.info("{}入库回退：{}，任务号：{}", inSta.getStaNo(), errMsg,wrkNo);
			wrkNo++;
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.error("输送线下发1："+wrkNo+","+inSta.getBackSta());
			}

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

			String barcode = barcodeThread.getBarcode();
			if(!Cools.isEmpty(barcode)) {
			log.info("{}号条码扫描器检测条码信息：{}", inSta.getBarcode(), barcode);
			if("NG".endsWith(barcode) \|\| "NoRead".equals(barcode) \|\| "empty".equals(barcode)) {
			staProtocol.setWorkNo((short) 9999);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));

			log.info("扫码失败1 ===>> {}号条码扫描器检测条码信息：{},站点:{}", inSta.getBarcode(), barcode, inSta.getStaNo());
			// led 异常显示
			if (ledThread != null) {
			String errorMsg = "扫码失败，请重试";
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(5, errorMsg));
			}
			continue;
			}
			} else {
			staProtocol.setWorkNo((short) 9999);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));

			log.info("扫码失败2 ===>> {}号条码扫描器检测条码信息：{},站点:{}", inSta.getBarcode(), barcode, inSta.getStaNo());
			&& !staProtocol.isEmptyMk()
			&& staProtocol.isPakMk()) {
			if(Cools.isEmpty(barcode) \|\| "NG".endsWith(barcode) \|\| "NoRead".equals(barcode) \|\| "00000000".equals(barcode)) {
			News.info("{}号条码扫描器检测条码信息：{}", inSta.getBarcode(), barcode);
			// led 异常显示
			if (ledThread != null) {
			String errorMsg = "扫码失败，请重试";
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(5, errorMsg));
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
			}
			continue;
			}

			// 判断重复工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode);

			if (wrkMast != null) {
			log.error("工作档中已存在该站状态为（ 2.设备上走）的数据,工作号={}", wrkMast.getWrkNo());
			staProtocol.setWorkNo((short)9999);
			staProtocol.setWorkNo(wrkNo);
			News.info("{}入库回退：{}，任务号：{}", inSta.getStaNo(), errMsg,wrkNo);
			wrkNo++;
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}

			// led 异常显示
			if (ledThread != null) {
			String errorMsg = "工作档已存在该条码号===>>" + barcode;
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(5, errorMsg));
			}
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.error("输送线下发1："+wrkNo+","+inSta.getBackSta());
			continue;
			}
			// if (staProtocol.getSiteId()!= 159){
			// if( Cools.isEmpty(barcodeMat) \|\| "NG".endsWith(barcodeMat) \|\| "NoRead".equals(barcodeMat) \|\| "00000000".equals(barcodeMat)) {
			// News.info("{}号条码扫描器检测条码信息：{}", inSta.getBarcodeMat(), barcodeMat);
			//
			// staProtocol.setWorkNo(wrkNo);
			// News.info("{}入库回退：{}，任务号：{}", inSta.getStaNo(), errMsg,wrkNo);
			// wrkNo++;
			// staProtocol.setStaNo(inSta.getBackSta().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// log.error("输送线下发1："+wrkNo+","+inSta.getBackSta());
			// continue;
			// }
			// }
			// 判断重复工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode);
			if (wrkMast != null) {
			int wrkNo1 = basDevpService.selectCount(new EntityWrapper<BasDevp>().eq("wrk_no", wrkMast.getWrkNo()));
			if (wrkNo1 != 0){
			News.error(barcode + "条码已存在状态为（ 2.设备上走）的数据,请查看WCS输送线界面,工作号={}", wrkMast.getWrkNo());
			if (ledThread != null) {
			News.error(methodName + ":扫码失败，请重试");
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, barcode + "条码已存在状态为（ 2.设备上走）的任务,工作号="+ wrkMast.getWrkNo()));
			}
			continue;
			}
			barcodeThread.setBarcode("");
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(RouteUtils.SouStaEnd(null,wrkMast.getSourceStaNo()));
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.info("输送线下发(存在设备上走的工作档，直接下发！))："+wrkMast.getWrkNo()+","+wrkMast.getStaNo());

			ledThread.errorReset();
			log.info("组托请求后LED错误清除");

			if (!result) {
			News.error(methodName + ":更新plc站点信息失败");
			log.error("输送线下发(存在设备上走的工作档，直接下发！)==>更新plc站点信息失败");

			// throw new CoolException("更新plc站点信息失败");
			continue;
			}

			}
			WrkMast checkPick = wrkMastService.selectOne(new EntityWrapper<WrkMast>()
			.eq("barcode", barcode)
			.in("io_type", 107,103,57));
			if (!Cools.isEmpty(checkPick)) {
			continue;
			}
			try {
			LocTypeDto locTypeDto = new LocTypeDto(staProtocol);

			@@ -198,46 +280,64 @@
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			StartupDto dto = jsonObject.getObject("data", StartupDto.class);

			barcodeThread.setBarcode("");
			staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			staProtocol.setStaNo(dto.getStaNo().shortValue());
			staProtocol.setWorkNo(dto.getWorkNo());
			staProtocol.setStaNo(RouteUtils.SouStaEnd(dto.getStaNo(),dto.getSourceStaNo()));
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}
			log.error("输送线下发2："+dto.getWorkNo()+","+dto.getStaNo());

			// led 入库信息显示
			if (ledThread != null) {
			// 命令集合
			List<LedCommand> commands = new ArrayList<>();
			// 组装命令
			LedCommand ledCommand = new LedCommand();
			ledCommand.setWorkNo(dto.getWorkNo());
			ledCommand.setIoType(1);
			ledCommand.setTitle("全板入库");
			ledCommand.setLocNo(dto.getLocNo());
			ledCommand.setStaNo(dto.getStaNo());
			commands.add(ledCommand);
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, commands));
			}
			} else {
			log.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			staProtocol.setWorkNo((short)9999);
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}
			ledThread.errorReset();
			log.error("组托请求后LED错误清除");

			// led 异常显示
			if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(5, errorMsg));
			if (!result) {
			News.error(methodName + ":更新plc站点信息失败");

			throw new CoolException("更新plc站点信息失败");
			}
			}
			// else if (jsonObject.getInteger("code").equals(700)) {
			// SearchLocParam param2 = new SearchLocParam();
			// param2.setBarcode(barcode);
			// param2.setBarcodeMat(barcodeMat);
			// param2.setSourceStaNo(inSta.getStaNo());
			// param2.setLocType1(locTypeDto.getLocType1());
			// String response2 = new HttpHandler.Builder()
			// .setUri(wmsUrl)
			// .setPath("/rpc/pakin/yk/loc/v33")
			// .setJson(JSON.toJSONString(param2))
			// .build()
			// .doPost();
			// JSONObject jsonObject2 = JSON.parseObject(response2);
			// if (jsonObject2.getInteger("code").equals(200)) {
			// log.info("自动组托成功！！");
			// MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, "自动组托成功"));
			// } else {
			// MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, "自动组托失败！！！barcodeMat==>"+barcodeMat));
			// News.error(methodName + "==>组托失败:请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/yk/loc/v33", JSON.toJSONString(param), response2);
			// }
			// try{
			// Thread.sleep(500);
			// } catch (Exception e){
			//
			// }
			// }
			else {
			staProtocol.setWorkNo(wrkNo);
			wrkNo++;
			staProtocol.setStaNo(inSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			//
			// if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			if (!Cools.isEmpty(errorMsg)) {
			MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
			}
			// }
			// News.error(methodName + ":请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			}


			} catch (Exception e) {
			e.printStackTrace();
			@@ -246,8 +346,10 @@

			}


			}
			}
			// News.infoNoLog(""+mark+" - 0"+" - 组托 ===》执行完成");

			}

			@@ -255,7 +357,7 @@
			* wms入库
			* 入库站，根据条码扫描生成入库工作档，工作状态 1 ==>> 2
			*/
			public synchronized void generateStoreWrkFile0() {
			public synchronized void generateStoreWrkFile0(Integer mark) {
			// 根据输送线plc遍历
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历入库口
			@@ -275,9 +377,13 @@
			}

			// 判断是否满足入库条件
			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()
			if (!staProtocol.isLoading()){
			continue;
			}
			if (staProtocol.isAutoing() && staProtocol.isInEnable()
			&& !staProtocol.isEmptyMk() && (staProtocol.getWorkNo() == 0 \|\| staProtocol.getWorkNo() == 9999)
			&& staProtocol.isPakMk()) {
			News.warnNoLog(""+mark+" - 0"+" - 开始执行");
			// 判断重复工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep11(inSta.getStaNo());
			if (wrkMast == null) {
			@@ -287,33 +393,37 @@
			// 命令下发区 --------------------------------------------------------------------------

			// 更新站点信息且下发plc命令
			staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.error("输送线下发3："+wrkMast.getWrkNo()+","+wrkMast.getStaNo());
			if (result) {
			// 更新工作主档
			wrkMast.setWrkSts(2L); // 工作状态：2.设备上走
			wrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("更新工作档失败！！！ [工作号：{}]", wrkMast.getWrkNo());
			News.error(""+mark+" - 1"+" - 更新工作档失败！！！ [工作号：{}]", wrkMast.getWrkNo());
			}
			} else {
			log.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
			News.error(""+mark+" - 2"+" - 发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
			}

			}else {
			News.errorNoLog(""+mark+" - 6"+" - 站点信息不符合入库条件！！！"+" 自动信号："+staProtocol.isLoading()+"、可入信号：" + staProtocol.isInEnable()
			+"、空板信号："+ staProtocol.isEmptyMk()+"、工作号：" + staProtocol.getWorkNo()
			+"、锁定标记"+ staProtocol.isPakMk()+"、入库印记：" + staProtocol.getStamp());
			}


			}
			}
			// News.infoNoLog(""+mark+" - 0"+" - wms入库 ===》执行完成");

			}

			/**
			* 拣料、并板、盘点再入库
			*/
			public synchronized void stnToCrnStnPick() {
			public synchronized void stnToCrnStnPick(Integer mark) {
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历拣料入库口
			for (DevpSlave.Sta pickSta : devp.getPickSta()) {
			@@ -324,7 +434,7 @@
			}
			String barcode = barcodeThread.getBarcode();
			if(!Cools.isEmpty(barcode)) {
			log.info("{}号条码扫描器检测条码信息：{}", pickSta.getBarcode(), barcode);
			// News.info(""+mark+" - 1"+" - {}号条码扫描器检测条码信息：{}", pickSta.getBarcode(), barcode);
			if("NG".endsWith(barcode) \|\| "NoRead".equals(barcode)) {
			continue;
			}
			@@ -345,6 +455,7 @@
			// if (devpThread.ioMode != IoModeType.PAKIN_MODE) { continue; }

			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk()) {
			News.warnNoLog(""+mark+" - 0"+" - 开始执行");
			WrkMast wrkMast = wrkMastMapper.selectPickStep(barcode);
			// WrkMast wrkMast = wrkMastMapper.selectPakInStep3(staProtocol.getWorkNo().intValue());
			if (wrkMast == null) {
			@@ -372,7 +483,19 @@
			.eq("crn_no", wrkMast.getCrnNo()); // 堆垛机号
			StaDesc staDesc = staDescService.selectOne(wrapper);
			if (Cools.isEmpty(staDesc)) {
			log.error("入库路径不存在！type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
			News.error(""+mark+" - 2"+" - 入库路径不存在！type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
			staProtocol.setWorkNo(wrkNo++);
			staProtocol.setStaNo((short) (pickSta.getStaNo().shortValue()-(short)1));
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.error("输送线下发4："+9989+","+(pickSta.getStaNo().shortValue()-(short)1));
			//LED
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
			// led 异常显示
			if (ledThread != null) {
			String errorMsg = "此为拣料、并板、盘点再入库.请放在"+pickSta.getBackSta().shortValue()+"站点";
			MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
			}
			continue;
			}

			@@ -417,12 +540,181 @@
			}

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

			}else {
			News.errorNoLog(""+mark+" - 6"+" - 站点信息不符合入库条件！！！"+" 自动信号："+staProtocol.isLoading()+"、可入信号：" + staProtocol.isInEnable()
			+"、空板信号："+ staProtocol.isEmptyMk());
			}

			}

			}
			// News.infoNoLog(""+mark+" - 0"+" - 拣料、并板、盘点再入库 ===》执行完成");
			}


			//盘点再入库
			public synchronized void stnToCrnStnPick2(){
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历拣料入库口
			for (DevpSlave.Sta pickSta : devp.getPickSta()) {
			// 获取拣料入库站信息
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(pickSta.getStaNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (staProtocol.isAutoing()
			&& staProtocol.isLoading()
			&& staProtocol.isInEnable()
			&& !staProtocol.isEmptyMk()
			// && staProtocol.getWorkNo() > 0
			&& staProtocol.isPakMk()){

			// 获取条码扫描仪信息
			BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
			if (barcodeThread == null) {
			continue;
			}
			String barcode = barcodeThread.getBarcode();
			if(!Cools.isEmpty(barcode)) {
			// log.info("{}号条码扫描器检测条码信息：{}", pickSta.getBarcode(), barcode);
			if("00000000".equals(barcode) \|\| "NG".endsWith(barcode) \|\| "NoRead".equals(barcode) \|\| "empty".equals(barcode)) {
			staProtocol.setWorkNo(wrkNo++);
			staProtocol.setStaNo(pickSta.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, pickSta.getLed());
			if (ledThread != null) {
			String errorMsg = "扫码失败，请重试";
			MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
			}
			continue;
			}
			} else {
			staProtocol.setWorkNo(wrkNo++);
			staProtocol.setStaNo(pickSta.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, pickSta.getLed());
			if (ledThread != null) {
			String errorMsg = "扫码失败，请重试";
			MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
			}
			continue;
			}

			WrkMast wrkMast = wrkMastMapper.selectPickStep2(barcode);
			if (wrkMast == null) {
			// 无盘点数据
			continue;
			}

			// 出库确认信号位
			// if ((Cools.isEmpty(wrkMast.getInvWh()) \|\| wrkMast.getInvWh().equals("N")) && wrkMast.getIoType() != 107) {
			// continue;
			// }
			// if ( wrkMast.getIoType() != 107 \|\| Cools.isEmpty(wrkMast.getStaNo())
			// \|\| Cools.isEmpty(wrkMast.getSourceStaNo())) {
			// continue;
			// }

			// 获取库位号
			try {
			LocMast locMast = locMastService.selectOne(new EntityWrapper<LocMast>().eq("loc_no", wrkMast.getSourceLocNo()));
			LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
			SearchLocParam param = new SearchLocParam();
			param.setBarcode(barcode);
			param.setIoType(107);
			param.setSourceStaNo(pickSta.getStaNo()); //作业站点
			if (!Cools.isEmpty(locMast)){
			param.setLocType1(locMast.getLocType1());
			}else {
			param.setLocType1(locTypeDto.getLocType1());
			}

			String response = "";
			log.info("入库作业站"+pickSta.getStaNo()+"盘点再入库任务请求WMS===>>参数：" + param);
			try {
			response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/pakin2/loc/v1")
			.setJson(JSON.toJSONString(param))
			// .setTimeout(15, TimeUnit.SECONDS)
			.build()
			.doPost();
			} catch(Exception e){
			log.error("入库作业站"+pickSta.getStaNo()+"盘点再入库任务请求WMS===>>参数：" + param);
			log.error("stnToCrnStnPick2===>>盘点查库位入库接口失败", e);
			e.printStackTrace();
			continue;
			}
			log.info("入库作业站"+pickSta.getStaNo()+"盘点再入库任务请求WMS===>>参数：" + param);
			log.info("入库作业站"+pickSta.getStaNo()+"下发盘点再入库任务请求WMS返回结果===>>" + response);
			if(response.equals("")) {
			continue;
			}
			JSONObject jsonObject = JSON.parseObject(response);
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
			Integer code = jsonObject.getInteger("code");
			if (code == 200) {
			StartupDto dto = jsonObject.getObject("data", StartupDto.class);
			if (Cools.isEmpty(dto) \|\| Cools.isEmpty(dto.getStaNo())) {
			log.error("任务号"+wrkMast.getWrkNo()+"盘点再入库查询库位失败===>>" + jsonObject.toJSONString());
			} else {
			log.info("任务号"+wrkMast.getWrkNo()+"盘点再入库查询库位成功===>>" + jsonObject.toJSONString());
			try {
			// 更新站点信息且下发plc命令
			staProtocol.setWorkNo(dto.getWorkNo());
			staProtocol.setStaNo((short)161);
			devpThread.setPakMk(staProtocol.getSiteId(), false);

			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			log.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
			}
			log.info("任务号"+wrkMast.getWrkNo()+"盘点再入库任务下发成功===>>" + staProtocol);

			ledThread.errorReset();
			log.error("盘点后led错误删除");

			} catch (Exception e) {
			log.error("盘点再入库失败===>>" + e);
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			}
			} else {
			staProtocol.setWorkNo(wrkNo++);
			staProtocol.setStaNo(pickSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			if (!Cools.isEmpty(errorMsg)) {
			MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
			}
			}
			log.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin2/loc/v1", JSON.toJSONString(param), response);
			}
			} catch (Exception e) {
			log.error("stnToCrnStnPick2===>>fail", e);
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}

			}
			@@ -435,7 +727,8 @@
			/**
			* 堆垛机站出库到出库站
			*/
			public synchronized void crnStnToOutStn() {
			public synchronized void crnStnToOutStn(Integer mark) {

			for (CrnSlave crnSlave : slaveProperties.getCrn()) {
			// 遍历堆垛机出库站
			for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
			@@ -454,7 +747,7 @@
			continue;
			}
			// 判断工作档条件
			if (wrkMast.getIoType() < 100 \|\| wrkMast.getStaNo() == null \|\| wrkMast.getSourceStaNo() == null) {
			if ((wrkMast.getIoType() != 12 && wrkMast.getIoType() < 100) \|\| wrkMast.getStaNo() == null \|\| wrkMast.getSourceStaNo() == null) {
			continue;
			}
			// 判断吊车是否实际已完成，且电脑状态在move中，以备电脑进行更新工作档
			@@ -468,14 +761,18 @@
			if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast.getWrkNo().shortValue())
			&& crnProtocol.statusType == CrnStatusType.WAITING
			&& crnProtocol.forkPosType == CrnForkPosType.HOME) {
			log.info("堆垛机出库完成 - 开始执行");

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

			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(RouteUtils.CrnStaEnd(wrkMast.getStaNo(),wrkMast.getSourceStaNo()));
			if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
			log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"输送线出库命令下发失败");
			continue;
			}else {
			log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"输送线出库命令下发成功");
			}

			// 更新工作档状态为14失败
			@@ -483,22 +780,123 @@
			wrkMast.setCrnEndTime(new Date());
			if (wrkMastMapper.updateById(wrkMast) != 0) {
			// 复位堆垛机
			log.error("出库任务完成下发堆垛机复位,{}", wrkMast.getWrkNo());
			crnThread.setResetFlag(true);
			} else {
			log.error("更新工作档的工作状态为14失败！！！ [工作号:{}]", wrkMast.getWrkNo());
			News.error(""+mark+" - 1"+" - 更新工作档的工作状态为14失败！！！ [工作号:{}]", wrkMast.getWrkNo());
			}

			}else {
			News.errorNoLog(""+mark+" - 6"+" - 堆垛机信息不符合入库条件！！！"
			+" 堆垛机状态："+crnProtocol.modeType+"==自动AUTO：" + CrnModeType.AUTO
			+"、堆垛机任务号："+crnProtocol.getTaskNo()+"==工作档任务号：" + wrkMast.getWrkNo().shortValue()
			+"、状态枚举："+crnProtocol.statusType+"==WAITING：90 //任务完成等待WCS确认)：" + CrnStatusType.WAITING
			+"、货叉位置："+crnProtocol.forkPosType+"==HOME：0 // 货叉原位：" + CrnForkPosType.HOME);
			}

			}
			}
			}
			// News.infoNoLog(""+mark+" - 0"+" - 堆垛机站出库到出库站 ===》执行完成");
			}

			/**
			* 入出库 ===>> 堆垛机入出库作业下发
			* 堆垛机任务衔接任务生成
			*/
			public synchronized void crnIoExecute() {
			public synchronized void connectWrk(Integer mark) {
			for (DevpSlave devp : slaveProperties.getDevp()) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocolIn = devpThread.getStation().get(4001);
			if (staProtocolIn == null) {
			continue;
			} else {
			staProtocolIn = staProtocolIn.clone();
			}
			StaProtocol staProtocolOut = devpThread.getStation().get(1015);
			if (staProtocolOut == null) {
			continue;
			} else {
			staProtocolOut = staProtocolOut.clone();
			}
			if(staProtocolOut.getWorkNo() != null &&staProtocolOut.getStaNo() == 4006){
			WrkMast wrkMastOut = wrkMastMapper.selectByWrkNo(staProtocolOut.getWorkNo());
			WrkMast wrkMast = wrkMastMapper.selectByWrkNo(9997);
			if(wrkMast == null){
			continue;
			}
			try {
			TransplantWork param = new TransplantWork();
			param.setWorkNo(wrkMastOut.getWrkNo());
			param.setBarcode(wrkMastOut.getBarcode());
			param.setSourceStaNo(1015);
			param.setStaNo(wrkMastOut.getStaNo());
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/TransplantingIn/v1")
			.setJson(JSON.toJSONString(param))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			staProtocolOut.setWorkNo(9997);
			devpThread.setPakMk(staProtocolOut.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocolOut));

			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}
			}

			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			}

			if(staProtocolIn.getWorkNo() != null &&staProtocolIn.getStaNo() != 4001){
			WrkMast wrkMastIn = wrkMastMapper.selectByWrkNo(staProtocolIn.getWorkNo());
			WrkMast wrkMast = wrkMastMapper.selectByWrkNo(9996);
			if(wrkMast == null){
			continue;
			}
			try {
			TransplantWork param = new TransplantWork();
			param.setWorkNo(wrkMastIn.getWrkNo());
			param.setBarcode(wrkMastIn.getBarcode());
			param.setSourceStaNo(4001);
			param.setStaNo(wrkMastIn.getStaNo());
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/TransplantingOut/v1")
			.setJson(JSON.toJSONString(param))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			staProtocolIn.setWorkNo(9996);
			devpThread.setPakMk(staProtocolIn.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocolIn));

			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}
			}

			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			}
			}

			}


			/**
			* 入出库 ===>> 堆垛机入出库作业下发
			*/
			public synchronized void crnIoExecute(Integer mark) {

			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			@@ -508,7 +906,7 @@
			}
			BasCrnp basCrnp = basCrnpService.selectById(crn.getId());
			if (basCrnp == null) {
			log.error("{}号堆垛机尚未在数据库进行维护！", crn.getId());
			News.error(""+mark+" - 1"+" - {}号堆垛机尚未在数据库进行维护！", crn.getId());
			continue;
			}

			@@ -520,53 +918,55 @@
			// 只有当堆垛机空闲并且无任务时才继续执行
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO
			&& crnProtocol.getLoaded() == 0 && crnProtocol.getForkPos() == 0) {
			News.warnNoLog(""+mark+" - 0"+" - 开始执行堆垛机入出库作业下发");
			// 如果最近一次是入库模式
			if (crnProtocol.getLastIo().equals("I")) {
			if (basCrnp.getInEnable().equals("Y")) {
			this.crnStnToLoc(crn, crnProtocol); // 入库
			//mark - 1 - ....
			this.crnStnToLoc(crn, crnProtocol,mark); // 入库
			crnProtocol.setLastIo("O");
			} else if (basCrnp.getOutEnable().equals("Y")) {
			this.locToCrnStn(crn, crnProtocol); // 出库
			//mark - 2 - ....
			this.locToCrnStn(crn, crnProtocol,mark); // 出库
			crnProtocol.setLastIo("I");
			}
			}
			// 如果最近一次是出库模式
			else if (crnProtocol.getLastIo().equals("O")) {
			if (basCrnp.getOutEnable().equals("Y")) {
			this.locToCrnStn(crn, crnProtocol); // 出库
			this.locToCrnStn(crn, crnProtocol,mark); // 出库
			crnProtocol.setLastIo("I");
			} else if (basCrnp.getInEnable().equals("Y")) {
			this.crnStnToLoc(crn, crnProtocol); // 入库
			this.crnStnToLoc(crn, crnProtocol,mark); // 入库
			crnProtocol.setLastIo("O");
			}
			}
			}
			// 库位移转
			this.locToLoc(crn, crnProtocol);
			// this.crnRebackHp(crnProtocol, crnThread);
			//mark - 3 - ....
			this.locToLoc(crn, crnProtocol,mark);
			//预调度
			this.crnRebackHp(crnProtocol, crnThread);

			}
			// News.infoNoLog(""+mark+" - 0"+" - 堆垛机入出库作业下发执行完成");
			}

			/**
			* 回原点，堆垛机没有执行中任务，设备存在入库任务时叫回原点
			*/
			public synchronized void crnRebackHp(CrnProtocol crnProtocol, CrnThread crnThread) {
			// 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) {
			// log.error("{}号堆垛机尚未在数据库进行维护！", crn.getId());
			// continue;
			// }
			if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
			if (crnProtocol.getBay() == 1 && crnProtocol.getLevel() == 1) {
			if (crnProtocol.getBay() == 1) {
			return;
			}
			int x=1;
			switch (crnProtocol.getCrnNo()){
			case 1: x =1; break;
			case 2: x =3; break;
			case 3: x =5; break;
			case 4: x =7; break;
			case 5: x =9; break;
			}

			// 已经存在吊车执行任务时，则过滤3,12
			@@ -580,48 +980,106 @@
			}

			//输送线没有入库任务，过滤2
			if (wrkMastMapper.selectDevWorking(crnProtocol.getCrnNo()) == null) {
			if (wrkMastMapper.selectDevWorking(crnProtocol.getCrnNo()) != null) {
			return;
			}
			log.info("堆垛机召回原点==>>" + crnProtocol.getCrnNo() + "号堆垛机有入库任务,召回原点");
			News.info("堆垛机召回原点==>>" + crnProtocol.getCrnNo() + "号堆垛机有入库任务,召回原点");
			// 命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 堆垛机编号
			crnCommand.setTaskNo((short) 9999); // 工作号
			crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.GO_ORIGIN); // 任务模式: 回原点
			crnCommand.setSourcePosX((short) 0); // 源库位排
			crnCommand.setSourcePosY((short) 0); // 源库位列
			crnCommand.setSourcePosZ((short) 0); // 源库位层
			crnCommand.setTaskMode(CrnTaskModeType.X_MOVE); // 任务模式: 回原点
			crnCommand.setSourcePosX((short) x); // 源库位排
			crnCommand.setSourcePosY((short) 1); // 源库位列
			crnCommand.setSourcePosZ((short) 1); // 源库位层
			crnCommand.setDestinationPosX((short) 0); // 目标库位排
			crnCommand.setDestinationPosY((short) 0); // 目标库位列
			crnCommand.setDestinationPosZ((short) 0); // 目标库位层
			if (!MessageQueue.offer(SlaveType.Crn, crnProtocol.getCrnNo(), new Task(2, crnCommand))) {
			log.error("堆垛机回原点命令下发失败，堆垛机号={}，任务数据={}", crnProtocol.getCrnNo(), JSON.toJSON(crnCommand));
			News.error("堆垛机回原点命令下发失败，堆垛机号={}，任务数据={}", crnProtocol.getCrnNo(), JSON.toJSON(crnCommand));
			}
			crnThread.setBackHpFlag(true);
			}

			// }
			}

			/**
			* 入库 ===>> 堆垛机站到库位
			*/
			public synchronized void crnStnToLoc(CrnSlave slave, CrnProtocol crnProtocol) {
			public synchronized void crnStnToLoc(CrnSlave slave, CrnProtocol crnProtocol,Integer mark) {
			News.warnNoLog(""+mark+" - 1"+" - 0"+" - 堆垛机入出库作业下发：执行入库");
			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) {
			News.infoNoLog(""+mark+" - 1"+" - 1"+" - 堆垛机入库站信息(staProtocol!=null继续执行)：staProtocol="+staProtocol);
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (slave.getId() == 3) {
			SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol2 = devpThread1.getStation().get(4001);
			if (staProtocol2 == null) {
			News.infoNoLog("" + mark + " - 2" + " - 3" + " - 堆垛机出库站信息(staProtocol!=null继续执行,否则循环终止)：staProtocol=" + staProtocol2);
			break;
			} else {
			staProtocol2 = staProtocol2.clone();
			}
			WrkMast wrkMast9999 = wrkMastMapper.selectByWrkNo(9996);
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			News.error(""+mark+" - 2"+" - 5"+" - 出库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			break;
			// continue;
			}
			if(wrkMast9999 != null && staProtocol2.isAutoing() && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")){
			// 堆垛机控制过滤
			if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			// continue;
			break;
			}
			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			break;
			// return;
			}
			// 1.堆垛机开始移动
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo((short) 9996); // 工作号
			// crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX((short) 5); // 源库位排
			crnCommand.setSourcePosY((short) 1); // 源库位列
			crnCommand.setSourcePosZ((short) 4); // 源库位层
			crnCommand.setDestinationPosX((short) 6); // 目标库位排
			crnCommand.setDestinationPosY((short) 1); // 目标库位列
			crnCommand.setDestinationPosZ((short) 1); // 目标库位层
			// crnCommand.setTraySize(sourceSta.getLocType1() == 2); //库位类型
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast9999.getCrnNo(), new Task(2, crnCommand))) {
			News.error("" + mark + " - 2" + " - 13" + " - 堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast9999.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 12.吊车出库中
			Date now = new Date();
			wrkMast9999.setWrkSts(3L);
			wrkMast9999.setCrnStrTime(now);
			wrkMast9999.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast9999) == 0) {
			News.error("" + mark + " - 2" + " - 14" + " - 修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast9999.getWrkNo());
			}
			break;
			}
			}
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			log.error("入库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			News.error(""+mark+" - 1"+" - 2"+" - 入库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			continue;
			}
			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
			@@ -629,27 +1087,33 @@
			flag = true;
			}
			if (!flag) {
			News.errorNoLog(""+mark+" - 1"+" - 3"+" - 堆垛机入库站信息(以下需要全true):"
			+"自动信号"+staProtocol.isAutoing()+"有物信号"+staProtocol.isLoading()
			+"工作号>0"+staProtocol.getWorkNo()+"可入信号"+staProtocol.isInEnable()
			+"能入信号（wms设置）.equals(\"Y\")"+staDetl.getCanining());
			continue;
			}
			// 获取工作状态为2（设备上走）的入库工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep2(slave.getId(), staProtocol.getWorkNo().intValue(), crnStn.getStaNo());
			if (null == wrkMast) {
			News.infoNoLog(""+mark+" - 1"+" - 4"+" - 查询无待入库数据--wrk_sts=2, 工作号={}", staProtocol.getWorkNo());
			// log.error("查询无待入库数据--wrk_sts=2, 工作号={}", staProtocol.getWorkNo());
			continue;
			}
			// 获取库位信息
			LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
			if (locMast == null) {
			log.error("查询库存无数据--库位号{}", wrkMast.getLocNo());
			News.error(""+mark+" - 1"+" - 5"+" - 查询库存无数据--库位号{}", wrkMast.getLocNo());
			continue;
			}
			if (!locMast.getLocSts().equals("S") && !locMast.getLocSts().equals("Q")) {
			log.error("入库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), locMast.getLocSts());
			News.error(""+mark+" - 1"+" - 6"+" - 入库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), locMast.getLocSts());
			continue;
			}

			// 堆垛机控制过滤
			if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			// News.infoNoLog(""+mark+" - 1"+" - 7"+" - 堆垛机控制过滤:堆垛机是否空闲={}，任务号={}", crnProtocol.getStatusType(),crnProtocol.getTaskNo());
			continue;
			}

			@@ -660,41 +1124,49 @@

			// 双深库位且浅库位有货，则需先对浅库位进行库位移转
			if (Utils.isDeepLoc(slaveProperties, wrkMast.getLocNo())) {
			News.warnNoLog(""+mark+" - 1"+" - 8"+" - 双深库位且浅库位有货，则需先对浅库位进行库位移转 : 开始执行任务号={}",wrkMast.getWrkNo());
			String shallowLocNo = Utils.getShallowLoc(slaveProperties, wrkMast.getLocNo());
			LocMast shallowLoc = locMastService.selectById(shallowLocNo);
			// O.空库位、Q.拣料/盘点/并板再入库、S.入库预约、X.禁用直接搬！
			if (shallowLoc.getLocSts().equals("P") \|\| shallowLoc.getLocSts().equals("R")) {
			News.warnNoLog(""+mark+" - 1"+" - 9"+" - // O.空库位、Q.拣料/盘点/并板再入库、S.入库预约、X.禁用直接搬！库位状态={}",shallowLoc.getLocSts());
			WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
			if (null == waitWrkMast) {
			log.error("{}库位异常，未检索到相应工作档！", shallowLocNo);
			News.error(""+mark+" - 1"+" - 10"+" - {}库位异常，未检索到相应工作档！", shallowLocNo);
			} else {
			waitWrkMast.setIoPri(15D);
			waitWrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(waitWrkMast) == 0) {
			log.error("调整工作档优先级失败！工作号={}", waitWrkMast.getWrkNo());
			News.error(""+mark+" - 1"+" - 11"+" - 调整工作档优先级失败！工作号={}", waitWrkMast.getWrkNo());
			}
			continue;
			}

			} else if (shallowLoc.getLocSts().equals("F") \|\| shallowLoc.getLocSts().equals("D")) {
			News.warnNoLog(""+mark+" - 1"+" - 12"+" - // F、D 库位状态={}",shallowLoc.getLocSts());
			// 此标记避免多次执行移库任务
			if (Cools.isEmpty(wrkMast.getUpdMk()) \|\| "N".equals(wrkMast.getUpdMk())) {
			wrkMast.setUpdMk("Y");
			wrkMast.setIoPri(14D);
			wrkMastMapper.updateById(wrkMast);
			// 生成工作档,将浅库位移转到新的库位中
			moveLocForDeepLoc(slave, shallowLoc);
			moveLocForDeepLoc(slave, shallowLoc,mark);
			// 生成工作档、改变浅库位的源库/目标库库位状态、下发堆垛机命令（立马执行)
			// moveLocForDeepLocPakin(slave, shallowLoc, wrkMast);
			}
			continue;
			} else if (shallowLoc.getLocSts().equals("Q")) {
			News.warnNoLog(""+mark+" - 1"+" - 13"+" - // Q 库位状态={}",shallowLoc.getLocSts());
			WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
			if (null != waitWrkMast && waitWrkMast.getWrkSts() == 4) {
			News.infoNoLog(""+mark+" - 1"+" - 14"+" - // F、D 工作状态(判断条件为==4)={}",waitWrkMast.getWrkSts());
			continue;
			}
			}
			}
			News.warnNoLog(""+mark+" - 1"+" - 15"+" - 命令下发 : 工作号={},源排={},源列={},源层={},目标排={},目标列={},目标层={}",wrkMast.getWrkNo().shortValue()
			,crnStn.getRow().shortValue(),crnStn.getBay().shortValue(),crnStn.getLev().shortValue()
			,locMast.getRow1().shortValue(),locMast.getBay1().shortValue(),locMast.getLev1().shortValue());

			// 命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			@@ -708,8 +1180,9 @@
			crnCommand.setDestinationPosX(locMast.getRow1().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(locMast.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(locMast.getLev1().shortValue()); // 目标库位层
			crnCommand.setTraySize(locMast.getLocType1() == 2);
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			log.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			News.error(""+mark+" - 1"+" - 16"+" - 堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {

			// long startTime = System.currentTimeMillis();
			@@ -730,40 +1203,104 @@
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("修改工作档状态 2.设备上走 => 3.吊车入库中失败！！，工作号={}", wrkMast.getWrkNo());
			News.error(""+mark+" - 1"+" - 17"+" - 修改工作档状态 2.设备上走 => 3.吊车入库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			}
			News.infoNoLog(""+mark+" - 1"+" - 0"+" - 堆垛机入出库作业下发：入库执行完毕");
			}

			/**
			* 出库 ===>> 库位到堆垛机站
			* 2022-06-09 TQS修改，查询工作档LIST，遍历下发，防止第一个任务堵塞出库
			*/
			public synchronized void locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol) {
			public synchronized void locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol,Integer mark) {
			News.warnNoLog(""+mark+" - 2"+" - 0"+" - 堆垛机入出库作业下发：执行出库");
			for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
			// 获取工作状态为11（生成出库ID）的出库工作档
			// WrkMast wrkMast = wrkMastMapper.selectPakOutStep1(slave.getId(), crnStn.getStaNo());
			List<WrkMast> wrkMasts = wrkMastMapper.selectPakOutStep11(slave.getId(), crnStn.getStaNo());
			if (slave.getId() == 3) {
			SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol2 = devpThread1.getStation().get(1015);
			if (staProtocol2 == null) {
			News.infoNoLog("" + mark + " - 2" + " - 3" + " - 堆垛机出库站信息(staProtocol!=null继续执行,否则循环终止)：staProtocol=" + staProtocol2);
			break;
			} else {
			staProtocol2 = staProtocol2.clone();
			}
			WrkMast wrkMast9999 = wrkMastMapper.selectByWrkNo(9997);
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			News.error(""+mark+" - 2"+" - 5"+" - 出库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			break;
			// continue;
			}
			if(wrkMast9999 != null && staProtocol2.isAutoing() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")){
			// 堆垛机控制过滤
			if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) \|\| crnProtocol.getTaskNo() != 0) {
			// continue;
			break;
			}
			// 已经存在吊车执行任务时，则过滤
			if (wrkMastMapper.selectWorking(slave.getId()) != null) {
			break;
			// return;
			}
			// 1.堆垛机开始移动
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			crnCommand.setTaskNo((short) 9997); // 工作号
			// crnCommand.setAckFinish((short) 0); // 任务完成确认位
			crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 任务模式: 库位移转
			crnCommand.setSourcePosX((short) 5); // 源库位排
			crnCommand.setSourcePosY((short) 1); // 源库位列
			crnCommand.setSourcePosZ((short) 1); // 源库位层
			crnCommand.setDestinationPosX((short) 6); // 目标库位排
			crnCommand.setDestinationPosY((short) 1); // 目标库位列
			crnCommand.setDestinationPosZ((short) 4); // 目标库位层
			// crnCommand.setTraySize(sourceSta.getLocType1() == 2); //库位类型
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast9999.getCrnNo(), new Task(2, crnCommand))) {
			News.error("" + mark + " - 2" + " - 13" + " - 堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast9999.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 12.吊车出库中
			Date now = new Date();
			wrkMast9999.setWrkSts(12L);
			wrkMast9999.setCrnStrTime(now);
			wrkMast9999.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast9999) == 0) {
			News.error("" + mark + " - 2" + " - 14" + " - 修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast9999.getWrkNo());
			}
			break;
			}
			}
			}
			for (WrkMast wrkMast : wrkMasts) {
			if (wrkMast == null) {
			continue;
			}
			if (wrkMast.getIoType() == 107){
			int count = wrkMastService.selectCount(new EntityWrapper<WrkMast>().eq("io_type", wrkMast.getIoType()).eq("wrk_sts", 14));
			if (count >= inventoryNumber) {
			continue;
			}
			}
			// 工作档状态判断
			if (wrkMast.getIoType() < 100 \|\| wrkMast.getSourceStaNo() == null) {
			log.error("查询工作档数据不符合条件--入出类型/站点, 工作号={}，源库位={}，入出类型={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getIoType());
			News.error(""+mark+" - 2"+" - 1"+" - 查询工作档数据不符合条件--入出类型/站点, 工作号={}，源库位={}，入出类型={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getIoType());
			continue;
			}
			// 获取源库位信息
			LocMast sourceSta = locMastService.selectById(wrkMast.getSourceLocNo());
			if (!sourceSta.getLocSts().equals("R") && !sourceSta.getLocSts().equals("P")) {
			log.error("出库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), sourceSta.getLocSts());
			News.error(""+mark+" - 2"+" - 2"+" - 出库操作库位状态不符合--状态, 库位号={}，库位状态={}", wrkMast.getLocNo(), sourceSta.getLocSts());
			continue;
			}
			// 获取堆垛机出库站信息
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
			if (staProtocol == null) {
			News.infoNoLog(""+mark+" - 2"+" - 3"+" - 堆垛机出库站信息(staProtocol!=null继续执行,否则循环终止)：staProtocol="+staProtocol);
			break;
			// continue;
			} else {
			@@ -772,20 +1309,29 @@

			// // 入出库模式判断
			// if (devpThread.ioMode != IoModeType.PAKOUT_MODE) { continue; }
			if (wrkMast.getStaNo() == 204 && devpThread.ioModeOf2F != IoModeType.PAKOUT_MODE) {
			continue;
			}
			// if (wrkMast.getStaNo() == 204 && devpThread.ioModeOf2F != IoModeType.PAKOUT_MODE) {
			// News.infoNoLog(""+mark+" - 2"+" - 4"+" - 入出库模式（此处出库方法，出库模式继续=="+devpThread.ioModeOf2F);
			// continue;
			// }

			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
			if (staDetl == null) {
			log.error("出库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			News.error(""+mark+" - 2"+" - 5"+" - 出库 ===>> 堆垛机站点在数据库不存在, 站点编号={}", crnStn.getStaNo());
			break;
			// continue;
			}
			// 判断堆垛机出库站状态
			if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
			&& staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {
			// if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
			// && staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {

			if (staProtocol.isAutoing() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
			) {
			// if (slave.getId() == 1 \|\| slave.getId() == 2){
			// if (staProtocol.isLoading() \|\| staProtocol.getWorkNo() != 0 \|\| !staProtocol.isOutEnable()){
			// continue;
			// }
			// }
			// 命令下发区 --------------------------------------------------------------------------

			// 堆垛机控制过滤
			@@ -796,19 +1342,21 @@

			// 双深库位且浅库位有货，则需先对浅库位进行库位移转
			if (Utils.isDeepLoc(slaveProperties, wrkMast.getSourceLocNo())) {
			News.warnNoLog(""+mark+" - 2"+" - 6"+" - 双深库位且浅库位有货，则需先对浅库位进行库位移转 : 开始执行任务号={}",wrkMast.getWrkNo());
			String shallowLocNo = Utils.getShallowLoc(slaveProperties, wrkMast.getSourceLocNo());
			LocMast shallowLoc = locMastService.selectById(shallowLocNo);
			// O.空库位、Q.拣料/盘点/并板再入库、S.入库预约、X.禁用直接搬！
			if (shallowLoc.getLocSts().equals("P") \|\| shallowLoc.getLocSts().equals("R")) {
			News.warnNoLog(""+mark+" - 2"+" - 7"+" - // O.空库位、Q.拣料/盘点/并板再入库、S.入库预约、X.禁用直接搬！库位状态={}",shallowLoc.getLocSts());
			WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
			if (null == waitWrkMast) {
			log.error("{}库位异常，未检索到相应工作档！", shallowLocNo);
			News.error("{}库位异常，未检索到相应工作档！", shallowLocNo);
			} else {
			if (waitWrkMast.getWrkSts() == 11) {
			waitWrkMast.setIoPri(15D);
			waitWrkMast.setModiTime(new Date());
			if (wrkMastMapper.updateById(waitWrkMast) == 0) {
			log.error("调整工作档优先级失败！工作号={}", waitWrkMast.getWrkNo());
			News.error(""+mark+" - 2"+" - 8"+" - 调整工作档优先级失败！工作号={}", waitWrkMast.getWrkNo());
			}
			continue;
			} else {
			@@ -816,6 +1364,7 @@
			}
			}
			} else if (shallowLoc.getLocSts().equals("F") \|\| shallowLoc.getLocSts().equals("D")) {
			News.warnNoLog(""+mark+" - 2"+" - 9"+" - // F、D 库位状态={}",shallowLoc.getLocSts());
			// WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
			//2022-08-16 modify,不根据updmk标记移库任务(容易被取消导致堵塞)，查询工作档是否存在任务
			WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
			@@ -826,13 +1375,15 @@
			wrkMast.setUpdMk("Y");
			wrkMastMapper.updateById(wrkMast);
			// 生成工作档,将浅库位移转到新的库位中
			moveLocForDeepLoc(slave, shallowLoc);
			moveLocForDeepLoc(slave, shallowLoc,mark);
			}
			log.error("{}任务出库失败，浅库位堵塞！浅库位号:{}", wrkMast.getWrkNo(), shallowLocNo);
			News.error("{}任务出库失败，浅库位堵塞！浅库位号:{}", wrkMast.getWrkNo(), shallowLocNo);
			continue;
			} else if (shallowLoc.getLocSts().equals("Q") \|\| shallowLoc.getLocSts().equals("S")) {
			News.warnNoLog(""+mark+" - 2"+" - 10"+" - // Q、S 库位状态={}",shallowLoc.getLocSts());
			WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
			if (null != waitWrkMast && waitWrkMast.getWrkSts() == 4) {
			News.infoNoLog(""+mark+" - 2"+" - 11"+" - // F、D 工作状态(判断条件为==4)={}",waitWrkMast.getWrkSts());
			continue;
			}
			}
			@@ -843,6 +1394,10 @@
			break;
			// return;
			}

			News.warnNoLog(""+mark+" - 2"+" - 12"+" - 命令下发 : 工作号={},源排={},源列={},源层={},目标排={},目标列={},目标层={}",wrkMast.getWrkNo().shortValue()
			,sourceSta.getRow1().shortValue(),sourceSta.getBay1().shortValue(),sourceSta.getLev1().shortValue()
			,crnStn.getRow().shortValue(),crnStn.getBay().shortValue(),crnStn.getLev().shortValue());

			// 1.堆垛机开始移动
			CrnCommand crnCommand = new CrnCommand();
			@@ -856,8 +1411,9 @@
			crnCommand.setDestinationPosX(crnStn.getRow().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(crnStn.getBay().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(crnStn.getLev().shortValue()); // 目标库位层
			crnCommand.setTraySize(sourceSta.getLocType1() == 2); //库位类型
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			log.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			News.error(""+mark+" - 2"+" - 13"+" - 堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 12.吊车出库中
			Date now = new Date();
			@@ -865,13 +1421,14 @@
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			News.error(""+mark+" - 2"+" - 14"+" - 修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			break;
			}
			}
			}
			}
			News.infoNoLog(""+mark+" - 2"+" - 0"+" - 堆垛机入出库作业下发：出库执行完毕");
			}

			// /**
			@@ -994,16 +1551,17 @@
			/**
			* 库位移转
			*/
			public synchronized void locToLoc(CrnSlave slave, CrnProtocol crnProtocol) {
			public synchronized void locToLoc(CrnSlave slave, CrnProtocol crnProtocol,Integer mark) {
			// 获取工作档信息
			WrkMast wrkMast = wrkMastMapper.selectLocMove(slave.getId());
			if (null == wrkMast) {
			return;
			}
			News.warnNoLog(""+mark+" - 3"+" - 0"+" - 堆垛机入出库作业下发：执行库位移转");
			// 获取源库位信息
			LocMast sourceSta = locMastService.selectById(wrkMast.getSourceLocNo());
			if (null == sourceSta) {
			log.error("工作档库位移转失败，原因：检索源库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo());
			News.error(""+mark+" - 3"+" - 1"+" - 工作档库位移转失败，原因：检索源库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo());
			return;
			}
			// 源库位库位状态判断
			@@ -1013,7 +1571,11 @@
			// 获取目标库位信息
			LocMast sta = locMastService.selectById(wrkMast.getLocNo());
			if (null == sta) {
			log.error("工作档库位移转失败，原因：检索目标库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getLocNo());
			News.error(""+mark+" - 3"+" - 2"+" - 工作档库位移转失败，原因：检索目标库位失败！工作号={}，源库位={}", wrkMast.getWrkNo(), wrkMast.getLocNo());
			return;
			}
			if(sta.getLocType1() != sourceSta.getLocType1()){
			News.error("移库目标库位类型与源库位类型不符");
			return;
			}
			// 获取堆垛机信息并判断是否可入出
			@@ -1032,6 +1594,10 @@
			return;
			}

			News.warnNoLog(""+mark+" - 3"+" - 3"+" - 命令下发 : 工作号={},源排={},源列={},源层={},目标排={},目标列={},目标层={}",wrkMast.getWrkNo().shortValue()
			,sourceSta.getRow1().shortValue(),sourceSta.getBay1().shortValue(),sourceSta.getLev1().shortValue()
			,sta.getRow1().shortValue(),sta.getBay1().shortValue(),sta.getLev1().shortValue());

			// 命令下发区 --------------------------------------------------------------------------
			CrnCommand crnCommand = new CrnCommand();
			crnCommand.setCrnNo(slave.getId()); // 堆垛机编号
			@@ -1044,8 +1610,9 @@
			crnCommand.setDestinationPosX(sta.getRow1().shortValue()); // 目标库位排
			crnCommand.setDestinationPosY(sta.getBay1().shortValue()); // 目标库位列
			crnCommand.setDestinationPosZ(sta.getLev1().shortValue()); // 目标库位层
			crnCommand.setTraySize(sourceSta.getLocType1() == 2); //库位类型
			if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
			log.error("堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			News.error(""+mark+" - 3"+" - 4"+" - 堆垛机命令下发失败，堆垛机号={}，任务数据={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
			} else {
			// 修改工作档状态 11.生成出库ID => 12.吊车出库中
			Date now = new Date();
			@@ -1053,16 +1620,18 @@
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("【库位移转】修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			News.error(""+mark+" - 3"+" - 5"+" - 【库位移转】修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			}
			News.infoNoLog(""+mark+" - 3"+" - 0"+" - 堆垛机入出库作业下发：库位移转完成");

			}

			/**
			* 执行对工作档的完成操作
			*/
			public synchronized void storeFinished() {
			public synchronized void storeFinished(Integer mark) {

			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			@@ -1070,16 +1639,50 @@
			if (crnProtocol == null) {
			continue;
			}
			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			if (crnProtocol.getTaskNo() == 9999) {
			if(crnProtocol.getTaskNo() == 9999){
			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			News.warnNoLog("" + mark + " - 0" + " - 开始执行对工作档的完成操作，任务号:" + crnProtocol.getTaskNo());



			// 堆垛机复位
			News.warnNoLog("" + mark + " - 2" + " - 修改成功后复位堆垛机 : 堆垛机号={}", crnThread.getCrnProtocol().getCrnNo());
			crnThread.setResetFlag(true);
			} else {
			}
			} else if (crnProtocol.getTaskNo() == 9996) {//盘点入库衔接
			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			News.warnNoLog("" + mark + " - 0" + " - 开始执行对工作档的完成操作，任务号:" + crnProtocol.getTaskNo());

			// 获取入库待确认工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep3(crnProtocol.getTaskNo().intValue());
			if (wrkMast == null) {
			log.error("堆垛机处于等待确认且任务完成状态，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			// 入库 + 库位转移 ==> 4.入库完成
			if (wrkMast.getWrkSts() == 3 \|\| (wrkMast.getWrkSts() == 12 && wrkMast.getIoType() == 11)) {
			wrkMast.setWrkSts(4L);
			} else {
			continue;
			}
			Date now = new Date();
			wrkMast.setCrnEndTime(now);
			wrkMast.setModiTime(now);
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			log.error(wrkMast.getWrkNo() + "任务修改状态4成功，复位堆垛机={}", crnThread.getCrnProtocol().getCrnNo());
			News.warnNoLog("" + mark + " - 2" + " - 修改成功后复位堆垛机 : 堆垛机号={}", crnThread.getCrnProtocol().getCrnNo());
			crnThread.setResetFlag(true);
			}
			}
			}else{
			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			News.warnNoLog("" + mark + " - 0" + " - 开始执行对工作档的完成操作，任务号:" + crnProtocol.getTaskNo());

			// 获取入库待确认工作档
			WrkMast wrkMast = wrkMastMapper.selectPakInStep3(crnProtocol.getTaskNo().intValue());
			if (wrkMast == null ) {
			News.error("" + mark + " - 1" + " - 堆垛机处于等待确认且任务完成状态，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			continue;
			}
			// 入库 + 库位转移 ==> 4.入库完成
			@@ -1094,18 +1697,24 @@
			// 修改成功后复位堆垛机
			if (wrkMastMapper.updateById(wrkMast) > 0) {
			// 堆垛机复位
			log.error(wrkMast.getWrkNo() + "任务修改状态4成功，复位堆垛机={}", crnThread.getCrnProtocol().getCrnNo());
			News.warnNoLog("" + mark + " - 2" + " - 修改成功后复位堆垛机 : 堆垛机号={}", crnThread.getCrnProtocol().getCrnNo());
			crnThread.setResetFlag(true);
			}
			}

			}



			}
			// News.infoNoLog(""+mark+" - 0"+" - 对工作档的完成操作执行完成");
			}


			/**
			* 堆垛机异常信息记录
			*/
			public synchronized void recCrnErr() {
			public synchronized void recCrnErr(Integer mark) {
			Date now = new Date();
			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			@@ -1118,9 +1727,11 @@
			// if (crnProtocol.getModeType() != CrnModeType.STOP) {
			// 有任务
			if (crnProtocol.getTaskNo() != 0) {

			BasErrLog latest = basErrLogService.findLatestByTaskNo(crn.getId(), crnProtocol.getTaskNo().intValue());
			// 有异常
			if (latest == null) {
			News.warnNoLog(""+mark+" - 1"+" - 开始执行：堆垛机异常信息记录：有任务，有异常");
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			WrkMast wrkMast = wrkMastMapper.selectById(crnProtocol.getTaskNo());
			if (wrkMast == null) {
			@@ -1152,7 +1763,7 @@
			"任务中异常" // 备注
			);
			if (!basErrLogService.insert(basErrLog)) {
			log.error("堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			News.error(""+mark+" - 2"+" - 堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			}
			}
			} else {
			@@ -1162,7 +1773,7 @@
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basErrLogService.updateById(latest)) {
			log.error("堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			News.error(""+mark+" - 3"+" - 堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			}
			}
			}
			@@ -1171,6 +1782,7 @@
			BasErrLog latest = basErrLogService.findLatest(crn.getId());
			// 有异常
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			News.warnNoLog(""+mark+" - 4"+" - 开始执行：堆垛机异常信息记录：无任务，有异常");
			// 记录新异常
			if (latest == null \|\| (latest.getErrCode() != crnProtocol.getAlarm().intValue())) {
			BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
			@@ -1199,7 +1811,7 @@
			"无任务异常" // 备注
			);
			if (!basErrLogService.insert(basErrLog)) {
			log.error("堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			News.error(""+mark+" - 5"+" - 堆垛机plc异常记录失败 ===>> [id:{}] [error:{}]", crn.getId(), errName);
			}
			}
			// 无异常
			@@ -1210,7 +1822,7 @@
			latest.setUpdateTime(now);
			latest.setStatus(2);
			if (!basErrLogService.updateById(latest)) {
			log.error("堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			News.error(""+mark+" - 6"+" - 堆垛机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", crn.getId(), latest.getId());
			}
			}
			}
			@@ -1218,6 +1830,7 @@
			}

			}
			// News.infoNoLog(""+mark+" - 0"+" - 堆垛机异常信息记录执行完成");
			}


			@@ -1226,7 +1839,8 @@
			/**
			* 空栈板初始化入库,叉车入库站放货
			*/
			public synchronized void storeEmptyPlt() {
			public synchronized void storeEmptyPlt(Integer mark) {

			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历空板入库口
			for (DevpSlave.Sta emptyInSta : devp.getEmptyInSta()) {
			@@ -1244,13 +1858,19 @@
			ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, emptyInSta.getLed());
			}

			if (!staProtocol.isLoading()){
			continue;
			}

			// 站点条件判断
			if (staProtocol.isAutoing()
			&& staProtocol.isLoading()
			&& staProtocol.isInEnable()
			&& staProtocol.isEmptyMk()
			&& (staProtocol.getWorkNo() > 9990 && staProtocol.getWorkNo() <= 9999)
			&& staProtocol.isPakMk()) {
			&& staProtocol.isPakMk()
			&& (staProtocol.getWorkNo() !=0 && staProtocol.getWorkNo() > 9700)
			) {
			News.warnNoLog(""+mark+" - 0"+" - 开始执行：空栈板初始化入库,叉车入库站放货");

			try {
			LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
			@@ -1270,11 +1890,13 @@
			StartupDto dto = jsonObject.getObject("data", StartupDto.class);

			// 更新站点信息且下发plc命令
			staProtocol.setWorkNo(dto.getWorkNo().shortValue());
			staProtocol.setStaNo(dto.getStaNo().shortValue());
			staProtocol.setWorkNo(dto.getWorkNo());
			staProtocol.setStaNo(staProtocol.getSiteId().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			log.error("输送线下发6："+dto.getWorkNo()+","+staProtocol.getSiteId());
			if (!result) {
			News.errorNoLog(""+mark+" - 1"+" - 更新plc站点信息失败");
			throw new CoolException("更新plc站点信息失败");
			}

			@@ -1289,41 +1911,46 @@
			ledCommand.setLocNo(dto.getLocNo());
			ledCommand.setStaNo(dto.getStaNo());
			commands.add(ledCommand);
			MessageQueue.offer(SlaveType.Led, emptyInSta.getLed(), new Task(3, commands));
			MessageQueue.offer(SlaveType.Led, emptyInSta.getLed(), new Task(1, commands));
			// ledThread.errorReset();
			}
			} else {
			staProtocol.setWorkNo((short)9999);
			staProtocol.setStaNo(emptyInSta.getBackSta().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			if (!result) {
			throw new CoolException("更新plc站点信息失败");
			}

			// staProtocol.setWorkNo(wrkNo++);
			// staProtocol.setStaNo(emptyInSta.getBackSta().shortValue());
			// devpThread.setPakMk(staProtocol.getSiteId(), false);
			// boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// if (!result) {
			// News.errorNoLog(""+mark+" - 2"+" - 更新plc站点信息失败");
			// throw new CoolException("更新plc站点信息失败");
			// }
			//
			if (ledThread != null) {
			String errorMsg = jsonObject.getString("msg");
			if (!Cools.isEmpty(errorMsg)) {
			MessageQueue.offer(SlaveType.Led, emptyInSta.getLed(), new Task(5, errorMsg));
			MessageQueue.offer(SlaveType.Led, emptyInSta.getLed(), new Task(3, errorMsg));
			}
			}
			log.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			// News.error(""+mark+" - 3"+" - 请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}

			} else {
			News.errorNoLog(""+mark+" - 4"+" - 站点信息不符合入库条件！！！"+" 自动信号："+staProtocol.isAutoing()+"、可入信号：" + staProtocol.isInEnable()
			+"、空板信号："+ staProtocol.isEmptyMk()+"、工作号：" + staProtocol.getWorkNo()
			+"、锁定标记"+ staProtocol.isPakMk());
			}

			}
			}
			// News.infoNoLog(""+mark+" - 0"+" - 空栈板初始化入库,叉车入库站放货执行完成");
			}

			/**
			* 出库 ===>> 工作档信息写入led显示器
			*/
			public synchronized void ledExecute() {
			public synchronized void ledExecute(Integer mark) {
			for (LedSlave led : slaveProperties.getLed()) {
			// 获取输送线plc线程
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
			@@ -1341,10 +1968,7 @@
			}
			// 获取工作档数据
			WrkMast wrkMast = wrkMastMapper.selectById(staProtocol.getWorkNo());
			// if (null == wrkMast \|\| wrkMast.getWrkSts() < 14 \|\| wrkMast.getIoType() < 100) { continue; }
			if (null == wrkMast) {
			continue;
			}
			if (null == wrkMast) { continue; }
			wrkMasts.add(wrkMast);
			// 组装命令
			LedCommand ledCommand = new LedCommand();
			@@ -1375,16 +1999,34 @@
			ledCommand.setEmptyMk(true);
			break;
			default:
			log.error("任务入出库类型错误！！！[工作号：{}] [入出库类型：{}]", wrkMast.getWrkNo(), wrkMast.getIoType());
			News.error("任务入出库类型错误！！！[工作号：{}] [入出库类型：{}]", wrkMast.getWrkNo(), wrkMast.getIoType());
			break;
			}
			ledCommand.setSourceLocNo(wrkMast.getSourceLocNo());
			ledCommand.setLocNo(wrkMast.getLocNo());
			ledCommand.setStaNo(wrkMast.getStaNo());
			// ledCommand.setSourceStaNo(wrkMast.getSourceStaNo());
			ledCommand.setBarcode(wrkMast.getBarcode());
			if (wrkMast.getIoType() != 110 && wrkMast.getIoType() != 10) {
			List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
			wrkDetls.forEach(wrkDetl -> ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getAnfme())));

			wrkDetls.forEach(wrkDetl -> {
			Double total = 0.0;
			EntityWrapper<LocDetl> wrapper = new EntityWrapper<>();
			LocDetl locDetl = locDetlService.selectOne(wrapper.eq("zpallet", wrkDetl.getZpallet()).eq("matnr", wrkDetl.getMatnr()));
			if (Cools.isEmpty(locDetl)) {
			total = wrkDetl.getAnfme();
			} else {
			total = locDetl.getAnfme();
			}
			if (wrkMast.getIoType() == 101 \|\| wrkMast.getIoType() == 1) {
			ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getBatch(), wrkDetl.getSpecs(), wrkDetl.getManu(), wrkDetl.getMemo(), wrkDetl.getAnfme(),total));
			}
			if (wrkMast.getIoType() == 103 && (null == wrkDetl.getInspect() \|\| 0 == wrkDetl.getInspect())) {
			ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getBatch(), wrkDetl.getSpecs(), wrkDetl.getManu(), wrkDetl.getMemo(), wrkDetl.getAnfme(),total));
			}
			if (wrkMast.getIoType() == 107) {
			ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getBatch(), wrkDetl.getSpecs(), wrkDetl.getManu(), wrkDetl.getMemo(), wrkDetl.getAnfme(),total));
			}
			});
			}
			commands.add(ledCommand);
			}
			@@ -1397,22 +2039,10 @@
			}
			// 命令下发 -------------------------------------------------------------------------------
			if (!commands.isEmpty()) {
			if (led.getId() == 7) {
			if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(3, commands))) {
			log.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
			continue;
			} else {
			ledThread.setLedMk(false);
			}
			} else {
			if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(1, commands))) {
			log.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
			continue;
			} else {
			ledThread.setLedMk(false);
			}
			if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(1, commands))) {
			News.error("{}号LED显示内容命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
			continue;
			}

			}

			try {
			@@ -1448,10 +2078,8 @@
			for (Integer staNo : led.getStaArr()) {
			// 获取叉车站点
			StaProtocol staProtocol = devpThread.getStation().get(staNo);
			if (staProtocol == null) {
			continue;
			}
			if (staProtocol.getWorkNo() != 0 && staProtocol.isLoading()) {
			if (staProtocol == null) { continue; }
			if (staProtocol.getWorkNo() != 0 \|\| staProtocol.isErr()) {
			reset = false;
			break;
			}
			@@ -1459,12 +2087,12 @@
			// 获取led线程
			LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
			// led显示默认内容
			if (reset && !ledThread.isLedMk()) {
			ledThread.setLedMk(true);
			if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(4, new ArrayList<>()))) {
			log.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
			} else {

			if (reset) {
			if (ledThread == null) {
			continue;
			}
			if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(2, new ArrayList<>()))) {
			News.error("{}号LED显示默认命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
			}
			}
			}
			@@ -1550,8 +2178,10 @@
			* 因双深库位阻塞，对浅库位进行移转（立即执行版)
			* tip：同步
			*/
			private synchronized void moveLocForDeepLoc(CrnSlave crn, LocMast shallowLoc) {
			private synchronized void moveLocForDeepLoc(CrnSlave crn, LocMast shallowLoc,Integer mark) {

			try {
			News.warnNoLog(""+mark+"moveLocForDeepLoc"+" - 0"+" - 开始执行:因双深库位阻塞，对浅库位进行移转（立即执行版)");
			List<Integer> rows = locMastService.queryDistinctRow(crn.getId());
			LocMast loc = null;
			for (Integer row : rows) {
			@@ -1593,7 +2223,7 @@
			}

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

			@@ -1609,7 +2239,7 @@
			wrkMast.setCrnNo(crn.getId());
			wrkMast.setSourceLocNo(shallowLoc.getLocNo()); // 源库位
			wrkMast.setLocNo(loc.getLocNo()); // 目标库位
			wrkMast.setFullPlt(shallowLoc.getFullPlt()); // 满板
			wrkMast.setFullPlt(shallowLoc.getLocSts().equals("F") ? "Y" : "N"); // 满板
			wrkMast.setPicking("N"); // 拣料
			wrkMast.setExitMk("N"); // 退出
			wrkMast.setEmptyMk(shallowLoc.getLocSts().equals("D") ? "Y" : "N"); // 空板
			@@ -1619,6 +2249,7 @@
			wrkMast.setModiTime(new Date());
			int res = wrkMastMapper.insert(wrkMast);
			if (res == 0) {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 2"+" - 保存工作档失败");
			throw new CoolException("保存工作档失败");
			}
			// 工作档明细保存
			@@ -1633,6 +2264,7 @@
			wrkDetl.setAppeTime(new Date());
			wrkDetl.setModiTime(new Date());
			if (!wrkDetlService.insert(wrkDetl)) {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 3"+" - 保存工作档明细失败");
			throw new CoolException("保存工作档明细失败");
			}
			}
			@@ -1642,9 +2274,11 @@
			shallowLoc.setLocSts("R"); // R.出库预约
			shallowLoc.setModiTime(new Date());
			if (!locMastService.updateById(shallowLoc)) {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 4"+" - 更新源库位状态失败");
			throw new CoolException("更新源库位状态失败");
			}
			} else {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 5"+" - 源库位出库失败");
			throw new CoolException("源库位出库失败");
			}
			// 修改目标库位状态
			@@ -1652,13 +2286,15 @@
			loc.setLocSts("S"); // S.入库预约
			loc.setModiTime(new Date());
			if (!locMastService.updateById(loc)) {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 6"+" - 更新目标库位状态失败");
			throw new CoolException("更新目标库位状态失败");
			}
			} else {
			News.errorNoLog(""+mark+"moveLocForDeepLoc"+" - 7"+" - 移转失败");
			throw new CoolException("移转失败");
			}
			} catch (Exception e) {
			log.error("双深库位阻塞，对浅库位进行移转失败", e);
			News.error(""+mark+"moveLocForDeepLoc"+" - 8"+" - 双深库位阻塞，对浅库位进行移转失败", e);
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			@@ -1759,7 +2395,7 @@
			}
			}
			} catch (Exception e) {
			log.error("堆垛机演示 ===>> 库位移转失败", e);
			News.error("堆垛机演示 ===>> 库位移转失败", e);
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			@@ -1786,27 +2422,27 @@
			}
			// 入库
			if (wrkMast.getWrkSts() == 1 \|\| wrkMast.getWrkSts() == 2) {
			log.warn("堆垛机非空闲情况下，开始修改工作档状态。[id:{},时间：{}] >>>>> 堆垛机当前状态为：{}。任务号:{}", crn.getId(), DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), crnProtocol.getStatusType().desc, crnProtocol.getTaskNo());
			News.warn("堆垛机非空闲情况下，开始修改工作档状态。[id:{},时间：{}] >>>>> 堆垛机当前状态为：{}。任务号:{}", crn.getId(), DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), crnProtocol.getStatusType().desc, crnProtocol.getTaskNo());
			// 修改工作档状态 2.设备上走 => 3.吊车入库中
			wrkMast.setWrkSts(3L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("修改工作档状态 2.设备上走 => 3.吊车入库中失败！！，工作号={}", wrkMast.getWrkNo());
			News.error("修改工作档状态 2.设备上走 => 3.吊车入库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			log.warn("修改工作档状态成功。[时间：{}] >>>>> 任务号:{}", DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), wrkMast.getWrkNo());
			News.warn("修改工作档状态成功。[时间：{}] >>>>> 任务号:{}", DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), wrkMast.getWrkNo());
			}
			// 出库、移库
			if (wrkMast.getWrkSts() == 11) {
			log.warn("堆垛机非空闲情况下，开始修改工作档状态。[id:{},时间：{}] >>>>> 堆垛机当前状态为：{}。任务号:{}", crn.getId(), DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), crnProtocol.getStatusType().desc, crnProtocol.getTaskNo());
			News.warn("堆垛机非空闲情况下，开始修改工作档状态。[id:{},时间：{}] >>>>> 堆垛机当前状态为：{}。任务号:{}", crn.getId(), DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), crnProtocol.getStatusType().desc, crnProtocol.getTaskNo());
			// 修改工作档状态 11.生成出库ID => 12.吊车出库中
			wrkMast.setWrkSts(12L);
			wrkMast.setCrnStrTime(now);
			wrkMast.setModiTime(now);
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			News.error("修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", wrkMast.getWrkNo());
			}
			log.warn("修改工作档状态成功。[时间：{}] >>>>> 任务号:{}", DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), wrkMast.getWrkNo());
			News.warn("修改工作档状态成功。[时间：{}] >>>>> 任务号:{}", DateUtils.convert(now, DateUtils.yyyyMMddHHmmsssss_F), wrkMast.getWrkNo());
			}


			@@ -1878,94 +2514,1656 @@

			}

			public synchronized void outOfDevp() {
			public synchronized void outOfDevp(Integer mark) {

			List<WrkMast> wrkMasts = wrkMastMapper.selectPick();
			if (wrkMasts.size()!=0){
			News.warnNoLog(""+mark+" - 0"+" - 开始执行outOfDevp");
			}
			for (WrkMast wrkMast : wrkMasts) {
			if (basDevpService.selectCount(new EntityWrapper<BasDevp>().eq("wrk_no", wrkMast.getWrkNo())) == 0) {
			wrkMast.setCtnNo("Y");
			if (wrkMastMapper.updateById(wrkMast) == 0) {
			log.error("修改{}工作档失败，ctn_no", wrkMast.getWrkNo());
			News.error(""+mark+" - 1"+" - 修改{}工作档失败，ctn_no", wrkMast.getWrkNo());
			}
			}

			}
			// News.infoNoLog(""+mark+" - 0"+" - outOfDevp执行完成");
			}


			public synchronized void autoEmptyOut() {
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			Integer autoOutSite = 12;
			//如果站点可出禁用，则不生成空盘出库任务
			StaProtocol staProtocol = devpThread.getStation().get(autoOutSite);
			if (staProtocol == null) {
			return;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (staProtocol.isAutoing() //自动
			&& !staProtocol.isLoading() //无物
			&& staProtocol.isOutEnable() //可出信号
			&& staProtocol.getWorkNo() == 0
			) {
			WrkMast pakoutEmpty = wrkMastMapper.selectPakoutEmpty(autoOutSite);
			if (null != pakoutEmpty) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			List<Integer> list = new ArrayList<>();
			list.add(1108);list.add(2031);
			for (Integer site:list){
			Integer emptyCount = wrkMastMapper.countPakOutEmpty(site);
			StaProtocol staProtocol = null;
			if(emptyCount >= 2 && site == 1108){
			continue;
			}else if(emptyCount == 1 && site == 2031){
			continue;
			}
			//如果站点可出禁用，则不生成空盘出库任务
			switch (site){
			case 1108:staProtocol = devpThread.getStation().get(site - 2);break;
			case 2031:staProtocol = devpThread.getStation().get(site);break;
			}
			if (staProtocol == null) {
			return;
			} else {
			staProtocol = staProtocol.clone();
			}
			try {
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/emptyOut/v1")
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			JSONObject data = (JSONObject) jsonObject.get("data");
			log.info((String) data.get("msg"));
			} else {
			log.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/auto/emptyOut/v1","", response);
			if (staProtocol.isAutoing() //自动
			&& !staProtocol.isLoading() //无物
			&& staProtocol.isOutEnable() //可出信号
			&& staProtocol.getWorkNo() == 0
			) {
			Short loctype1 = 1;
			LocTypeDto locTypeDto = new LocTypeDto(loctype1, (short) 1, (short) 1);
			locTypeDto.setSiteId(site);
			try {
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/emptyOut/v1")
			.setJson(JSON.toJSONString(locTypeDto))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			String data = jsonObject.get("data").toString();
			News.info((String) jsonObject.get("msg")+","+data);
			} else {
			News.warnNoLog("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/auto/emptyOut/v1","", response);
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			}

			}

			public synchronized void autoEmptyIn() {
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			Integer autoInSite = 12;
			StaProtocol staProtocol = devpThread.getStation().get(autoInSite);
			if (staProtocol == null) {
			return;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (staProtocol.isAutoing() //自动
			&& staProtocol.isLoading() //有物
			&& staProtocol.isInEnable() //可入信号
			&& (staProtocol.getWorkNo() == 0 \|\| staProtocol.getWorkNo() > 9990) //工作号为0或者工作号是9991~9999（输送机留用）
			) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			List<Integer> list = new ArrayList<>();
			list.add(1038);
			for (Integer site:list){
			StaProtocol staProtocol = devpThread.getStation().get(site);
			if (staProtocol == null) {
			return;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (staProtocol.isAutoing() //自动
			&& staProtocol.isLoading() //有物
			&& staProtocol.isInEnable() //可入信号
			&& staProtocol.isPakMk()
			&& (staProtocol.getWorkNo() == 0 \|\| staProtocol.getWorkNo() > 9990) //工作号为0或者工作号是9991~9999（输送机留用）
			) {

			try {
			LocTypeDto locTypeDto = new LocTypeDto((short) 1, (short) 1, (short) 1);
			try {
			Short loctype1 = 1;
			LocTypeDto locTypeDto = new LocTypeDto(loctype1, (short) 1, (short) 1);
			locTypeDto.setSiteId(site);


			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/emptyIn/v1")
			.setJson(JSON.toJSONString(locTypeDto))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			log.info((String) jsonObject.get("msg"));
			} else {
			log.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/auto/emptyIn/v1", JSON.toJSONString(locTypeDto), response);
			String response = new HttpHandler.Builder()
			.setUri(wmsUrl)
			.setPath("/rpc/auto/emptyIn/v1")
			.setJson(JSON.toJSONString(locTypeDto))
			.build()
			.doPost();
			JSONObject jsonObject = JSON.parseObject(response);
			if (jsonObject.getInteger("code").equals(200)) {
			News.info((String) jsonObject.get("msg"));
			staProtocol.setWorkNo(jsonObject.get("data").hashCode());
			staProtocol.setStaNo(site.shortValue());
			devpThread.setPakMk(site,false);
			MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol));
			} else {
			News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/auto/emptyIn/v1", JSON.toJSONString(locTypeDto), response);
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}
			} catch (Exception e) {
			e.printStackTrace();
			TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
			}

			}

			}

			/*
			* 小车地图更新更新锁
			* */
			public synchronized boolean rgvMapUpdate(BasRgvMap basRgvMapCurrent,Integer staStart,Integer staEnd,String sign){
			// log.info("小车地图更新！[标记：{}];[BasRgvMap：{}];[staStart：{}];[staEnd：{}];",sign,JSON.toJSONString(basRgvMapCurrent),staStart,staEnd);

			// List<Integer> integers = RouteUtils.RouteMapCurrentFar(basRgvMapCurrent.getNowRoute(),staStart,staEnd, basRgvMapCurrent.getLockStartRoute());
			//更新当前小车锁
			try{
			Integer farCurrentStaNo = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getNowRoute(), staStart, staEnd, basRgvMapCurrent.getLockStartRoute());//获取最远站点
			// log.info("小车地图更新！获取最远站点;[farCurrentStaNo：{}]",farCurrentStaNo);
			Integer fallMerge = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getRgvNo(), farCurrentStaNo); //获取合并干涉项
			// log.info("小车地图更新！获取合并干涉项;[fallMerge：{}]",fallMerge);
			basRgvMapCurrent.setLockEndRoute(fallMerge);
			Integer i = basRgvMapMapper.updateById(basRgvMapCurrent);
			// if (i>0){
			// log.error("{}:==>{}:{}号车更新结束锁,{}",sign,new Date(),basRgvMapCurrent.getRgvNo(),JSON.toJSONString(basRgvMapCurrent));
			// }

			//更新另一台小车地图
			Integer rgvNoOther = basRgvMapCurrent.getRgvNoOther(basRgvMapCurrent.getRgvNo());
			// log.info("小车地图更新！另一台小车号;[rgvNoOther：{}]",rgvNoOther);

			BasRgvMap basRgvMapOther = basRgvMapMapper.selectById(rgvNoOther);
			// log.info("小车地图更新！另一台小车;[basRgvMapOther：{}]",JSON.toJSONString(basRgvMapOther));

			List<Integer> integers = RouteUtils.RouteMapCurrentFar(fallMerge, basRgvMapCurrent.getLockStartRoute());
			Integer lockEndRoute = RouteUtils.RouteMapOtherFarStnNo(integers, basRgvMapCurrent.getLockStartRoute());//另一台小车可活动最远位置
			// log.info("小车地图更新！另一台小车可活动最远位置;[lockEndRoute：{}]",lockEndRoute);
			basRgvMapOther.setEndRoute(lockEndRoute);
			Integer i1 = basRgvMapMapper.updateById(basRgvMapOther);
			// if (i1>0){
			// log.error("{}:==>{}:{}号车更新结束位置,{}",sign,new Date(),basRgvMapOther.getRgvNo(),JSON.toJSONString(basRgvMapOther));
			// }
			return true;
			}catch (Exception e){
			log.error("小车地图更新出错！异常原因："+e);
			return false;
			}
			}

			/*
			* 刷新地图数据
			* */
			public synchronized void refreshRgvMap() {
			try{
			List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
			for (BasRgvMap rgvSlave:basRgvMaps) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			continue;
			}else {
			rgvProtocol = rgvProtocol.clone();
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！2", rgvSlave.getRgvNo());
			continue;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE &&
			rgvProtocol.getModeType() == RgvModeType.AUTO
			&& !rgvProtocol.isLoaded1ing() //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			&& (rgvProtocol.getTaskNo1()==0)
			&&rgvThread.isPakMk()
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());

			Integer rgvNoOther = basRgvMap.getRgvNoOther((int) rgvProtocol.getRgvNo());
			RgvThread rgvThreadOther = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvNoOther);
			RgvProtocol rgvProtocolOther = rgvThreadOther.getRgvProtocol();
			if (rgvProtocolOther == null) {
			continue;
			}else {
			rgvProtocolOther = rgvProtocolOther.clone();
			}
			if (rgvProtocolOther.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocolOther.getModeType() == RgvModeType.AUTO
			&& !rgvProtocolOther.isLoaded1ing()
			&& (rgvProtocolOther.getTaskNo1()==0)
			&&rgvThreadOther.isPakMk()
			){
			//对工作档进行判断
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			if (rgvProtocol.getTaskNo1() >0 && rgvProtocol.getTaskNo1()<=9000){
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1().intValue());
			rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2366");
			}else if (rgvProtocol.getTaskNo1() == 0){
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2366");
			}

			}



			}
			}
			}catch (Exception e){
			log.error("4109行执行小车初始化任务下发失败");
			log.error("4109行"+e);
			}
			}

			/**
			* 自动生成RGV接驳任务（检索出入口任务，生成对应RGV任务，检索4楼任务，非3号堆垛机，则生成对应接驳任务）
			*/
			// public synchronized void rgvCreateWrkMastSta(){
			// try{
			// for (DevpSlave devp : slaveProperties.getDevp()) {
			// SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			// StaProtocol staProtocol = devpThread.getStation().get(1105);
			// if (staProtocol == null) {
			// continue;
			// } else {
			// staProtocol = staProtocol.clone();
			// }
			// if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			// continue;
			// }
			// }
			// }
			// }


			/**
			* 完成小车任务
			*/
			public synchronized void rgvCompleteWrkMastSta() {
			try{
			for (DevpSlave devp : slaveProperties.getDevp()) {
			List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
			for (RgvSlave rgv : slaveProperties.getRgv()) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			continue;
			}else {
			rgvProtocol = rgvProtocol.clone();
			}
			BasRgv basRgv = basRgvService.selectById(rgv.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！3", rgv.getId());
			continue;
			}

			// 只有当RGV工位1等待WCS确认、自动
			if ((rgvProtocol.getStatusType1() == RgvStatusType.WAITING \|\| rgvProtocol.getStatusType1()==RgvStatusType.FETCHWAITING)
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& (rgvProtocol.getStatusType() == RgvStatusType.WORKING1)
			){
			log.info("{}号小车等待wcs确认，状态{}，参数{}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
			if(rgvProtocol.getTaskNo1() == 9999){ // 预调度任务确认
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			Integer staNo = basRgvMap.getNowRoute();
			switch (staNo){
			case 1004: staNo = 1042; break;
			case 1007: staNo = 1105; break;
			}

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(staNo);
			boolean rgvComplete = false;

			// long now = System.currentTimeMillis();
			// if (staProtocol.isLoading()) {
			// rgvProtocol.setLoadingStartTime(null); // 已到位，清空时间戳
			// } else {
			// if (rgvProtocol.getLoadingStartTime() == null) {
			// rgvProtocol.setLoadingStartTime(now);
			// }
			// }

			if (staProtocol.isLoading()) {
			rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(), 3);
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！等待入库取货", rgvProtocol.getRgvNo());
			}
			}
			}
			if (rgvProtocol.getTaskNo1()!=0 && rgvProtocol.getTaskNo1()!=9999){
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1());
			if(wrkMastSta.getWrkSts() == 1){//取货确认
			wrkMastSta.setWrkSts(2);
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			boolean rgvComplete = false;

			rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),7);
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			break;
			}
			if (Cools.isEmpty(wrkMastSta) \|\| wrkMastSta.getWrkSts()!=1){
			log.error("未查到小车执行任务或者执行任务状态不符合！"+wrkMastSta);
			continue;
			}

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			continue;
			}
			WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
			if (!Cools.isEmpty(wrkMast)){
			if (!staProtocol.isPakMk()){
			continue;
			}
			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			log.error("rgv任务完成给输送线下发命令："+wrkMast.getWrkNo()+","+wrkMast.getStaNo());
			if (!MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol))) {
			continue;
			}
			}
			boolean rgvComplete = false;

			rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),3);
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			WrkMast wrkMast1 = wrkMastService.selectByWrkNo(rgvProtocol.getTaskNo1());
			wrkMast1.setPdcType("Y");

			wrkMastService.updateById(wrkMast1);

			wrkMastSta.setWrkSts(3);
			wrkMastStaMapper.updateById(wrkMastSta);
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2471");
			}

			else {
			log.error("小车复位失败，小车号{},等待wcs确认但是没有工作号！",rgvProtocol.getRgvNo());
			}
			}
			// 只有当RGV工位2等待WCS确认、自动
			if ((rgvProtocol.getStatusType2() == RgvStatusType.WAITING \|\| rgvProtocol.getStatusType2()==RgvStatusType.FETCHWAITING)
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& (rgvProtocol.getStatusType() == RgvStatusType.WORKING1)
			){
			log.info("{}号小车等待wcs确认，状态{}，参数{}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
			if (rgvProtocol.getTaskNo2() !=0 ){
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1());
			if(wrkMastSta.getWrkSts() == 1){//缺货确认
			wrkMastSta.setWrkSts(2);
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			boolean rgvComplete = false;

			rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),7);
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			break;
			}
			if (Cools.isEmpty(wrkMastSta) \|\| wrkMastSta.getWrkSts()!=1){
			log.error("未查到小车执行任务或者执行任务状态不符合！"+wrkMastSta);
			continue;
			}

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			continue;
			}
			WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
			if (!Cools.isEmpty(wrkMast)){
			if (!staProtocol.isPakMk()){
			continue;
			}
			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			log.error("rgv任务完成给输送线下发命令："+wrkMast.getWrkNo()+","+wrkMast.getStaNo());
			if (!MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol))) {
			continue;
			}
			}
			int sourceSta = wrkMast.getSourceStaNo();
			boolean rgvComplete = false;

			//双工位出入库不同工位复位
			rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),6);

			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			WrkMast wrkMast1 = wrkMastService.selectByWrkNo(rgvProtocol.getTaskNo1());
			wrkMast1.setPdcType("Y");

			wrkMastService.updateById(wrkMast1);

			wrkMastSta.setWrkSts(3);
			wrkMastStaMapper.updateById(wrkMastSta);
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2471");
			}
			else {
			log.error("小车复位失败，小车号{},等待wcs确认但是没有工作号！",rgvProtocol.getRgvNo());
			}
			}
			//当小车无任务时取消锁定
			if(rgvProtocol.getTaskNo1() == 0 && rgvProtocol.getTaskNo2() == 0){
			rgvThread.setPakMk(true);
			rgvThread.setPakIn(true);
			rgvThread.setPakOut(true);
			}
			}
			}
			}catch (Exception e){
			log.error("小车复位线程报错！"+e);
			}
			}

			/**
			* rgv放货任务下发
			*/
			public synchronized void rgvOutExecute() {
			for (RgvSlave rgv : slaveProperties.getRgv()) {
			// 获取RGV信息
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			continue;
			}
			BasRgv basRgv = basRgvService.selectById(rgv.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！4", rgv.getId());
			continue;
			}
			//小车无任务时跳过
			if(rgvProtocol.getTaskNo1() ==0 && rgvProtocol.getTaskNo2() == 0){
			continue;
			}
			//入库放货
			if(rgvThread.isPakIn()){
			for(RgvSlave.RgvStn rgvStn : rgv.getRgvInPStn()){//入库放货站点
			boolean flag = false;

			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
			if (staProtocol == null) {
			News.infoNoLog( " - 1" + " - 1" + " - Rgv入库放货站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
			if (staDetl == null) {
			News.error( " - 1" + " - 2" + " - 入库 ===>>Rgv放货站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}

			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
			&& staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
			flag = true;
			}
			if (!flag) {
			News.errorNoLog( " - 1" + " - 3" + " - Rgv入库放货站信息(以下需要全true):"
			+ "自动信号" + staProtocol.isAutoing() + "有物信号" + staProtocol.isLoading()
			+ "工作号>0" + staProtocol.getWorkNo() + "可入信号" + staProtocol.isInEnable()
			+ "能入信号（wms设置）.equals(\"Y\")" + staDetl.getCanining());
			continue;
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			Integer wrkNo = 0;
			if(rgvProtocol.getTaskNo2() != 0){
			wrkNo = rgvProtocol.getTaskNo2();
			}else{
			wrkNo = rgvProtocol.getTaskNo1();
			}
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(wrkNo));//根据站点工作号和小车工作范围检索任务档
			if( null == wrkMastSta ) {
			News.infoNoLog( " - 1" + " - 4" + " - 查询无待入库数据--wrk_sts0, 工作号={}", staProtocol.getWorkNo());
			continue;
			}
			boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,null); //命令下发
			if (sign){
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			if (!signMap){
			log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			} else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}

			}
			}
			//出库放货
			if( rgvThread.isPakOut()){
			for(RgvSlave.RgvStn rgvStn : rgv.getRgvOutPStn()){//入库放货站点
			boolean flag = false;

			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
			if (staProtocol == null) {
			News.infoNoLog( " - 1" + " - 1" + " - Rgv出库放货站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
			if (staDetl == null) {
			News.error( " - 1" + " - 2" + " - 出库 ===>>Rgv放货站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}

			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isOutEnable()
			&& staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
			flag = true;
			}
			if (!flag) {
			News.errorNoLog( " - 1" + " - 3" + " - Rgv出库放货站信息(以下需要全true):"
			+ "自动信号" + staProtocol.isAutoing() + "有物信号" + staProtocol.isLoading()
			+ "工作号>0" + staProtocol.getWorkNo() + "可入信号" + staProtocol.isOutEnable()
			+ "能入信号（wms设置）.equals(\"Y\")" + staDetl.getCanouting());
			continue;
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			Integer wrkNo = 0;
			if(rgvProtocol.getTaskNo1() != 0){
			wrkNo = rgvProtocol.getTaskNo1();
			}else{
			wrkNo = rgvProtocol.getTaskNo2();
			}
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(wrkNo));//根据站点工作号和小车工作范围检索任务档
			if( null == wrkMastSta ) {
			News.infoNoLog( " - 1" + " - 4" + " - 查询无待出库数据--wrk_sts0, 工作号={}", staProtocol.getWorkNo());
			continue;
			}
			wrkMastSta.setWrkSts(2);
			boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,null); //命令下发
			if (sign){
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			if (!signMap){
			log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			} else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}

			}
			}
			rgvThread.setPakRgv(true);//优先放货完成，开启预调度
			}
			}



			/**
			* rgv出入库任务下发
			*/
			public synchronized void rgvIoExecute(Integer mark) {
			List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());

			for (RgvSlave rgv : slaveProperties.getRgv()) {
			// 获取堆垛机信息
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			continue;
			}
			BasRgv basRgv = basRgvService.selectById(rgv.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！4", rgv.getId());
			continue;
			}

			// 只有当RGV空闲并且无任务时才继续执行
			if ((rgvProtocol.getStatusType1() == RgvStatusType.IDLE \|\| rgvProtocol.getStatusType2() == RgvStatusType.IDLE)
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvThread.isPakMk()) {
			News.warnNoLog(""+mark+" - 0"+" - 开始执行RGV入出库作业下发");
			// 如果最近一次是入库模式
			if (rgvProtocol.getLastIo().equals("I")) {
			if (basRgv.getInEnable().equals("Y") && rgvThread.isPakIn()) {
			//mark - 1 - ....
			this.rgvRunWrkMastIn(rgv, rgvProtocol,mark); // 入库
			rgvProtocol.setLastIo("O");
			} else if (basRgv.getOutEnable().equals("Y") && rgvThread.isPakOut()) {
			//mark - 2 - ....
			this.rgvRunWrkMastOut(rgv, rgvProtocol,mark); // 出库
			rgvProtocol.setLastIo("I");
			}
			}
			// 如果最近一次是出库模式
			else if (rgvProtocol.getLastIo().equals("O")) {
			if (basRgv.getOutEnable().equals("Y") && rgvThread.isPakOut()) {
			this.rgvRunWrkMastOut(rgv, rgvProtocol,mark); // 出库
			rgvProtocol.setLastIo("I");
			} else if (basRgv.getInEnable().equals("Y") && rgvThread.isPakIn()) {
			this.rgvRunWrkMastIn(rgv, rgvProtocol,mark); // 入库
			rgvProtocol.setLastIo("O");
			}
			}
			WrkMastSta wrkMastSta2 = wrkMastStaMapper.selectByWorkSta(2, (int) rgvProtocol.getRgvNo());
			WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWorkSta(1, (int) rgvProtocol.getRgvNo());
			if(wrkMastSta1 != null && wrkMastSta2 != null){
			rgvThread.setPakMk(false); //小车双工位锁定
			}
			}
			if(rgvProtocol.getStatusType1() == RgvStatusType.IDLE && rgvProtocol.getTaskNo1() == 0 && rgvThread.isPakIn() && rgvThread.isPakRgv()){
			rgvPreScheduling();//若暂无下发任务预调度提前到取货点
			}

			if (rgvProtocol.getStatusType1() == RgvStatusType.IDLE && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO) {
			//小车执行放货任务
			rgvOutExecute();

			}
			}
			}
			/**
			* 小车入库任务取货下发
			*/
			public synchronized void rgvRunWrkMastIn(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark) {
			for (RgvSlave.RgvStn rgvStn : slave.getRgvInTStn()) {//rgv入库取货站点
			boolean flag = false;
			boolean ds = false;
			//遍历rgv入库取货站点
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
			StaProtocol staProtocol2 = null;

			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
			if(rgvStn.getStaNo2()!= null ){
			staProtocol2 = devpThread.getStation().get(rgvStn.getStaNo2());
			if (staProtocol2 == null) {
			News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv入库站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol2 = staProtocol2.clone();
			}
			BasDevp staDetl2 = basDevpService.selectById(rgvStn.getStaNo2());
			if (staDetl2 == null) {
			News.error("" + mark + " - 1" + " - 2" + " - 入库 ===>>Rgv站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}
			}
			if (staProtocol == null) {
			News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv入库站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}

			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
			if (staDetl == null) {
			News.error("" + mark + " - 1" + " - 2" + " - 入库 ===>>Rgv站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}


			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
			&& staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
			flag = true;
			}
			if (!flag) {
			News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv入库取货站信息(以下需要全true):"
			+ "自动信号" + staProtocol.isAutoing() + "有物信号" + staProtocol.isLoading()
			+ "工作号>0" + staProtocol.getWorkNo() + "可入信号" + staProtocol.isInEnable()
			+ "能入信号（wms设置）.equals(\"Y\")" + staDetl.getCanining());
			continue;
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol.getWorkNo()));//根据站点工作号和小车工作范围检索任务档

			if( null == wrkMastSta ) {
			News.infoNoLog("" + mark + " - 1" + " - 4" + " - 查询无待入库数据--wrk_sts0, 工作号={}", staProtocol.getWorkNo());
			continue;
			}
			WrkMastSta wrkMastSta2 = wrkMastStaMapper.selectByWorkSta(2, (int) rgvProtocol.getRgvNo());
			boolean result = false;
			if(wrkMastSta2 != null && rgvProtocol.getRgvNo() == 1){ //距离计算 2楼单入库口不需要计算
			result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta2.getStaEnd(),wrkMastSta.getStaStart());//工位2放货站点，工位1取货站点
			}
			if(result){//若小车距离放货点距离近于取货点则跳过取货 true跳过取货/false优先取货
			rgvThread.setPakRgv(false);
			continue;
			}
			wrkMastSta.setWorkSta(wrkMastSta2 != null ? 1 : 2);
			wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
			Short direction = 2;//双工位最终抵达位置
			boolean sign = false;
			//若取货为工位2且取货口前一站点有物，给双工位同时下发指令
			if(wrkMastSta.getWorkSta() == 2 && staProtocol2 != null && staProtocol2.isLoading() && staProtocol2.getWorkNo() > 0){
			WrkMastSta wrkMastSta3 = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol2.getWorkNo()));//根据站点工作号和小车工作范围检索任务档
			wrkMastSta3.setWorkSta(1);
			wrkMastSta3.setRgvNo((int) rgvProtocol.getRgvNo());
			sign = rgvTakeFullAll2(basRgvMap.getRgvNo(), wrkMastSta, wrkMastSta3);
			}else{
			sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,direction); //命令下发
			}
			if (sign){
			wrkMastSta.setWrkSts(1);
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			rgvThread.setPakOut(false);//出库不允许
			boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			if (!signMap){
			log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			} else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}


			}
			}
			/**
			* 小车出库任务取货下发
			*/
			public synchronized void rgvRunWrkMastOut(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark){
			for (RgvSlave.RgvStn rgvStn : slave.getRgvOutTStn()) {//rgv出库取货站点
			boolean flag = false;
			//遍历rgv入库取货站点
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
			StaProtocol staProtocol2 = null;
			if(rgvStn.getStaNo2()!= null ){
			staProtocol2 = devpThread.getStation().get(rgvStn.getStaNo2());
			if (staProtocol2 == null) {
			News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv入库站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol2 = staProtocol2.clone();
			}
			BasDevp staDetl2 = basDevpService.selectById(rgvStn.getStaNo2());
			if (staDetl2 == null) {
			News.error("" + mark + " - 1" + " - 2" + " - 入库 ===>>Rgv站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}
			}
			if (staProtocol == null) {
			News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv出库站信息(staProtocol!=null继续执行)：staProtocol=" + staProtocol);
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			// 查询站点详细信息
			BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
			if (staDetl == null) {
			News.error("" + mark + " - 1" + " - 2" + " - 出库 ===>>Rgv站点在数据库不存在, 站点编号={}", rgvStn.getStaNo());
			continue;
			}

			if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isOutEnable()
			&& staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
			flag = true;
			}
			if (!flag) {
			News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv出库取货站信息(以下需要全true):"
			+ "自动信号" + staProtocol.isAutoing() + "有物信号" + staProtocol.isLoading()
			+ "工作号>0" + staProtocol.getWorkNo() + "可入信号" + staProtocol.isOutEnable()
			+ "能入信号（wms设置）.equals(\"Y\")" + staDetl.getCanouting());
			continue;
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol.getWorkNo()));//根据站点工作号和小车工作范围检索任务档
			if( null == wrkMastSta ) {
			News.infoNoLog("" + mark + " - 1" + " - 4" + " - 查询无待入库数据--wrk_sts0, 工作号={}", staProtocol.getWorkNo());
			continue;
			}
			WrkMastSta wrkMastSta2 = wrkMastStaMapper.selectByWorkSta(2, (int) rgvProtocol.getRgvNo());
			boolean result = false;
			if(wrkMastSta2 != null && rgvProtocol.getRgvNo() == 1){ //距离计算 2楼单入库口不需要计算
			result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta2.getStaEnd(),wrkMastSta.getStaStart());//工位2放货站点，工位1取货站点
			}
			if(result){//若小车距离放货点距离近于取货点则跳过取货 true跳过取货/false优先取货
			rgvThread.setPakRgv(false);
			continue;
			}
			WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWorkSta(1, (int) rgvProtocol.getRgvNo());
			wrkMastSta.setWorkSta(wrkMastSta1 != null ? 2 : 1);//若1号工位有任务给2号工位
			wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
			boolean sign = false;
			Short direction = 1;//工位1方向
			//若取货为工位2且取货口前一站点有物，给双工位同时下发指令
			if(wrkMastSta.getWorkSta() == 1 && staProtocol2 != null && staProtocol2.isLoading() && staProtocol2.getWorkNo() > 0){
			WrkMastSta wrkMastSta3 = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol2.getWorkNo()));//根据站点工作号和小车工作范围检索任务档
			wrkMastSta3.setWorkSta(2);
			wrkMastSta3.setRgvNo((int) rgvProtocol.getRgvNo());
			sign = rgvTakeFullAll2(basRgvMap.getRgvNo(), wrkMastSta, wrkMastSta3);
			}else{
			sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,direction); //命令下发
			}
			if (sign){
			wrkMastSta.setWrkSts(1);
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			log.error("更新小车任务成功");
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			rgvThread.setPakIn(false);//入库不允许
			boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			if (!signMap){
			log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			} else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}


			}
			}
			/**
			* 执行小车搬运任务
			*
			* @return
			*/
			// public synchronized boolean rgvRunWrkMastFullSta() {
			// boolean wrkEnable = false;
			// try{
			// List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
			// for (BasRgvMap rgvSlave:basRgvMaps) {
			// RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
			// RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			// if (rgvProtocol == null) {
			// continue;
			// }else {
			// rgvProtocol = rgvProtocol.clone();
			// }
			// BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
			// if (basRgv == null) {
			// log.error("{}号RGV尚未在数据库进行维护！4", rgvSlave.getRgvNo());
			// continue;
			// }
			//
			// // 只有当RGV空闲、自动,工位一无物//rgv可用入库取货
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && !rgvProtocol.isLoaded1ing()
			// && rgvProtocol.getTaskNo1() == 0
			// && rgvThread.isPakMk()
			// && rgvThread.isPakIn()
			// ) {
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// if (basRgvMap == null) {
			// log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			// continue;
			// }
			// List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			// basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			// List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
			// for (WrkMastSta wrkMastSta : wrkMastStaList){
			// List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//入库口
			// if (!staNos.contains(wrkMastSta.getStaStart())) {
			// continue;
			// }
			// boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //命令下发
			// wrkEnable = true;
			// if (sign){
			// wrkMastSta.setWrkSts(1);
			// try{
			// wrkMastStaMapper.updateById(wrkMastSta);
			// log.error("更新小车任务成功");
			// }catch (Exception e){
			// log.error("更新小车任务失败");
			// }
			// rgvThread.setPakMk(false);
			// rgvThread.setPakOut(false);
			// boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			// if (signMap){
			// return wrkEnable;
			//// break;
			// }else {
			// log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			// Thread.sleep(500);
			// }
			// } else {
			// log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			// Thread.sleep(500);
			// }
			// break;
			// }
			// }
			//
			// // 只有当RGV空闲、自动,工位一无物//rgv可用出库取货
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && !rgvProtocol.isLoaded2ing()
			// && rgvProtocol.getTaskNo2() == 0
			// && rgvThread.isPakMk()
			// && rgvThread.isPakOut()
			// ){
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// if (basRgvMap == null) {
			// log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			// continue;
			// }
			// List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			// basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			// List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
			// for (WrkMastSta wrkMastSta : wrkMastStaList){
			// List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//入库口
			// if (staNos.contains(wrkMastSta.getStaStart())) {//非入库口（出库口）限制
			// continue;
			// }
			// boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //命令下发
			// wrkEnable = true;
			// if (sign){
			// wrkMastSta.setWrkSts(1);
			// try{
			// wrkMastStaMapper.updateById(wrkMastSta);
			// log.error("更新小车任务成功");
			// }catch (Exception e){
			// log.error("更新小车任务失败");
			// }
			// rgvThread.setPakMk(false);
			// rgvThread.setPakOut(false);
			// boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
			// if (signMap){
			// return wrkEnable;
			//// break;
			// }else {
			// log.error("货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			// Thread.sleep(500);
			// }
			// } else {
			// log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			// Thread.sleep(500);
			// }
			// break;
			// }
			//
			// }
			//
			// }
			// }catch (Exception e){
			// log.error("执行小车搬运任务下发失败");
			// }
			// return wrkEnable;
			// }
			/**
			* 小车预调度
			*/
			public synchronized void rgvPreScheduling(){
			try{
			List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
			for (BasRgvMap rgvSlave:basRgvMaps) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			continue;
			}else {
			rgvProtocol = rgvProtocol.clone();
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！4", rgvSlave.getRgvNo());
			continue;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用才进行预调度
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& !rgvProtocol.isLoaded1ing()
			&& rgvProtocol.getTaskNo1() == 0
			&& !rgvProtocol.isLoaded2ing()
			&& rgvProtocol.getTaskNo2() == 0
			&& rgvThread.isPakMk()
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			if (basRgvMap == null) {
			log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			continue;
			}
			List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			// 根据输送线plc遍历
			for (DevpSlave devp : slaveProperties.getDevp()) {
			// 遍历入库口入库预调度
			List<Integer> staNos = Arrays.asList( 1043, 1104,1037);
			for (Integer staNo : staNos) {
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
			StaProtocol staProtocol = devpThread.getStation().get(staNo);
			if(staProtocol.isLoading()){
			RgvCommand rgvCommand = new RgvCommand();
			rgvCommand.setRgvNo((int) rgvProtocol.getRgvNo()); // RGV编号
			rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(9999); // 工位1工作号
			rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 工位1任务模式: 移动
			rgvCommand.setEndStaNo1(0); //工位1 放货后要去的位置
			switch (staNo){
			case 1043: rgvCommand.setTargetPosition1(1042);break; //工位1目标站点
			case 1104: rgvCommand.setTargetPosition1(1105);break;
			case 1037: rgvCommand.setTargetPosition1(1036);break;

			}
			if(Objects.equals(basRgvMap.getNowRoute(), staNo)){
			continue;
			}
			rgvCommand.setCommand(true); //工位1任务确认
			if (!MessageQueue.offer(SlaveType.Rgv, (int) rgvProtocol.getRgvNo(), new Task(4, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", (int) rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
			}
			}
			}

			}

			}
			}
			}catch (Exception e){
			log.error("执行小车移动下发失败");
			}
			}
			/**
			* 执行小车搬运任务
			*/
			// public synchronized void rgvRunWrkMastEmptyStaPut() {//放
			// try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			// RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			// RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			// if (rgvProtocol == null) {
			// continue;
			// }
			// BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			// if (basRgv == null) {
			// log.error("{}号RGV尚未在数据库进行维护！5", rgvSlave.getId());
			// continue;
			// }
			//
			// // 只有当RGV空闲、自动,工位二有物//rgv可用
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && rgvProtocol.getLoaded1()==1 //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			// ) {
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// if (basRgvMap == null) {
			// log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			// continue;
			// }
			// basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			// List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());//获取活动范围
			// List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);//查询可执行任务
			// for (WrkMastSta wrkMastSta : wrkMastStaList){
			// if (wrkMastSta.getType()!=2 \|\| (wrkMastSta.getWrkType()!=2 && wrkMastSta.getWrkType()!=4)){// 2:空板 2:放 4：拆盘
			// continue;
			// }
			// boolean sign = false;
			// if (wrkMastSta.getStaStart()==0 && wrkMastSta.getStaEnd()!=0){//放
			// sign = rgvPutEmpty(rgvProtocol.getRgvNo(),wrkMastSta);
			// }else {
			// continue;
			// }
			// if (sign){
			// boolean signMap = rgvMapUpdate(basRgvMap, basRgvMap.getStartRoute(), wrkMastSta.getStaEnd());
			// if (signMap){
			// wrkMastSta.setWrkSts(2);
			// try{
			// wrkMastStaMapper.updateById(wrkMastSta);
			// }catch (Exception e){
			// log.error("更新小车任务失败");
			// }
			// return;
			// }else {
			// log.error("3857行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			// }
			// }else {
			// log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			// }
			// break;
			// }
			// }
			// }
			// }catch (Exception e){
			// log.error("3933行执行小车放空板任务下发失败");
			// log.error("3933行"+e);
			// }
			// }

			// public synchronized void rgvRunWrkMastEmptyStaTake() {//取
			// try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			// RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			// RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			// if (rgvProtocol == null) {
			// continue;
			// }
			// BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			// if (basRgv == null) {
			// log.error("{}号RGV尚未在数据库进行维护！6", rgvSlave.getId());
			// continue;
			// }
			//
			// // 只有当RGV空闲、自动,工位二无物//rgv可用
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && rgvProtocol.getLoaded1()==0 //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			// ) {
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// if (basRgvMap == null) {
			// log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			// continue;
			// }
			// List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
			// basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //更新小车当前位置站点号
			// List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
			// for (WrkMastSta wrkMastSta : wrkMastStaList){
			// if (wrkMastSta.getType()!=2 \|\| wrkMastSta.getWrkType()!=1){// 2:空板 1:取
			// continue;
			// }
			// boolean sign = false;
			// if (wrkMastSta.getStaEnd()==0 && wrkMastSta.getStaStart()!=0){//取
			// sign = rgvTakeEmpty(rgvProtocol.getRgvNo(),wrkMastSta);
			// } else {
			// continue;
			// }
			// if (sign){
			// boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), basRgvMap.getStartRoute());
			// if (signMap){
			// wrkMastSta.setWrkSts(1);
			// try{
			// wrkMastStaMapper.updateById(wrkMastSta);
			// }catch (Exception e){
			// log.error("更新小车任务失败");
			// }
			// return;
			// }else {
			// log.error("3879行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			// }
			// }else {
			// log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			// }
			// break;
			// }
			// }
			// }
			// }catch (Exception e){
			// log.error("3989行执行小车取空板任务下发失败");
			// log.error("3989行"+e);
			// }
			// }

			/*
			* 有任务但未执行此时需要调整小车位置
			* */
			// public synchronized void rgvRunWrkMastEmptyStaAvoidance() {
			// try{
			// Integer integer = wrkMastStaMapper.selectAllWrkStsCount(null,0);//查询状态为0的任务
			// if (integer==0){
			// return;
			// }
			// List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
			// for (BasRgvMap rgvSlave:basRgvMaps) {
			// RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
			// RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			// if (rgvProtocol == null) {
			// continue;
			// }else {
			// rgvProtocol = rgvProtocol.clone();
			// }
			// BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
			// if (basRgv == null) {
			// log.error("{}号RGV尚未在数据库进行维护！1", rgvSlave.getRgvNo());
			// continue;
			// }
			//
			// // 只有当RGV空闲、自动,工位一无物//rgv可用
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && !rgvProtocol.isLoaded1ing() //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			// && rgvProtocol.getTaskNo1()==0
			// && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			// && rgvThread.isPakMk()
			//// && rgvProtocol.getTaskNo2()==0
			// ){
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// if (rgvProtocol.getRgvPosI().equals(basRgvMap.getStartRoute())){
			// continue;
			// }
			//// if (rgvProtocol.getRgvNo()==1 && rgvProtocol.getRgvPosI().equals(100)){
			//// continue;
			//// } else if (rgvProtocol.getRgvNo()==2 && rgvProtocol.getRgvPosI().equals(157) ){
			//// continue;
			//// }
			// rgvAvoidanceXY((int) rgvProtocol.getRgvNo());
			// rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2727");
			// }
			// }
			// }catch (Exception e){
			// log.error("4109行执行小车初始化任务下发失败");
			// log.error("4109行"+e);
			// }
			// }

			/*
			* 小车XY移动避让
			* */
			// public synchronized boolean rgvAvoidanceXY(Integer rgvId){
			// BasRgvMap basRgvMap = basRgvMapService.selectByRgvNo(rgvId);
			// if (basRgvMap.getStartRoute() == 100 \|\| basRgvMap.getStartRoute() == 101){
			// try{
			//
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish1((short) 0); // 工位1任务完成确认位
			// rgvCommand.setTaskNo1((short)32222); // 工位1工作号
			// rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 工位1任务模式: 回原点
			// //basRgvMap.getLockStartRoute().shortValue()
			// rgvCommand.setSourceStaNo1(basRgvMap.getStartRoute().shortValue());
			// rgvCommand.setCommand((short) 1); //工位1任务确认
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务 step=9，回原点 9999任务号
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			//
			// }
			// }else {
			// try{
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish1((short) 0); // 工位1任务完成确认位
			// rgvCommand.setTaskNo1((short)32222); // 工位1工作号
			// rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 工位1任务模式: 回原点
			// //basRgvMap.getLockStartRoute().shortValue()
			// rgvCommand.setSourceStaNo1(basRgvMap.getStartRoute().shortValue());
			// rgvCommand.setCommand((short) 1); //工位1任务确认
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务 step=9，回原点 9999任务号
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			//
			// }
			// }
			// }


			/*
			* 小车取货至工位任务
			* */
			public synchronized boolean rgvTakeFullAll(Integer rgvId,WrkMastSta wrkMastSta,Short direction){
			try{
			// 命令下发区 --------------------------------------------------------------------------
			RgvCommand rgvCommand = new RgvCommand();
			boolean pakIn1 = true;
			boolean pakIn2 = true;
			rgvCommand.setRgvNo(rgvId); // RGV编号
			if(wrkMastSta.getWrkSts() == 0){//取货
			if(wrkMastSta.getWorkSta() == 2){//出库RGV取货
			rgvCommand.setAckFinish2(false); // 工位2任务完成确认位
			rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位2工作号
			rgvCommand.setTaskStatus2(RgvTaskStatusType.FETCH); // 工位2任务模式: 取放货
			rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd()); //工位2 放货后要去的位置
			rgvCommand.setTargetPosition2(wrkMastSta.getStaStart()); //工位2目标站点
			rgvCommand.setDirection2(direction);
			rgvCommand.setCommand(true); //工位1任务确认
			pakIn1 = false;
			}else{ //入库RGV取货
			rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位1工作号
			rgvCommand.setTaskStatus1(RgvTaskStatusType.FETCH); // 工位1任务模式: 取放货
			rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd()); //工位1 放货后要去的位置
			rgvCommand.setTargetPosition1(wrkMastSta.getStaStart()); //工位1目标站点
			rgvCommand.setDirection1(direction);
			rgvCommand.setCommand(true); //工位1任务确认
			}
			if(!pakIn1){
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			return false;
			} else {
			return true;
			}
			}else{
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			return false;
			} else {
			return true;
			}
			}
			}
			if(wrkMastSta.getWrkSts() == 2) {//放货
			if((wrkMastSta.getWorkSta() == 2)){ //工位2任务放货
			rgvCommand.setAckFinish2(false); // 工位2任务完成确认位
			rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位2工作号
			rgvCommand.setTaskStatus2(RgvTaskStatusType.PUT); // 工位2任务模式: 放货
			rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd()); //工位2 放货后要去的位置
			rgvCommand.setTargetPosition2(wrkMastSta.getStaEnd()); //工位2目标站点
			rgvCommand.setCommand(true); //工位1任务确认
			pakIn2 = false;
			}else{ //工位1任务放货
			rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位1工作号
			rgvCommand.setTaskStatus1(RgvTaskStatusType.PUT); // 工位1任务模式: 放货
			rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd()); //工位1 放货后要去的位置
			rgvCommand.setTargetPosition1(wrkMastSta.getStaEnd()); //工位1目标站点
			rgvCommand.setCommand(true); //工位1任务确认
			}
			if(!pakIn2){
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			return false;
			} else {
			return true;
			}
			}else{
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			return false;
			} else {
			return true;
			}
			}
			}
			return true;
			}catch (Exception e){
			return false;
			}
			}


			/*
			* 小车取货至双工位任务
			* */
			public synchronized boolean rgvTakeFullAll2(Integer rgvId,WrkMastSta wrkMastSta,WrkMastSta wrkMastSta2){
			try{
			// 命令下发区 --------------------------------------------------------------------------
			RgvCommand rgvCommand = new RgvCommand();
			boolean pakIn1 = true;
			boolean pakIn2 = true;
			rgvCommand.setRgvNo(rgvId); // RGV编号
			if(wrkMastSta.getWrkSts() == 0) {//取货
			if (wrkMastSta.getWorkSta() == 2) {//入库RGV取货
			rgvCommand.setAckFinish2(false); // 工位2任务完成确认位
			rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位2工作号
			rgvCommand.setTaskStatus2(RgvTaskStatusType.FETCH); // 工位2任务模式: 取放货
			rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd()); //工位2 放货后要去的位置
			rgvCommand.setTargetPosition2(wrkMastSta.getStaStart()); //工位2目标站点
			rgvCommand.setCommand(true); //工位1任务确认
			rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta2.getWrkNo())); // 工位1工作号
			rgvCommand.setTaskStatus1(RgvTaskStatusType.FETCH); // 工位1任务模式: 取放货
			rgvCommand.setEndStaNo1(wrkMastSta2.getWrkEnd()); //工位1 放货后要去的位置
			rgvCommand.setTargetPosition1(wrkMastSta2.getStaStart()); //工位1目标站点
			rgvCommand.setCommand(true); //工位1任务确认
			rgvCommand.setWrkTaskPri((short) 2); //优先执行工位2任务
			} else { //出库RGV取货
			rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位1工作号
			rgvCommand.setTaskStatus1(RgvTaskStatusType.FETCH); // 工位1任务模式: 取放货
			rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd()); //工位1 放货后要去的位置
			rgvCommand.setTargetPosition1(wrkMastSta.getStaStart()); //工位1目标站点
			rgvCommand.setAckFinish2(false); // 工位2任务完成确认位
			rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位2工作号
			rgvCommand.setTaskStatus2(RgvTaskStatusType.FETCH); // 工位2任务模式: 取放货
			rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd()); //工位2 放货后要去的位置
			rgvCommand.setTargetPosition2(wrkMastSta.getStaStart()); //工位2目标站点
			rgvCommand.setWrkTaskPri((short) 1); //出库取货优先执行工位1任务
			rgvCommand.setCommand(true); //工位1任务确认
			}
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(2, rgvCommand))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			return false;
			} else {
			return true;
			}
			}

			// if(wrkMastSta.getWrkSts() == 2) {//放货
			// if((wrkMastSta.getWorkSta() == 2)){ //工位2任务放货
			// rgvCommand.setAckFinish2(false); // 工位2任务完成确认位
			// rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位2工作号
			// rgvCommand.setTaskStatus2(RgvTaskStatusType.PUT); // 工位2任务模式: 放货
			// rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd()); //工位2 放货后要去的位置
			// rgvCommand.setTargetPosition2(wrkMastSta.getStaEnd()); //工位2目标站点
			// rgvCommand.setCommand(true); //工位1任务确认
			// pakIn2 = false;
			// }else{ //工位1任务放货
			// rgvCommand.setAckFinish1(false); // 工位1任务完成确认位
			// rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 工位1工作号
			// rgvCommand.setTaskStatus1(RgvTaskStatusType.PUT); // 工位1任务模式: 放货
			// rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd()); //工位1 放货后要去的位置
			// rgvCommand.setTargetPosition1(wrkMastSta.getStaEnd()); //工位1目标站点
			// rgvCommand.setCommand(true); //工位1任务确认
			// }
			// if(!pakIn2){
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }else{
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }
			// }
			return true;
			}catch (Exception e){
			return false;
			}
			}

			/*
			* 小车取货至工位任务
			* */
			// public synchronized boolean rgvTakeFull(Integer rgvId,WrkMastSta wrkMastSta){
			// try{
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish1((short) 0); // 工位1任务完成确认位
			// rgvCommand.setTaskNo1(wrkMastSta.getWrkNo().shortValue()); // 工位1工作号
			// rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 工位1任务模式: 取货
			// rgvCommand.setSourceStaNo1(wrkMastSta.getStaStart().shortValue()); //工位1起点
			// rgvCommand.setCommand((short) 1); //工位1任务确认
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			// }
			// }

			/*
			* 小车放货至输送线任务
			* */
			// public synchronized boolean rgvPutFull(Integer rgvId,WrkMastSta wrkMastSta){
			// try{
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish1((short) 0); // 工位1任务完成确认位
			// rgvCommand.setTaskNo1(wrkMastSta.getWrkNo().shortValue()); // 工位1工作号
			// rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 工位1任务模式: 放货
			// rgvCommand.setDestinationStaNo1(wrkMastSta.getStaEnd().shortValue()); //工位1目标站点
			// rgvCommand.setCommand((short) 1); //工位1任务确认
			// if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			// }
			// }

			/*
			* 小车取空板至工位任务
			* */
			// public synchronized boolean rgvTakeEmpty(Integer rgvId,WrkMastSta wrkMastSta){
			// try{
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish2((short) 0); // 工位2任务完成确认位
			// rgvCommand.setTaskNo2(wrkMastSta.getWrkNo().shortValue()); // 工位2工作号
			// rgvCommand.setTaskMode2(RgvTaskModeType.FETCH); // 工位2任务模式: 取货
			// rgvCommand.setSourceStaNo2(wrkMastSta.getStaStart().shortValue()); //工位2起点
			// rgvCommand.setCommand((short) 2); //工位2任务确认
			// if (!MessageQueue.offer(SlaveType.Crn, rgvId, new Task(5, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			// }
			// }

			/*
			* 小车放空板至输送线任务
			* */
			// public synchronized boolean rgvPutEmpty(Integer rgvId,WrkMastSta wrkMastSta){
			// try{
			// // 命令下发区 --------------------------------------------------------------------------
			// RgvCommand rgvCommand = new RgvCommand();
			// rgvCommand.setRgvNo(rgvId); // RGV编号
			// rgvCommand.setAckFinish2((short) 0); // 工位2任务完成确认位
			// rgvCommand.setTaskNo2(wrkMastSta.getWrkNo().shortValue()); // 工位2工作号
			// rgvCommand.setTaskMode2(RgvTaskModeType.PUT); // 工位2任务模式: 放货
			// rgvCommand.setDestinationStaNo2(wrkMastSta.getStaEnd().shortValue()); //工位2目标站点
			// rgvCommand.setCommand((short) 2); //工位2任务确认
			// if (!MessageQueue.offer(SlaveType.Crn, rgvId, new Task(5, rgvCommand))) {
			// //step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			// log.error("RGV命令下发失败，RGV号={}，任务数据={}", rgvId, JSON.toJSON(rgvCommand));
			// return false;
			// } else {
			// return true;
			// }
			// }catch (Exception e){
			// return false;
			// }
			// }

			/**
			* 取放取路径计算
			*/
			public synchronized boolean rgvCalcDistance(Integer rgvNo, Integer outStn, Integer inStn){
			try {
			// 小车当前位置
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvNo);
			Integer currPos = basRgvMap.getNowRoute(); // 或者用 rgvProtocol.getRgvPosI()

			if(currPos == null \|\| outStn == null \|\| inStn == null){
			return false; // 无效数据直接放弃
			}

			// 计算两段距离
			List<Integer> routeToOut = RouteUtils.getRouteDis(currPos, outStn);
			List<Integer> routeToIn = RouteUtils.getRouteDis(currPos, inStn);

			int distOut = (routeToOut != null) ? routeToOut.size() : Integer.MAX_VALUE;
			int distIn = (routeToIn != null) ? routeToIn.size() : Integer.MAX_VALUE;

			// 调试日志
			log.info("RGV距离计算: currPos={}, outStn={}, distOut={}, inStn={}, distIn={}",
			currPos, outStn, distOut, inStn, distIn);

			return distOut < distIn; // 放货点更近 → true
			} catch (Exception e) {
			log.error("RGV路径距离计算异常", e);
			return false;
			}
			}

			/*
			* 小车复位
			* */
			public synchronized boolean rgvComplete(Integer rgvId,Integer step){
			try{
			// 命令下发区 --------------------------------------------------------------------------
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(step, new RgvCommand()))) {
			//step=2,工位1、2写任务； step=4，工位1写任务； step=5，工位2写任务
			log.error("RGV命令下发失败，RGV号={}",rgvId);
			return false;
			} else {
			log.info("RGV命令下发成功，RGV号={}",rgvId);
			return true;
			}
			}catch (Exception e){
			log.error("RGV命令下发失败，RGV号={}。异常："+e,rgvId);
			return false;
			}
			}

			}