zy-wcs.git - Gitblit

			@@ -4,19 +4,16 @@
			import com.alibaba.fastjson.JSONObject;
			import com.baomidou.mybatisplus.mapper.EntityWrapper;
			import com.core.common.Cools;
			import com.core.common.R;
			import com.core.exception.CoolException;
			import com.zy.asrs.controller.CrnController;
			import com.zy.asrs.controller.OpenController;
			import com.zy.asrs.controller.SiteController;
			import com.zy.asrs.domain.enums.TaskStatusType;
			import com.zy.asrs.domain.enums.WorkNoType;
			import com.zy.asrs.domain.param.CrnOperatorParam;
			import com.zy.asrs.entity.*;
			import com.zy.asrs.entity.param.TaskOverToWms;
			import com.zy.asrs.mapper.*;
			import com.zy.asrs.service.*;
			import com.zy.asrs.utils.CommandUtils;
			import com.zy.asrs.utils.RouteUtils;
			import com.zy.asrs.utils.Utils;
			import com.zy.common.service.CommonService;
			import com.zy.common.utils.HttpHandler;
			@@ -27,16 +24,17 @@
			import com.zy.core.enums.*;
			import com.zy.core.model.CrnSlave;
			import com.zy.core.model.DevpSlave;
			import com.zy.core.model.RgvSlave;
			import com.zy.core.model.Task;
			import com.zy.core.model.command.CommandPackage;
			import com.zy.core.model.command.CrnCommand;
			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.RgvThread;
			import com.zy.core.thread.SiemensDevpThread;
			import com.zy.system.entity.Config;
			import com.zy.system.service.ConfigService;
			import lombok.extern.slf4j.Slf4j;
			import org.springframework.beans.factory.annotation.Autowired;
			import org.springframework.beans.factory.annotation.Value;
			@@ -55,8 +53,6 @@
			@Service("mainService")
			@Transactional
			public class MainServiceImpl {

			public static final long COMMAND_TIMEOUT = 5 * 1000;

			@Autowired
			private SlaveProperties slaveProperties;
			@@ -77,14 +73,8 @@
			@Autowired
			private TaskWrkService taskWrkService;
			@Autowired
			private ConfigService configService;
			@Autowired
			private StaDescMapper staDescMapper;
			@Autowired
			private CommandInfoService commandInfoService;

			@Autowired
			private OpenServiceImpl openServiceImpl;
			@Autowired
			private StaDescService staDescService;

			@@ -92,6 +82,12 @@
			private ApiLogService apiLogService;
			@Autowired
			private CommonService commonService;
			@Autowired
			private BasRgvService basRgvService;
			@Autowired
			private WrkMastStaMapper wrkMastStaMapper;
			@Autowired
			private BasRgvMapMapper basRgvMapMapper;

			@Value("${wms.url}")
			private String wmsUrl;
			@@ -103,9 +99,9 @@
			private String taskStatusFeedbackPath;
			@Autowired
			private CrnController crnController;
			@Autowired
			private SiteController siteController;

			@Value("${wms.rgvOpen}")
			private boolean rgvOpen;

			public void generateStoreWrkFile() throws IOException, InterruptedException {
			try {
			@@ -123,8 +119,8 @@
			} else {
			staProtocol = staProtocol.clone();
			}
			Short workNo = staProtocol.getWorkNo();
			Short stano = staProtocol.getStaNo();
			Integer workNo = staProtocol.getWorkNo();
			Integer stano = staProtocol.getStaNo();

			// 尺寸检测异常
			boolean back = false;
			@@ -170,12 +166,13 @@
			}
			// News.warn("扫码入库失败，{}入库站因{}异常，托盘已被退回", inSta.getStaNo(), errMsg);
			staProtocol.setWorkNo(workNo);
			staProtocol.setStaNo(inSta.getStaNo().shortValue());
			staProtocol.setStaNo(inSta.getStaNo());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			TaskWrk taskWrk = taskWrkMapper.selectByWrkNo(Integer.valueOf(workNo));
			if (taskWrk != null) {
			taskWrk.setMemo(errMsg);//将错误码存入备注字段进行展示
			taskWrk.setModiTime(new Date());
			taskWrkMapper.updateById(taskWrk);
			}
			continue;
			@@ -204,8 +201,8 @@
			log.info("托盘码："+barcode+"任务档存在");
			return;
			}else {
			staProtocol.setWorkNo(taskWrk1.getWrkNo().shortValue());
			staProtocol.setStaNo(staDesc.getCrnStn().shortValue());
			staProtocol.setWorkNo(taskWrk1.getWrkNo());
			staProtocol.setStaNo(staDesc.getCrnStn());
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			}
			}
			@@ -237,8 +234,8 @@
			// 退回
			log.error("扫码检测程序异常"+inSta.getStaNo()+"异常信息"+e1);
			}
			staProtocol.setWorkNo((short)9999);
			staProtocol.setStaNo(inSta.getStaNo().shortValue());
			staProtocol.setWorkNo(9999);
			staProtocol.setStaNo(inSta.getStaNo());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// TaskWrk taskWrk = taskWrkMapper.selectByWrkNo(Integer.valueOf(workNo));
			@@ -291,8 +288,8 @@
			log.error("扫码检测程序异常"+inSta.getStaNo()+errMsg);
			log.error("扫码检测程序异常,异常信息"+e);

			staProtocol.setWorkNo((short)9999);
			staProtocol.setStaNo(inSta.getStaNo().shortValue());
			staProtocol.setWorkNo(9999);
			staProtocol.setStaNo(inSta.getStaNo());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			// TaskWrk taskWrk = taskWrkMapper.selectByWrkNo(Integer.valueOf(workNo));
			@@ -346,8 +343,8 @@
			taskWrkService.insert(taskWrk);
			StaDesc staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
			.eq("crn_no", taskWrk.getCrnNo()).eq("type_no",1).eq("stn_no",staProtocol.getSiteId()));
			staProtocol.setWorkNo(taskWrk.getWrkNo().shortValue());
			staProtocol.setStaNo(staDesc.getCrnStn().shortValue());
			staProtocol.setWorkNo(taskWrk.getWrkNo());
			staProtocol.setStaNo(staDesc.getCrnStn());
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			}
			}
			@@ -360,13 +357,14 @@
			// 退回
			log.error("扫码入库失败，{}入库站因{}异常，托盘已被退回", inSta.getStaNo(), errMsg);

			staProtocol.setWorkNo((short)9999);
			staProtocol.setStaNo(inSta.getStaNo().shortValue());
			staProtocol.setWorkNo(9999);
			staProtocol.setStaNo(inSta.getStaNo());
			devpThread.setPakMk(staProtocol.getSiteId(), false);
			MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
			TaskWrk taskWrk = taskWrkMapper.selectByWrkNo(Integer.valueOf(workNo));
			if (taskWrk != null) {
			taskWrk.setMemo(errMsg);//将错误码存入备注字段进行展示
			taskWrk.setModiTime(new Date());
			taskWrkMapper.updateById(taskWrk);
			}
			}
			@@ -408,8 +406,8 @@
			}
			log.info("下发输送线任务：taskWrk:"+JSON.toJSONString(taskWrk));
			// R r = siteController.siteDetlUpdate(Integer.valueOf(taskWrk.getTargetPoint()), taskWrk.getWrkNo().shortValue(), (short) 0, "Y", false, false);
			staProtocol.setWorkNo(taskWrk.getWrkNo().shortValue());
			staProtocol.setStaNo(staDesc.getCrnStn().shortValue());
			staProtocol.setWorkNo(taskWrk.getWrkNo());
			staProtocol.setStaNo(staDesc.getCrnStn());
			boolean offer = false;
			try{
			offer = MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol));
			@@ -420,8 +418,11 @@
			// JSONObject jsonObject = JSON.parseObject(JSON.toJSONString(r));
			if (offer){
			log.info("下发输送线任务成功：taskWrk:"+JSON.toJSONString(taskWrk));
			Date now = new Date();
			taskWrk.setStatus(5);
			taskWrk.setWrkSts(14);
			taskWrk.setModiTime(now);
			taskWrk.setCompleteTime(now);
			taskWrkService.updateById(taskWrk);
			}else {
			log.error("下发输送线任务失败：taskWrk:"+JSON.toJSONString(taskWrk));
			@@ -531,11 +532,13 @@

			// int workNo = commonService.getWorkNo(WorkNoType.PAKIN.type);//获取入库工作号
			// taskWrk.setWrkNo(workNo);//工作号
			Date now = new Date();
			taskWrk.setStatus(TaskStatusType.DISTRIBUTE.id);//派发状态
			taskWrk.setAssignTime(new Date());//派发时间
			// taskWrk.setAssignTime(now);//派发时间
			taskWrk.setExecuteTime(now);
			taskWrk.setWrkSts(3);//工作状态 3.吊车入库
			taskWrk.setCrnNo(staDesc.getCrnNo());//堆垛机号
			taskWrk.setModiTime(new Date());
			taskWrk.setModiTime(now);
			taskWrk.setModiUser(9988L);

			// //取出命令
			@@ -703,6 +706,7 @@
			taskWrk.setWrkSts(12);
			taskWrk.setStatus(2);
			taskWrk.setModiTime(now);
			taskWrk.setExecuteTime(now);
			if (taskWrkMapper.updateById(taskWrk) == 0) {
			log.error("修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", taskWrk.getWrkNo());
			}
			@@ -750,10 +754,12 @@
			public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol){
			for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
			// 获取工作状态为11（生成出库ID）的移库工作档
			List<TaskWrk> taskWrks = taskWrkMapper.selectList(new EntityWrapper<TaskWrk>()
			.eq("crn_no",slave.getId())
			.eq("wrk_sts",11)
			.eq("io_type",3));
			List<TaskWrk> taskWrks = taskWrkMapper.selectList(
			new EntityWrapper<TaskWrk>()
			.eq("CRN_NO",slave.getId())
			.eq("WRK_STS",11)
			.eq("IO_TYPE",3)
			.orderBy("IO_PRI",false));
			for (TaskWrk taskWrk : taskWrks){

			// 双深库位且浅库位有货，则需先对浅库位进行库位移转
			@@ -809,6 +815,7 @@
			taskWrk.setWrkSts(12);
			taskWrk.setStatus(2);
			taskWrk.setModiTime(now);
			taskWrk.setExecuteTime(now);
			if (taskWrkMapper.updateById(taskWrk) == 0) {
			log.error("修改工作档状态 11.生成出库ID => 12.吊车出库中失败！！，工作号={}", taskWrk.getWrkNo());
			}
			@@ -850,54 +857,6 @@
			/**
			* 执行对工作档的完成操作
			*/
			// public void storeFinished() {
			// for (CrnSlave crn : slaveProperties.getCrn()) {
			// // 获取堆垛机信息
			// CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
			// CrnProtocol crnProtocol = crnThread.getCrnProtocol();
			// if (crnProtocol == null) { continue; }
			//
			// // 状态：等待确认并且任务完成位 = 1
			// if (crnProtocol.getTaskFinish() == 0 && crnProtocol.statusType == CrnStatusType.HANDLING_COMPLETED && crnProtocol.getTaskNo() != 0) {
			// //获取入库待确认工作档
			// TaskWrk taskWrk = taskWrkMapper.selectCrnNoInWorking(crn.getId(),crnProtocol.getTaskNo().intValue());
			// if (Cools.isEmpty(taskWrk)) {
			//// log.error("堆垛机处于等待确认且任务完成状态，但未找到工作档。堆垛机号={}，工作号={}", crn.getId(), crnProtocol.getTaskNo());
			// continue;
			// }
			//
			// //获取指令ID
			// Integer commandId = crnProtocol.getCommandId();
			// CommandInfo commandInfo = new CommandInfo();
			// if (Cools.isEmpty(commandId)){
			// commandInfo = commandInfoService.selectOne(new EntityWrapper<CommandInfo>()
			// .eq("wrk_no",crnProtocol.getTaskNo())
			// .eq("device","Crn"));
			// }else {
			// commandInfo = commandInfoService.selectById(commandId);
			// }
			//
			//
			// if (commandInfo == null) {
			// //指令不存在
			// continue;
			// }
			// if (commandInfo.getCommandStatus() == 3){
			// continue;
			// }
			// commandInfo.setCommandStatus(CommandStatusType.COMPLETE.id);//指令完成
			// commandInfo.setCompleteTime(new Date());//指令完成时间
			// if (commandInfoService.updateById(commandInfo)) {//修改成功后复位堆垛机
			// // 堆垛机复位
			// crnThread.setResetFlag(true);
			// }
			// }
			// }
			// }

			/**
			* 执行对工作档的完成操作
			*/
			public void storeFinished() throws InterruptedException {
			for (CrnSlave crn : slaveProperties.getCrn()) {
			// 获取堆垛机信息
			@@ -906,7 +865,7 @@
			if (crnProtocol == null) { continue; }

			// 状态：等待确认并且任务完成位 = 1
			if (crnProtocol.getTaskFinish() == 0 && crnProtocol.statusType == CrnStatusType.HANDLING_COMPLETED && crnProtocol.getTaskNo() != 0) {
			if (!Cools.isEmpty(crnProtocol.getTaskFinish()) && crnProtocol.getTaskFinish() == 0 && crnProtocol.statusType == CrnStatusType.WAITING && crnProtocol.getTaskNo() != 0) {
			//获取入库待确认工作档
			TaskWrk taskWrk = taskWrkMapper.selectCrnNoInWorking(crn.getId(),crnProtocol.getTaskNo().intValue());
			if (Cools.isEmpty(taskWrk)&&crnProtocol.getTaskNo() !=999) {
			@@ -917,6 +876,7 @@
			//确认完成信号
			CrnOperatorParam crnOperatorParam=new CrnOperatorParam();
			crnOperatorParam.setCrnNo(crn.getId());
			Date now = new Date();

			crnController.crnTaskComplete(crnOperatorParam);
			if(!Cools.isEmpty(taskWrk)){
			@@ -927,7 +887,7 @@
			LocMast locMast = locMastService.selectByLocNo(taskWrk.getTargetPoint());
			locMast.setLocSts("F");//F.在库
			locMast.setBarcode(taskWrk.getBarcode());//托盘码
			locMast.setModiTime(new Date());
			locMast.setModiTime(now);
			locMast.setModiUser(9999L);
			locMastService.updateById(locMast);
			}else if(taskWrk.getIoType()==2&&taskWrk.getWrkSts()==12){
			@@ -937,7 +897,7 @@
			LocMast locMast = locMastService.selectByLocNo(taskWrk.getStartPoint());
			locMast.setLocSts("O");//O.空库位
			locMast.setBarcode("");//托盘码
			locMast.setModiTime(new Date());
			locMast.setModiTime(now);
			locMast.setModiUser(9999L);
			locMastService.updateById(locMast);
			}else if(taskWrk.getIoType()==3&&taskWrk.getWrkSts()==12){
			@@ -947,17 +907,19 @@
			LocMast locMast = locMastService.selectByLocNo(taskWrk.getTargetPoint());
			locMast.setLocSts("F");//F.在库
			locMast.setBarcode(taskWrk.getBarcode());//托盘码
			locMast.setModiTime(new Date());
			locMast.setModiTime(now);
			locMast.setModiUser(9999L);
			locMastService.updateById(locMast);

			LocMast locMast1 = locMastService.selectByLocNo(taskWrk.getStartPoint());
			locMast1.setLocSts("O");//O.空库位
			locMast1.setBarcode("");//托盘码
			locMast1.setModiTime(new Date());
			locMast1.setModiTime(now);
			locMast1.setModiUser(9999L);
			locMastService.updateById(locMast1);
			}
			taskWrk.setModiTime(now);
			taskWrk.setCompleteTime(now);
			taskWrkService.updateById(taskWrk);


			@@ -1041,7 +1003,7 @@
			wrkMast.getSourceStaNo(), // 源站
			wrkMast.getSourceLocNo(), // 源库位
			wrkMast.getBarcode(), // 条码
			(int) crnProtocol.getAlarm1(), // 异常码
			(int) crnProtocol.getAlarm(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			@@ -1056,7 +1018,7 @@
			}
			} else {
			// 异常修复
			if (crnProtocol.getAlarm1() == null \|\| crnProtocol.getAlarm1() == 0) {
			if (crnProtocol.getAlarm() == null \|\| crnProtocol.getAlarm() == 0) {
			latest.setEndTime(now);
			latest.setUpdateTime(now);
			latest.setStatus(2);
			@@ -1069,7 +1031,7 @@
			} else {
			BasErrLog latest = basErrLogService.findLatest(crn.getId());
			// 有异常
			if (crnProtocol.getAlarm1() != null && crnProtocol.getAlarm() > 0) {
			if (crnProtocol.getAlarm() != null && crnProtocol.getAlarm() > 0) {
			// 记录新异常
			if (latest == null \|\| (latest.getErrCode() != crnProtocol.getAlarm().intValue())) {
			BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
			@@ -1088,7 +1050,7 @@
			null, // 源站
			null, // 源库位
			null, // 条码
			(int)crnProtocol.getAlarm1(), // 异常码
			(int)crnProtocol.getAlarm(), // 异常码
			errName, // 异常
			1, // 异常情况
			now, // 添加时间
			@@ -1119,199 +1081,6 @@
			}
			}

			//自动派发任务
			public void autoDistribute() {
			Config config = configService.selectByCode("autoDistribute");
			if (config == null) {
			return;
			}

			if (config.getValue().equals("false")) {//判断是否开启自动派发任务
			return;
			}

			for (TaskWrk taskWrk : taskWrkService.selectReceive()) {

			try {
			taskWrkService.distribute(taskWrk.getTaskNo(), 9527L);
			} catch (CoolException e) {
			log.info(e.getMessage());
			}
			}
			}

			//agv取放货任务完成
			public synchronized void autoCompleteAGV() {
			List<BasDevp> basDevps = basDevpService.selectList(new EntityWrapper<>());
			try{
			Thread.sleep(500);
			}catch (Exception e){

			}

			for (BasDevp basDevp:basDevps){
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (basDevp.getWrkNo()!=0){
			if (basDevp.getAgvTargetPick()!=0){//取货
			staProtocol.setAgvTypeSign((short)0);
			staProtocol.setStaNo(basDevp.getDevNo().shortValue());
			MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
			}
			boolean sign = true;
			if (basDevp.getAgvTargetPlace()!=0){
			sign = false;
			basDevp.setAgvTargetPlace(0);
			basDevpService.updateById(basDevp);
			staProtocol.setAgvTypeSign((short)3);//1
			staProtocol.setStaNo(basDevp.getDevNo().shortValue());
			MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
			}
			}else {
			if (basDevp.getAgvTargetPlace()!=0){
			if (basDevp.getLoading().equals("Y")){
			staProtocol.setAgvTypeSign((short)1);
			staProtocol.setStaNo(basDevp.getDevNo().shortValue());
			MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
			}else {
			log.error("AGV放货完成但输送线无物，复位信号 ===>> [staNo:{}] [basDevp:{}]", basDevp.getDevNo(), basDevp);
			basDevp.setAgvTargetPlace(0);
			basDevpService.updateById(basDevp);
			staProtocol.setAgvTypeSign((short)3);//1
			staProtocol.setStaNo(basDevp.getDevNo().shortValue());
			MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
			}

			}
			if (basDevp.getAgvTargetPick()!=0){
			basDevp.setAgvTargetPick(0);
			basDevpService.updateById(basDevp);
			staProtocol.setAgvTypeSign((short)2);//0
			staProtocol.setStaNo(basDevp.getDevNo().shortValue());
			MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
			}
			}
			}
			}
			public synchronized void autoCompleteTask() {
			List<TaskWrk> taskWrks = taskWrkMapper.selectWorkingTask();
			for (TaskWrk taskWrk : taskWrks) {
			//获取命令集合
			List<CommandInfo> commandInfos = commandInfoService.selectByTaskNo(taskWrk.getTaskNo());
			if (taskWrk.getCommandStep() < commandInfos.size()) {
			continue;//当前步序没有到达最后一条命令
			}

			//判断末端命令是否执行完成
			CommandInfo commandInfo = commandInfos.get(commandInfos.size() - 1);
			if (commandInfo.getCommandStatus() != CommandStatusType.COMPLETE.id) {
			continue;//指令未完成
			}

			Date now = new Date();
			//指令已完成，更新任务
			if (taskWrk.getIoType() == 1) {
			//入库任务
			taskWrk.setWrkSts(4);//3.吊车入库中 => 4.入库完成
			//taskWrk.setStatus(TaskStatusType.COMPLETE.id);
			taskWrk.setModiTime(now);
			taskWrkService.updateById(taskWrk);

			//更新库位状态
			LocMast locMast = locMastService.selectByLocNo(taskWrk.getTargetPoint());
			locMast.setLocSts("F");//F.在库
			locMast.setBarcode(taskWrk.getBarcode());//托盘码
			locMast.setModiTime(now);
			locMast.setModiUser(9999L);
			locMastService.updateById(locMast);
			} else if (taskWrk.getIoType() == 2) {
			//出库任务
			taskWrk.setWrkSts(14);//12.吊车出库中 => 14.出库完成
			// taskWrk.setStatus(TaskStatusType.COMPLETE.id);
			taskWrk.setModiTime(now);
			taskWrkService.updateById(taskWrk);

			//更新库位状态
			LocMast locMast = locMastService.selectByLocNo(taskWrk.getStartPoint());
			locMast.setLocSts("O");//O.空库位
			locMast.setBarcode("");//托盘码
			locMast.setModiTime(now);
			locMast.setModiUser(9999L);
			locMastService.updateById(locMast);
			}
			}
			}


			public synchronized String CrnStartRunning(TaskWrk taskWrk){
			String tasktype = null;
			switch (taskWrk.getIoType()){
			case 1:
			tasktype= "RK";
			break;
			case 2:
			tasktype= "CK";
			break;
			case 3:
			tasktype= "YK";
			break;
			default:
			tasktype= "未知";
			}
			Map<String, Object> map = new HashMap<>();
			map.put("x-api-key","7a15b5db-29b6-552c-8cff-0cfec3756da2");
			TaskOverToWms taskOverToWms = new TaskOverToWms();
			taskOverToWms.setFeedbackFrom("WCS"); //来源
			taskOverToWms.setWarehouseId("1688469798893297665"); //仓库标识
			taskOverToWms.setTaskNo(taskWrk.getTaskNo()); //任务号
			taskOverToWms.setTaskType(tasktype); // 任务类型
			taskOverToWms.setContainerCode(taskWrk.getBarcode()); // 容器编码
			if (taskWrk.getIoType() ==1 \|\| taskWrk.getIoType() == 3){
			taskOverToWms.setEquipmentCode(String.valueOf(taskWrk.getCrnNo())); //设备编码
			taskOverToWms.setTargetLocationCode(taskWrk.getOriginTargetPoint()); //目标库位
			}else if (taskWrk.getIoType() ==2){
			Map<Integer,String> map1 = new HashMap<>();
			map1.put(102,"J-1101");
			map1.put(106,"J-1103");
			map1.put(110,"J-1105");
			map1.put(114,"J-1107");
			map1.put(118,"J-1109");
			map1.put(122,"J-1111");
			map1.put(305,"H-1101");
			map1.put(405,"G-1101");
			taskOverToWms.setEquipmentCode(map1.get(taskWrk.getTargetPoint())); //设备编码
			taskOverToWms.setSourceLocationCode(taskWrk.getOriginStartPoint()); //源库位
			}

			taskOverToWms.setTaskStatus("executing"); //任务状态
			String response = null;
			try {
			response = new HttpHandler.Builder()
			.setHeaders(map)
			.setUri(wmsUrl)
			.setPath("wcsManager/wcsInterface/taskStatusFeedback")
			.setJson(JSON.toJSONString(taskOverToWms))
			.build()
			.doPost();
			}catch (Exception e){
			log.error("堆垛机任务完成，请求wms任务完成接口失败");
			}
			apiLogService.save("堆垛机开始运行"
			,wmsUrl+"wcsManager/wcsInterface/taskStatusFeedback"
			,null
			,"127.0.0.1"
			,JSON.toJSONString(taskOverToWms)
			,response
			,true
			);
			return response;
			}

			private TaskWrk createTask(GetWmsDto dto, String barcode){
			String wcsLocNo = dto.getLocNo();
			if(Cools.isEmpty(wcsLocNo)){
			@@ -1324,6 +1093,9 @@
			taskWrk.setWrkNo(workNo1);
			taskWrk.setStatus(TaskStatusType.RECEIVE.id);//任务状态：接收
			taskWrk.setCreateTime(now);
			taskWrk.setAssignTime(now);
			taskWrk.setModiTime(now);
			taskWrk.setModiUser(5555L);
			taskWrk.setIoType(1);//任务类型
			taskWrk.setIoPri(Cools.isEmpty(dto.getTaskPriority()) ? 300 : Integer.parseInt(dto.getTaskPriority()));//优先级
			taskWrk.setBarcode(barcode);//条码
			@@ -1353,6 +1125,1075 @@
			}
			return taskWrk;
			}
			/**
			* 完成小车任务
			*/
			public synchronized void rgvCompleteWrkMastSta() {
			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尚未在数据库进行维护！", rgvSlave.getId());
			continue;
			}

			// 只有当RGV等待WCS确认、自动
			if (rgvProtocol.getStatusType() == RgvStatusType.WORKING
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& ((rgvProtocol.getStatusType1()==RgvStatusType.WAITING \|\| rgvProtocol.getStatusType2()==RgvStatusType.WAITING ) \|\|
			(rgvProtocol.getStatusType1()==RgvStatusType.FETCHWAITING \|\| rgvProtocol.getStatusType2()==RgvStatusType.FETCHWAITING ))
			) {
			log.info("{}号小车等待wcs确认，状态{}，参数{}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
			if (rgvProtocol.getTaskNo1()!=0 && (rgvProtocol.getStatusType1()==RgvStatusType.WAITING \|\| rgvProtocol.getStatusType1()==RgvStatusType.FETCHWAITING)){
			if (rgvProtocol.getTaskNo1()==(short)32222){
			boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			break;
			}
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1().longValue());
			if (Cools.isEmpty(wrkMastSta) \|\| wrkMastSta.getType()!=1 \|\| wrkMastSta.getWrkSts()!=1){
			log.error("未查到小车执行任务或者执行任务状态不符合！"+wrkMastSta);
			continue;
			}
			/* WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
			if (!Cools.isEmpty(wrkMast) && wrkMastSta.getWrkType()!=5){
			Thread.sleep(200);
			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
			if (staProtocol == null) {
			continue;
			} else {
			staProtocol = staProtocol.clone();
			}
			if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			continue;
			}
			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(wrkMast.getStaNo());
			if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
			continue;
			}
			log.error("小车任务完成下发输送线任务："+staProtocol);
			// try{
			// Thread.sleep(1000);
			// DevpThread devpThreadEnd = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			// StaProtocol staProtocolEnd = devpThreadEnd.getStation().get(wrkMastSta.getStaEnd());
			// log.error("小车任务完成读取输送线任务："+staProtocolEnd);
			// if (staProtocolEnd.getWorkNo()==0 ){ //\|\| !staProtocolEnd.getWorkNo().equals(wrkMast.getWrkNo())
			// staProtocolEnd.setWorkNo(wrkMast.getWrkNo());
			// staProtocolEnd.setStaNo(wrkMast.getStaNo());
			// if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocolEnd))) {
			// continue;
			// }
			// log.error("小车任务完成下发输送线任务第二次："+staProtocolEnd);
			// }
			// }catch (Exception e){
			//
			// }
			}*/
			boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			wrkMastSta.setWrkSts(3);
			wrkMastStaMapper.updateById(wrkMastSta);
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			}else if (rgvProtocol.getTaskNo2()!=0 && (rgvProtocol.getStatusType2()==RgvStatusType.WAITING \|\| rgvProtocol.getStatusType2()==RgvStatusType.FETCHWAITING)){
			if (rgvProtocol.getTaskNo2()==(short)32222){
			boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			}
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			break;
			}
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo2().longValue());
			if (Cools.isEmpty(wrkMastSta) \|\| wrkMastSta.getType()!=2){
			log.error("未查到小车执行任务或者执行任务状态不符合！"+wrkMastSta);
			continue;
			}
			/*WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
			if (!Cools.isEmpty(wrkMast) && wrkMastSta.getWrkType()!=5){
			Thread.sleep(200);
			DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
			if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			continue;
			}
			// 下发站点信息
			staProtocol.setWorkNo(wrkMast.getWrkNo());
			staProtocol.setStaNo(wrkMast.getStaNo());
			if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
			continue;
			}
			log.error("小车任务完成下发输送线任务："+staProtocol);
			// try{
			// Thread.sleep(1000);
			// DevpThread devpThreadEnd = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
			// StaProtocol staProtocolEnd = devpThreadEnd.getStation().get(wrkMastSta.getStaEnd());
			// log.error("小车任务完成读取输送线任务："+staProtocolEnd);
			// if (staProtocolEnd.getWorkNo()==0 ){ //\|\| !staProtocolEnd.getWorkNo().equals(wrkMast.getWrkNo())
			// staProtocolEnd.setWorkNo(wrkMast.getWrkNo());
			// staProtocolEnd.setStaNo(wrkMast.getStaNo());
			// if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocolEnd))) {
			// continue;
			// }
			// log.error("小车任务完成下发输送线任务第二次："+staProtocolEnd);
			// }
			// }catch (Exception e){
			//
			// }
			}*/
			boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
			if (!rgvComplete){
			log.error("小车复位失败，小车号{}！",rgvProtocol.getRgvNo());
			break;
			}
			wrkMastSta.setWrkSts(3);
			wrkMastStaMapper.updateById(wrkMastSta);
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			}else {
			log.error("小车复位失败，小车号{},等待wcs确认但是没有工作号！",rgvProtocol.getRgvNo());
			}
			}
			}
			}catch (Exception e){
			log.error("小车复位线程报错！"+e);
			}
			}
			/**
			* 入出库 ===>> 小车作业下发
			*/
			public synchronized boolean rgvIoExecute(Integer sign) {
			boolean rgvIoExecuteSign = false;
			try{
			for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			// 获取小车信息
			boolean signWork = false;
			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尚未在数据库进行维护！", rgvSlave.getId());
			continue;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getLoaded1()==0
			&& rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
			) {
			switch (sign){
			//执行小车货物搬运任务
			case 1:
			signWork = rgvRunWrkMastFullSta(rgvSlave);
			break;
			//执行小车空板搬运任务
			case 2://放//拆盘
			signWork = rgvRunWrkMastEmptyStaPut(rgvSlave);
			break;
			case 3://满放
			signWork = rgvRunWrkMastEmptyStaPutFull(rgvSlave);
			break;
			case 4://取叠盘
			signWork = rgvRunWrkMastEmptyStaTake(rgvSlave);
			break;
			case 6:////提升
			// signWork = qwe();
			break;
			default:
			break;
			}
			for (int signCount = 1;!signWork && signCount<7;signCount++){
			switch (signCount){
			case 1://执行小车货物搬运任务
			signWork = rgvRunWrkMastFullSta(rgvSlave);
			break;
			case 2://放//拆盘
			signWork = rgvRunWrkMastEmptyStaPut(rgvSlave);
			break;
			case 3://满放
			signWork = rgvRunWrkMastEmptyStaPutFull(rgvSlave);
			break;
			case 4://取叠盘
			signWork = rgvRunWrkMastEmptyStaTake(rgvSlave);
			break;
			case 6:////提升
			// signWork = rgvRunWrkMastEmptyStaPut();
			break;
			default:
			break;
			}
			}
			}else {
			continue;
			}
			if (!rgvIoExecuteSign){
			rgvIoExecuteSign = signWork;
			}
			}
			// if (!rgvIoExecuteSign){
			// if (sign>6){
			//
			// }
			// }
			}catch (Exception e){
			log.error("RGV小车任务下发报错"+e);
			}
			return rgvIoExecuteSign;
			}

			/**
			* 执行小车搬运任务
			*/
			public synchronized boolean rgvRunWrkMastFullSta(RgvSlave rgvSlave) {
			try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			return false;
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！", rgvSlave.getId());
			return false;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getLoaded1()==0
			&& rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(basRgv.getRgvNo());
			if (basRgvMap == null) {
			log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			return false;
			}
			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()!=1 \|\| wrkMastSta.getWrkType()!=3){//1:满版 3：取放
			continue;
			}
			BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
			if (!basDevp.getAutoing().equals("Y") \|\| basDevp.getLoading().equals("Y") \|\| basDevp.getWrkNo()!=0){
			continue;
			}
			Date date = new Date();

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
			if (staProtocol == null) {
			log.info(date+"取放任务下发：未查询到站点信息："+wrkMastSta);
			continue;
			}
			if (!staProtocol.isAutoing() \|\| staProtocol.isLoading() \|\| staProtocol.getWorkNo() != 0){
			continue;
			}
			if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
			if (staProtocol.isLoadingSuper()){
			continue;
			}
			}
			if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
			if (!staProtocol.isEmptyMk()){
			continue;
			}
			}
			BasDevp basDevpS = basDevpService.selectById(wrkMastSta.getStaStart());
			if (!basDevpS.getAutoing().equals("Y") \|\| !basDevpS.getLoading().equals("Y") \|\| basDevpS.getWrkNo()!=wrkMastSta.getWrkNo().intValue()){
			continue;
			}
			StaProtocol staProtocols = devpThread.getStation().get(basDevpS.getDevNo());
			if (staProtocols == null) {
			log.info(date+"取放任务下发：未查询到站点信息："+wrkMastSta);
			continue;
			}
			if (!staProtocols.isAutoing() \|\| !staProtocols.isLoading() \|\| staProtocols.getWorkNo() != wrkMastSta.getWrkNo().intValue()){
			continue;
			}


			log.info(date+"取放任务下发：小车工作档："+wrkMastSta);
			log.info(date+"取放任务下发：目标站状态："+basDevp);
			boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta);
			if (sign){
			boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd());
			if (signMap){
			wrkMastSta.setWrkSts(1);
			try{
			wrkMastStaMapper.updateById(wrkMastSta);
			}catch (Exception e){
			log.error("更新小车任务失败");
			}
			return true;
			}else {
			log.error("3864行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			}else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}
			break;
			}
			}
			// }
			}catch (Exception e){
			log.error("3875行执行小车搬运任务下发失败");
			log.error("3875行"+e);
			}
			return false;
			}
			/**
			* 执行小车搬运任务//拆盘
			*/
			public synchronized boolean rgvRunWrkMastEmptyStaPut(RgvSlave rgvSlave) {//拆盘
			try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			return false;
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！", rgvSlave.getId());
			return false;
			}

			// 只有当RGV空闲、自动,工位二有物//rgv可用//拆盘
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
			&& (rgvProtocol.getLoaded2()==3 \|\| rgvProtocol.getLoaded2()==1 \|\| rgvProtocol.getLoaded2()==4)////0 无物；1 一层无物二层有物（只能拆叠）；2一层有物二层无物() ；3 1、2层都有物 4：（）只允许拆盘
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			if (basRgvMap == null) {
			log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			return false;
			}
			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){// 2:空板 \|\| 工作类型 1:取（叠盘） 2：拆盘 5：满取 6：满放
			continue;
			}
			boolean sign = false;
			if ( wrkMastSta.getStaEnd()!=0){//放
			BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
			if (!basDevp.getAutoing().equals("Y") \|\| basDevp.getLoading().equals("Y") \|\| basDevp.getWrkNo()!=0){
			continue;
			}
			Date date = new Date();

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
			if (staProtocol == null) {
			log.info(date+"拆盘任务下发：未查询到站点信息："+wrkMastSta);
			continue;
			}
			if (!staProtocol.isAutoing() \|\| staProtocol.isLoading() \|\| staProtocol.getWorkNo() != 0){
			continue;
			}
			if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
			if (staProtocol.isLoadingSuper()){
			continue;
			}
			}
			if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
			if (!staProtocol.isEmptyMk()){
			continue;
			}
			}

			log.info(date+"拆盘任务下发：小车工作档："+wrkMastSta);
			log.info(date+"拆盘任务下发：目标站状态："+basDevp);
			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 true;
			}else {
			log.error("3857行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			}else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}
			break;
			}
			}
			// }
			}catch (Exception e){
			log.error("3933行执行小车放空板任务下发失败");
			log.error("3933行"+e);
			}
			return false;
			}

			/**
			* 执行小车搬运任务
			*/
			public synchronized boolean rgvRunWrkMastEmptyStaPutFull(RgvSlave rgvSlave) {//满放
			try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			return false;
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！", rgvSlave.getId());
			return false;
			}

			// 只有当RGV空闲、自动,工位二有物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
			&& (rgvProtocol.getLoaded2()==2 \|\| rgvProtocol.getLoaded2()==3 ) ////0 无物；1 一层无物二层有物；2一层有物二层无物（只能满放）；3 1、2层都有物 4：（）只允许拆盘
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			if (basRgvMap == null) {
			log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			return false;
			}
			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()!=6){// 2:空板 \|\| 工作类型 1:取（叠盘） 2：拆盘 5：满取 6：满放 7:提升
			continue;
			}
			boolean sign = false;
			if ( wrkMastSta.getStaEnd()!=0){//满放
			BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
			if (!basDevp.getAutoing().equals("Y") \|\| basDevp.getLoading().equals("Y") \|\| basDevp.getWrkNo()!=0){
			continue;
			}
			Date date = new Date();

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
			if (staProtocol == null) {
			log.info(date+"满放任务下发：未查询到站点信息："+wrkMastSta);
			continue;
			}
			if (!staProtocol.isAutoing() \|\| staProtocol.isLoading() \|\| staProtocol.getWorkNo() != 0){
			continue;
			}
			if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
			if (staProtocol.isLoadingSuper()){
			continue;
			}
			}
			if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
			if (!staProtocol.isEmptyMk()){
			continue;
			}
			}

			log.info(date+"满放任务下发：小车工作档："+wrkMastSta);
			log.info(date+"满放任务下发：目标站状态："+basDevp);
			sign = rgvPutEmptyFull(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 true;
			}else {
			log.error("3857行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			}else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}
			break;
			}
			}
			// }
			}catch (Exception e){
			log.error("3933行执行小车放空板任务下发失败");
			log.error("3933行"+e);
			}
			return false;
			}

			public synchronized boolean rgvRunWrkMastEmptyStaTake(RgvSlave rgvSlave) {//叠盘
			try{
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			if (rgvProtocol == null) {
			return false;
			}
			BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
			if (basRgv == null) {
			log.error("{}号RGV尚未在数据库进行维护！", rgvSlave.getId());
			return false;
			}

			// 只有当RGV空闲、自动,工位二无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
			&& (rgvProtocol.getLoaded2()==0 \|\| rgvProtocol.getLoaded2()==1 ) //现场修改：叠盘机，////0 无物；1 一层无物二层有物（只能拆叠）；2一层有物二层无物（只能满放）；3 1、2层都有物 4：（）只允许拆盘
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			if (basRgvMap == null) {
			log.error("{}号RGV尚未在数据库地图中进行维护！", rgvProtocol.getRgvNo());
			return false;
			}
			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:取（叠盘） 2：拆盘 5：满取 6：满放
			continue;
			}
			boolean sign = false;
			if ( wrkMastSta.getStaStart()!=0){//取
			BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaStart());
			if (!basDevp.getAutoing().equals("Y") \|\| !basDevp.getLoading().equals("Y")){
			continue;
			}
			Date date = new Date();

			SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
			StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
			if (staProtocol == null) {
			log.info(date+"叠盘任务下发：未查询到站点信息："+wrkMastSta);
			continue;
			}
			if (!staProtocol.isAutoing() \|\| !staProtocol.isLoading()){
			continue;
			}
			if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
			if (!staProtocol.isEmptyMk()){
			continue;
			}
			}

			log.info(date+"叠盘任务下发：小车工作档："+wrkMastSta);
			log.info(date+"叠盘任务下发：目标站状态："+basDevp);
			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 true;
			}else {
			log.error("3879行，货物搬运任务：工作号{}所属任务下发后地图同步失败",wrkMastSta.getWrkNo());
			}
			}else {
			log.error("工作号{}所属任务下发失败",wrkMastSta.getWrkNo());
			}
			break;
			}
			}
			// }
			}catch (Exception e){
			log.error("3989行执行小车取空板任务下发失败");
			log.error("3989行"+e);
			}
			return false;
			}

			/*
			* 有任务但未执行此时需要调整小车位置
			* */
			public synchronized void rgvRunWrkMastEmptyStaAvoidance() {
			try{
			// Integer integer = wrkMastStaMapper.selectAllWrkStsCount(null,0);//查询状态为0的任务
			// if (integer==0){
			// return;
			// }
			WrkMastSta wrkMastSta = wrkMastStaMapper.selectAllWrkStsCountWrkMastSta(null, 0);
			if (Cools.isEmpty(wrkMastSta)){
			return;
			}
			boolean signRgv = true;
			boolean signRgv1 = true;
			boolean signRgv2 = true;
			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尚未在数据库进行维护！", rgvSlave.getId());
			continue;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getLoaded1()==0 //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			&& rgvProtocol.getTaskNo1()==0
			&& rgvProtocol.getTaskNo2()==0
			&& rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			&& rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			) {
			if (rgvProtocol.getRgvNo()!=1){
			if (!rgvProtocol.getRgvPosI().equals(120) && !rgvProtocol.getRgvPosI().equals(110)){
			continue;
			}
			rgvAvoidanceXY(rgvProtocol.getRgvNo());
			// return;
			continue;
			}
			if (!rgvProtocol.getRgvPosI().equals(110) && !rgvProtocol.getRgvPosI().equals(108) && !rgvProtocol.getRgvPosI().equals(119)){
			continue;
			}
			Integer count108Y = wrkMastStaMapper.selectAllWrkCount108Y();
			if (count108Y!=0){
			continue;
			}
			// Integer count108 = wrkMastStaMapper.selectAllWrkCount108();
			// if (count108!=0){
			// continue;
			// }
			rgvAvoidanceXY(rgvProtocol.getRgvNo());
			continue;
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// Integer fallMerge = RouteUtils.RouteIndexFarMas(basRgvMap.getRgvNo(), basRgvMap.getEndRoute()); //获取合并干涉项
			// List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(),fallMerge);
			// List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route ,route);
			// if (!wrkMastStaList.isEmpty()){
			// log.info("小车存在可执行任务，跳过避让！！4214");
			// return;
			// }
			// if (rgvProtocol.getRgvPosI().equals(basRgvMap.getStartRoute())){
			//// if (!RouteUtils.RgvRunStaSign(rgvProtocol.getRgvPosI(),RouteUtils.RouteIndexFarMas(rgvProtocol.getRgvNo(),rgvRunSta[rgvProtocol.getRgvNo()-1]),rgvProtocol.getRgvNo())){
			//// if (!RouteUtils.RgvRunStaSign(rgvProtocol.getRgvPosI(),rgvRunSta[rgvProtocol.getRgvNo()-1],rgvProtocol.getRgvNo())){
			// if (rgvProtocol.getRgvNo()==1){
			// signRgv1 = false;
			// }else {
			// signRgv2 = false;
			// }
			// }
			// if (rgvProtocol.getRgvNo()==1 && (rgvProtocol.getRgvPosI().equals(101) \|\| rgvProtocol.getRgvPosI().equals(102) )){
			// signRgv1 = false;
			// continue;
			// } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) \|\| rgvProtocol.getRgvPosI().equals(117) ) ){
			// signRgv2 = false;
			// continue;
			// }
			}else {
			signRgv = false;
			break;
			}
			}
			// if (signRgv && (signRgv1 \|\| signRgv2)){
			// for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
			// RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
			// RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
			// if (rgvProtocol == null) {
			// continue;
			// }
			//
			// // 只有当RGV空闲、自动,工位一无物//rgv可用
			// if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			// && rgvProtocol.getModeType() == RgvModeType.AUTO
			// && rgvProtocol.getLoaded1()==0 //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			// && rgvProtocol.getTaskNo1()==0
			// && rgvProtocol.getTaskNo2()==0
			// && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
			// && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
			// ) {
			// if (rgvProtocol.getRgvNo()==1 && (rgvProtocol.getRgvPosI().equals(101) \|\| rgvProtocol.getRgvPosI().equals(102) )){
			// continue;
			// } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) \|\| rgvProtocol.getRgvPosI().equals(117) ) ){
			// continue;
			// }
			// BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
			// rgvAvoidanceXY(rgvProtocol.getRgvNo());
			// rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			//
			// }
			// }
			// }
			}catch (Exception e){
			log.error("4109行执行小车初始化任务下发失败");
			log.error("4109行"+e);
			}
			}

			/*
			* 刷新地图数据
			* */
			public synchronized void refreshRgvMap() {
			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尚未在数据库进行维护！", rgvSlave.getId());
			continue;
			}

			// 只有当RGV空闲、自动,工位一无物//rgv可用
			if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
			&& rgvProtocol.getModeType() == RgvModeType.AUTO
			&& rgvProtocol.getLoaded1()==0 //现场修改：叠盘机，不满都算无物，怎么判断需要跟电控对接
			&& rgvProtocol.getTaskNo1()==0
			&& rgvProtocol.getTaskNo2()==0
			) {
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvSlave.getId());
			basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
			rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
			}
			}
			}catch (Exception e){
			log.error("4109行执行小车初始化任务下发失败");
			log.error("4109行"+e);
			}
			}

			/*
			* 小车XY移动避让
			* */
			public synchronized boolean rgvAvoidanceXY(Integer rgvId){
			if (rgvId==1){
			try{
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
			// 命令下发区 --------------------------------------------------------------------------
			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( (short)104);
			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{
			BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
			// 命令下发区 --------------------------------------------------------------------------
			RgvCommand rgvCommand = new RgvCommand();
			rgvCommand.setRgvNo(rgvId); // RGV编号
			rgvCommand.setAckFinish2((short) 0); // 工位2任务完成确认位
			rgvCommand.setTaskNo2((short)32222); // 工位2工作号
			rgvCommand.setTaskMode2(RgvTaskModeType.X_MOVE); // 工位2任务模式: 回原点
			rgvCommand.setSourceStaNo2((short)114);
			rgvCommand.setCommand((short) 2); //工位2任务确认
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, 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){
			try{
			// 命令下发区 --------------------------------------------------------------------------
			RgvCommand rgvCommand = new RgvCommand();
			rgvCommand.setRgvNo(rgvId); // RGV编号
			rgvCommand.setAckFinish1((short) 0); // 工位1任务完成确认位
			rgvCommand.setTaskNo1(wrkMastSta.getWrkNo().shortValue()); // 工位1工作号
			rgvCommand.setTaskMode1(RgvTaskModeType.FETCH_PUT); // 工位1任务模式: 取放货
			rgvCommand.setSourceStaNo1(wrkMastSta.getStaStart().shortValue()); //工位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 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.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;
			}
			}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.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;
			}
			}catch (Exception e){
			return false;
			}
			}

			/*
			* 小车取空板至工位任务满取
			* */
			public synchronized boolean rgvTakeEmptyFull(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_5); // 工位2任务模式: 满取
			rgvCommand.setSourceStaNo2(wrkMastSta.getStaStart().shortValue()); //工位2起点
			rgvCommand.setCommand((short) 2); //工位2任务确认
			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;
			}
			}catch (Exception e){
			return false;
			}
			}

			/*
			* 小车放空板至输送线任务 //满放
			* */
			public synchronized boolean rgvPutEmptyFull(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_6); // 工位2任务模式: 满放
			rgvCommand.setDestinationStaNo2(wrkMastSta.getStaEnd().shortValue()); //工位2目标站点
			rgvCommand.setCommand((short) 2); //工位2任务确认
			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;
			}
			}catch (Exception e){
			return false;
			}
			}

			/*
			* 小车复位
			* */
			public synchronized boolean rgvComplete(Integer rgvId){
			try{
			// 命令下发区 --------------------------------------------------------------------------
			if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(3, 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;
			}
			}

			/*
			* 小车地图更新更新锁
			* */
			public synchronized boolean rgvMapUpdate(BasRgvMap basRgvMapCurrent,Integer staStart,Integer staEnd){
			if (rgvOpen){
			return true;
			}

			// List<Integer> integers = RouteUtils.RouteMapCurrentFar(basRgvMapCurrent.getNowRoute(),staStart,staEnd, basRgvMapCurrent.getLockStartRoute());
			//更新当前小车锁
			try{
			Integer farCurrentStaNo = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getNowRoute(), staStart, staEnd, basRgvMapCurrent.getLockStartRoute());//获取最远站点
			// Integer farCurrentStaNo = RouteUtils.RouteIndexFarMas(staEnd, staStart, staEnd, basRgvMapCurrent.getLockStartRoute());//获取最远站点
			Integer fallMerge = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getRgvNo(), farCurrentStaNo); //获取合并干涉项
			basRgvMapCurrent.setLockEndRoute(fallMerge);
			basRgvMapMapper.updateById(basRgvMapCurrent);

			//更新另一台小车地图
			Integer rgvNoOther = basRgvMapCurrent.getRgvNoOther();
			BasRgvMap basRgvMapOther = basRgvMapMapper.selectById(rgvNoOther);
			List<Integer> integers = RouteUtils.RouteMapCurrentFar(fallMerge, basRgvMapCurrent.getLockStartRoute());
			Integer lockEndRoute = RouteUtils.RouteMapOtherFarStnNo(integers, basRgvMapCurrent.getLockStartRoute());//另一台小车可活动最远位置
			Integer lockEndRouteL = RouteUtils.RouteIndexFarMasL(rgvNoOther, lockEndRoute);//另一台小车可活动最远位置
			basRgvMapOther.setEndRoute(lockEndRouteL);
			basRgvMapMapper.updateById(basRgvMapOther);
			return true;
			}catch (Exception e){
			log.error("小车地图更新出错！");
			return false;
			}
			}

			}