From 184980deb3f854a98eb112e7998875113ebbba9a Mon Sep 17 00:00:00 2001
From: lsh <lsh@163.com>
Date: 星期一, 28 四月 2025 17:10:39 +0800
Subject: [PATCH] *

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java | 1676 +++++++++++++++++++++++++++++++++++++----------------------
 1 files changed, 1,055 insertions(+), 621 deletions(-)

diff --git a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
index fe2a993..775d5fc 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -6,36 +6,33 @@
 import com.core.common.Cools;
 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.TrackRangeUtils;
 import com.zy.asrs.utils.Utils;
+import com.zy.common.model.MatDto;
 import com.zy.common.service.CommonService;
+import com.zy.common.utils.CollectionUtils;
 import com.zy.common.utils.HttpHandler;
 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.cache.*;
 import com.zy.core.enums.*;
-import com.zy.core.model.CrnSlave;
-import com.zy.core.model.DevpSlave;
-import com.zy.core.model.Task;
-import com.zy.core.model.command.CommandPackage;
+import com.zy.core.model.*;
 import com.zy.core.model.command.CrnCommand;
-import com.zy.core.model.protocol.CrnProtocol;
-import com.zy.core.model.protocol.StaProtocol;
+import com.zy.core.model.command.LedCommand;
+import com.zy.core.model.protocol.*;
 import com.zy.core.properties.SlaveProperties;
 import com.zy.core.thread.BarcodeThread;
+import com.zy.core.thread.LedThread;
+import com.zy.core.thread.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;
@@ -45,6 +42,8 @@
 
 import java.io.IOException;
 import java.util.*;
+import java.util.concurrent.ConcurrentHashMap;
+import java.util.stream.Collectors;
 
 /**
  * 绔嬩綋浠撳簱WCS绯荤粺涓绘祦绋嬩笟鍔�
@@ -54,8 +53,6 @@
 @Service("mainService")
 @Transactional
 public class MainServiceImpl {
-
-    public static final long COMMAND_TIMEOUT = 5 * 1000;
 
     @Autowired
     private SlaveProperties slaveProperties;
@@ -76,40 +73,42 @@
     @Autowired
     private TaskWrkService taskWrkService;
     @Autowired
-    private ConfigService configService;
-    @Autowired
     private StaDescMapper staDescMapper;
     @Autowired
-    private CommandInfoService commandInfoService;
-
-    @Autowired
-    private OpenServiceImpl openServiceImpl;
-    @Autowired
     private StaDescService staDescService;
-
     @Autowired
     private ApiLogService apiLogService;
     @Autowired
     private CommonService commonService;
+    @Autowired
+    private CrnController crnController;
+    @Autowired
+    private BasDevpPositionService basDevpPositionService;
 
     @Value("${wms.url}")
     private String wmsUrl;
     @Value("${wms.inboundTaskApplyPath}")
     private String inboundTaskApplyPath;
-    @Value("${wms.movePath}")
-    private String movePath;
     @Value("${wms.taskStatusFeedbackPath}")
     private String taskStatusFeedbackPath;
-    @Autowired
-    private CrnController crnController;
-    @Autowired
-    private SiteController siteController;
 
+    @Value("${wms.rgvOpen}")
+    private boolean rgvOpen;
 
-    public void generateStoreWrkFile() throws IOException, InterruptedException {
+    @Value("${constant-parameters.trackEntireLength}")
+    private Long trackEntireLength;
+
+    @Value("${constant-parameters.trackBenchmark}")
+    private Long trackBenchmark;
+
+    @Value("${constant-parameters.trackProportion}")
+    private Long trackProportion;
+
+    @Value("${constant-parameters.avoidDistance}")
+    private Long avoidDistance;
+
+    public void generateStoreWrkFile() {
         try {
-
-
             // 鏍规嵁杈撻�佺嚎plc閬嶅巻
             for (DevpSlave devp : slaveProperties.getDevp()) {
                 // 閬嶅巻鍏ュ簱鍙�
@@ -122,8 +121,8 @@
                     } else {
                         staProtocol = staProtocol.clone();
                     }
-                    Short workNo = staProtocol.getWorkNo();
-                    Short stano = staProtocol.getStaNo();
+                    Integer workNo = staProtocol.getWorkNo();
+                    Integer stano = staProtocol.getStaNo();
 
                     // 灏哄妫�娴嬪紓甯�
                     boolean back = false;
@@ -158,23 +157,24 @@
                     }
                     // 閫�鍥�
                     if (back) {
-                        if (stano == inSta.getBackSta().shortValue()){
+                        if (stano == inSta.getBackSta().shortValue()) {
                             continue;
                         }
-                        if (workNo == 0 && stano == 0){
+                        if (workNo == 0 && stano == 0) {
                             continue;
                         }
-                        if (!staProtocol.isPakMk()){
+                        if (!staProtocol.isPakMk()) {
                             continue;
                         }
 //                        News.warn("鎵爜鍏ュ簱澶辫触锛寋}鍏ュ簱绔欏洜{}寮傚父锛屾墭鐩樺凡琚��鍥�", inSta.getStaNo(), errMsg);
                         staProtocol.setWorkNo(workNo);
-                        staProtocol.setStaNo(inSta.getBackSta().shortValue());
+                        staProtocol.setStaNo(inSta.getStaNo());
                         devpThread.setPakMk(staProtocol.getSiteId(), false);
-                        MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, staProtocol));
+                        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;
@@ -182,173 +182,110 @@
                     // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
                     if (staProtocol.isAutoing() && staProtocol.isLoading()
                             && staProtocol.isInEnable()
-                            && !staProtocol.isEmptyMk() && (workNo >= 0)
-                            && staProtocol.isPakMk()) {
+                            && !staProtocol.isEmptyMk() && (workNo == 0 || (workNo>9000 && workNo<10000))
+                            && staProtocol.isPakMk()
+                            && staProtocol.isPakMkWalk()
+                    ) {
                         // 鑾峰彇鏉$爜鎵弿浠俊鎭�
                         BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
                         if (barcodeThread == null) {
                             continue;
                         }
                         String barcode = barcodeThread.getBarcode();
-                        if(!Cools.isEmpty(barcode) && !barcode.equals("99999999")) {
+                        if (!Cools.isEmpty(barcode) && !barcode.equals("99999999")) {
                             // 璇锋眰wms鎺ュ彛锛岃幏鍙栧伐浣滃彿鍜岀洰鏍囧簱浣�
-                            ToWmsDTO toWmsDTO = new ToWmsDTO(barcode,staProtocol.getSiteId(),staProtocol.isHigh() ? 2 : 1);
-                            TaskWrk taskWrk1=taskWrkService.selectOne(new EntityWrapper<TaskWrk>().eq("barcode",barcode));
-                            if(!Cools.isEmpty(taskWrk1)){
-                                log.info("鎵樼洏鐮侊細"+barcode+"浠诲姟妗e瓨鍦�");
-                                continue;
-                            }
-                            HashMap<String, Object> headParam = new HashMap<>();
-                            headParam.put("Content-Type","application/json");
-                            String response;
-                            response = new HttpHandler.Builder()
-                                   // .setHeaders(headParam)
-                                    .setUri(wmsUrl)
-                                    .setPath(inboundTaskApplyPath)
-                                    .setJson(JSON.toJSONString(toWmsDTO))
-                                    .build()
-                                    .doPost();
+                            ToWmsDTO toWmsDTO = new ToWmsDTO(staProtocol.getSiteId(),staProtocol.getGrossWt(),barcode, 0);
+                            TaskWrk taskWrk1 = taskWrkService.selectOne(new EntityWrapper<TaskWrk>().eq("barcode", barcode));
+                            if (!Cools.isEmpty(taskWrk1)) {
+                                log.info("鎵樼洏鐮侊細" + barcode + "浠诲姟妗e瓨鍦�");
+                                if (taskWrk1.getIoType() == 1 && taskWrk1.getStartPoint().equals(staProtocol.getSiteId().toString())) {
+                                    StaDesc staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
+                                            .eq("CRN_NO", taskWrk1.getCrnNo()).eq("TYPE_NO", 1).eq("STN_NO", staProtocol.getSiteId()));
 
-                            JSONObject jsonObject = JSON.parseObject(response);
-                            apiLogService.save("wms璇锋眰鍏ュ簱璐т綅鎺ュ彛"
-                                    ,wmsUrl+inboundTaskApplyPath
-                                    ,null
-                                    ,"127.0.0.1"
-                                    ,JSON.toJSONString(toWmsDTO)
-                                    ,response
-                                    ,true
-                            );
-                            log.info("鍏ュ簱璇锋眰鍙傛暟{}" + JSON.toJSONString(toWmsDTO));
-                            if (jsonObject.getInteger("code").equals(200) && !Cools.isEmpty(jsonObject.get("data").toString())) {
-                                GetWmsDto getWmsDto = JSON.parseObject(jsonObject.get("data").toString(), GetWmsDto.class);
-
-                                //鏌ョ湅璇ュ簱浣嶆槸鍚︿负绌哄簱浣�
-                                LocMast locMast=locMastService.selectOne(new EntityWrapper<LocMast>()
-                                        .eq("loc_sts","O")
-                                        .eq("loc_no",getWmsDto.getLocNo()));
-                                if(Cools.isEmpty(locMast)){
-                                    try{
-                                        HashMap<String, Object> headParam1 = new HashMap<>();
-                                        headParam1.put("taskNo",getWmsDto.getTaskNo());
-                                        headParam1.put("status",6);
-                                        headParam1.put("ioType",1);
-                                        headParam1.put("barcode",barcode);
-                                        String response2;
-                                        response2 = new HttpHandler.Builder()
-                                                // .setHeaders(headParam)
-                                                .setUri(wmsUrl)
-                                                .setPath(taskStatusFeedbackPath)
-                                                .setJson(JSON.toJSONString(headParam1))
-                                                .build()
-                                                .doPost();
-                                        JSONObject jsonObject1 = JSON.parseObject(response2);
-                                        apiLogService.save("wcs娲惧彂搴撲綅涓嶄负绌轰笂鎶ms"
-                                                ,wmsUrl+taskStatusFeedbackPath
-                                                ,null
-                                                ,"127.0.0.1"
-                                                ,JSON.toJSONString(headParam1)
-                                                ,response
-                                                ,true
-                                        );
-                                    }catch (Exception e){
-                                        log.error("wcs娲惧彂搴撲綅涓嶄负绌轰笂鎶ms", getWmsDto.getWrkNo());
-                                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
-                                    }
-                                }
-
-                                // 鍒涙柊涓�涓叆搴撳伐浣滄。
-                                TaskWrk taskWrk = taskWrkService.selectByTaskNo(getWmsDto.getWrkNo());
-                                if(Cools.isEmpty(taskWrk)) {
-                                    taskWrk = createTask(getWmsDto,barcode);
-                                    if (Cools.isEmpty(taskWrk)){
-                                        log.error("搴撲綅寮傚父锛屽簱浣嶅彿锛歿}", getWmsDto.getTargetLocationCode());
-                                    }else {
-                                        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());
+                                    if (Cools.isEmpty(staDesc)) {
+                                        log.info("鎵樼洏鐮侊細" + barcode + "浠诲姟妗e瓨鍦�");
+                                        return;
+                                    } else {
+                                        staProtocol.setWorkNo(taskWrk1.getWrkNo());
+                                        staProtocol.setStaNo(staDesc.getCrnStn());
                                         MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
                                     }
                                 }
-
-                            }else {
+                                return;
+                            }
+                            HashMap<String, Object> headParam = new HashMap<>();
+                            headParam.put("Content-Type", "application/json");
+                            String response;
+                            try {
+                                response = new HttpHandler.Builder()
+                                        // .setHeaders(headParam)
+                                        .setUri(wmsUrl)
+                                        .setPath(inboundTaskApplyPath)
+                                        .setJson(JSON.toJSONString(toWmsDTO))
+                                        .build()
+                                        .doPost();
+                            } catch (Exception e) {
+                                log.error("璇锋眰鍏ュ簱璋冪敤鎺ュ彛澶辫触");
+                                log.error("寮傚父淇℃伅鎵撳嵃锛�" + e);
+                                try {
+                                    BasDevp basDevp = basDevpService.selectById(inSta.getStaNo());
+                                    if (Cools.isEmpty(basDevp)) {
+                                        log.error("绔欑偣鍙峰紓甯�" + inSta.getStaNo());
+                                    } else if (basDevp.getStaErr() != 0) {
+                                        basDevp.setStaErr(2);
+                                        basDevpService.updateById(basDevp);
+                                    }
+                                } catch (Exception e1) {
+                                    // 閫�鍥�
+                                    log.error("鎵爜妫�娴嬬▼搴忓紓甯�" + inSta.getStaNo() + "寮傚父淇℃伅" + e1);
+                                }
+                                staProtocol.setWorkNo(9999);
+                                staProtocol.setStaNo(inSta.getStaNo());
+                                devpThread.setPakMk(staProtocol.getSiteId(), false);
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
                                 continue;
                             }
 
-//                        StaDescService staDescService = SpringUtils.getBean(StaDescService.class);
-//
-//                        ToWmsDTO toWmsDTO = new ToWmsDTO();
-//                        Map<String, Object> map = new HashMap<>();
-//                        map.put("x-api-key","7a15b5db-29b6-552c-8cff-0cfec3756da2");
-//                        List<Integer> list = openServiceImpl.getInEnableRoadway();
-//                        TaskWrk taskWrk = taskWrkService.selectOne(new EntityWrapper<TaskWrk>().eq("barcode", barcode));
-//
-//                        if (Cools.isEmpty(taskWrk)){
-//                            continue;
-//                        }
-//                        //StaDesc staDesc1 = staDescService.selectOne(new EntityWrapper<StaDesc>().eq("stn_no",inSta.getBackSta()));
-//                        if (taskWrk.getTargetPoint() != null && taskWrk.getStartPoint() != null){
-//                            if ( taskWrk.getWrkNo() != null && taskWrk.getWrkNo().shortValue() == workNo ){
-//                                continue;
-//                            }
-//                            //鑾峰彇鍫嗗灈鏈虹珯鐐�
-//                            StaDesc staDesc = new StaDesc();
-//                            if (devp.getId() <= 1){
-//                                staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
-//                                        .eq("crn_no", taskWrk.getCrnNo()).eq("type_no",1).lt("stn_no", 200));
-//                            }else {
-//                                staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
-//                                        .eq("crn_no", taskWrk.getCrnNo()).eq("type_no",1).lt("stn_no", 400).ge("stn_no", 250));
-//                            }
-//                            staProtocol.setWorkNo(taskWrk.getWrkNo().shortValue());
-//                            staProtocol.setStaNo(staDesc.getCrnStn().shortValue());
-//                            MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, staProtocol));
-//                            Thread.sleep(500);
-//                        }else {
-//                            //TaskWrk taskWrk = taskWrkService.selectByTaskNo(param.getTaskNo());
-//                            toWmsDTO.setWarehouseId("1688469798893297665");
-//                            toWmsDTO.setContainerCode(barcode);
-//                            toWmsDTO.setApplyType("TUNNEL_LOCATION");
-//                            toWmsDTO.setTaskTunnel(taskWrk.getCrnNo());
-//                            toWmsDTO.setCanInboundTunnels(list);
-//                            String response = null;
-//                            try {
-//                                response = new HttpHandler.Builder()
-//                                        .setHeaders(map)
-//                                        .setUri(wmsUrl)
-//                                        .setPath(inboundTaskApplyPath)
-//                                        .setJson(JSON.toJSONString(toWmsDTO))
-//                                        .build()
-//                                        .doPost();
-//                            }catch (Exception e){
-//                                log.error("wms閫氳澶辫触,"+e.getMessage());
-//                                continue;
-//                            }
-//                            apiLogService.save("wms璇锋眰鍏ュ簱璐т綅鎺ュ彛"
-//                                    ,wmsUrl+"wcsManager/wcsInterface/inboundTaskApply"
-//                                    ,null
-//                                    ,"127.0.0.1"
-//                                    ,JSON.toJSONString(toWmsDTO)
-//                                    ,response
-//                                    ,true
-//                            );
-//                            JSONObject jsonObject = JSON.parseObject(response);
-//                            if (jsonObject.getInteger("code").equals(200)) {
-//                                GetWmsDto getWmsDto = JSON.parseObject(jsonObject.get("data").toString(), GetWmsDto.class);
-//                                taskWrk.setOriginTargetPoint(getWmsDto.getTargetLocationCode());
-//                                taskWrk.setTargetPoint(Utils.getWcsLocNo(getWmsDto.getTargetLocationCode()));
-//                                taskWrk.setStartPoint(String.valueOf(inSta.getBackSta()));
-//                                if (!taskWrkService.updateById(taskWrk)){
-//                                    log.error("淇濆瓨wms搴撲綅鍙峰け璐�");
-//                                }
-//
-//                            }else {
-//                                log.error("wms閫氳澶辫触,"+jsonObject.get("msg"));
-//
-//                            }
-//                        }
+                            JSONObject jsonObject = JSON.parseObject(response);
+                            apiLogService.save("wms璇锋眰鍏ュ簱璐т綅鎺ュ彛"
+                                    , wmsUrl + inboundTaskApplyPath
+                                    , null
+                                    , "127.0.0.1"
+                                    , JSON.toJSONString(toWmsDTO)
+                                    , response
+                                    , true
+                            );
+                            log.info("鍏ュ簱璇锋眰鍙傛暟{}" + JSON.toJSONString(toWmsDTO));
+                            log.info("鍏ュ簱璇锋眰杩斿洖鍙傛暟{}" + JSON.toJSONString(response));
+                            if (jsonObject.getInteger("code").equals(200)) {
+                                try {
+                                    devpThread.setPakMk(staProtocol.getSiteId(), false);
+                                } catch (Exception e) {
+                                    // 閫�鍥�
+                                    log.error("鎵爜妫�娴嬬▼搴忓紓甯�" + inSta.getStaNo() + errMsg);
+                                    log.error("鎵爜妫�娴嬬▼搴忓紓甯�,寮傚父淇℃伅" + e);
 
+                                    staProtocol.setWorkNo(9999);
+                                    staProtocol.setStaNo(inSta.getStaNo());
+                                    devpThread.setPakMk(staProtocol.getSiteId(), false);
+                                    MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                }
+
+                            }
+                        } else {
+                            // 閫�鍥�
+                            log.error("鎵爜鍏ュ簱澶辫触锛寋}鍏ュ簱绔欏洜{}寮傚父锛屾墭鐩樺凡琚��鍥�", inSta.getStaNo(), errMsg);
+
+                            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);
+                            }
                         }
                     }
 
@@ -361,34 +298,325 @@
         }
     }
 
+    public void generateStoreWrkFileIsEmptyMk() {
+        try {
+            // 鏍规嵁杈撻�佺嚎plc閬嶅巻
+            for (DevpSlave devp : slaveProperties.getDevp()) {
+                // 閬嶅巻鍏ュ簱鍙�
+                for (DevpSlave.Sta inSta : devp.getInSta()) {
+                    // 鑾峰彇鍏ュ簱绔欎俊鎭�
+                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                    StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
+                    if (staProtocol == null) {
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+                    Integer workNo = staProtocol.getWorkNo();
+                    Integer stano = staProtocol.getStaNo();
+
+                    // 灏哄妫�娴嬪紓甯�
+                    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) {
+                        if (stano == inSta.getBackSta().shortValue()) {
+                            continue;
+                        }
+                        if (workNo == 0 && stano == 0) {
+                            continue;
+                        }
+                        if (!staProtocol.isPakMk()) {
+                            continue;
+                        }
+//                        News.warn("鎵爜鍏ュ簱澶辫触锛寋}鍏ュ簱绔欏洜{}寮傚父锛屾墭鐩樺凡琚��鍥�", inSta.getStaNo(), errMsg);
+                        staProtocol.setWorkNo(workNo);
+                        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;
+                    }
+                    // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
+                    if (staProtocol.isAutoing() && staProtocol.isLoading()
+                            && staProtocol.isInEnable()
+                            && staProtocol.isEmptyMk() && (workNo == 0 || (workNo>9000 && workNo<10000))
+                            && staProtocol.isPakMk()
+                            && staProtocol.isPakMkWalk()
+                    ) {
+                        // 璇锋眰wms鎺ュ彛锛岃幏鍙栧伐浣滃彿鍜岀洰鏍囧簱浣�
+                        ToWmsDTO toWmsDTO = new ToWmsDTO("", staProtocol.getSiteId(), 1);
+
+                        HashMap<String, Object> headParam = new HashMap<>();
+                        headParam.put("Content-Type", "application/json");
+                        String response;
+                        try {
+                            response = new HttpHandler.Builder()
+                                    // .setHeaders(headParam)
+                                    .setUri(wmsUrl)
+                                    .setPath(inboundTaskApplyPath)
+                                    .setJson(JSON.toJSONString(toWmsDTO))
+                                    .build()
+                                    .doPost();
+                        } catch (Exception e) {
+                            log.error("璇锋眰鍏ュ簱璋冪敤鎺ュ彛澶辫触");
+                            log.error("寮傚父淇℃伅鎵撳嵃锛�" + e);
+                            try {
+                                BasDevp basDevp = basDevpService.selectById(inSta.getStaNo());
+                                if (Cools.isEmpty(basDevp)) {
+                                    log.error("绔欑偣鍙峰紓甯�" + inSta.getStaNo());
+                                } else if (basDevp.getStaErr() != 0) {
+                                    basDevp.setStaErr(2);
+                                    basDevpService.updateById(basDevp);
+                                }
+                            } catch (Exception e1) {
+                                // 閫�鍥�
+                                log.error("鎵爜妫�娴嬬▼搴忓紓甯�" + inSta.getStaNo() + "寮傚父淇℃伅" + e1);
+                            }
+                            staProtocol.setWorkNo(9999);
+                            staProtocol.setStaNo(inSta.getStaNo());
+                            devpThread.setPakMk(staProtocol.getSiteId(), false);
+                            MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                            continue;
+                        }
+
+                        JSONObject jsonObject = JSON.parseObject(response);
+                        apiLogService.save("wms璇锋眰鍏ュ簱璐т綅鎺ュ彛"
+                                , wmsUrl + inboundTaskApplyPath
+                                , null
+                                , "127.0.0.1"
+                                , JSON.toJSONString(toWmsDTO)
+                                , response
+                                , true
+                        );
+                        log.info("鍏ュ簱璇锋眰鍙傛暟{}" + JSON.toJSONString(toWmsDTO));
+                        log.info("鍏ュ簱璇锋眰杩斿洖鍙傛暟{}" + JSON.toJSONString(response));
+                        if (jsonObject.getInteger("code").equals(200)) {
+                            try {
+                                devpThread.setPakMk(staProtocol.getSiteId(), false);
+                            } catch (Exception e) {
+//                                    log.error("鎵爜妫�娴嬬▼搴忓紓甯�"+inSta.getStaNo()+"寮傚父淇℃伅"+e);
+                                // 閫�鍥�
+                                log.error("鎵爜妫�娴嬬▼搴忓紓甯�" + inSta.getStaNo() + errMsg);
+                                log.error("鎵爜妫�娴嬬▼搴忓紓甯�,寮傚父淇℃伅" + e);
+
+                                staProtocol.setWorkNo(9999);
+                                staProtocol.setStaNo(inSta.getStaNo());
+                                devpThread.setPakMk(staProtocol.getSiteId(), false);
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                            }
+                        } else {
+                            continue;
+                        }
+                    }
+                }
+            }
+        } catch (Exception e) {
+            log.error("generateStoreWrkFile e", e);
+            TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+        }
+    }
+
+
+    public void generateStoreWrkFileWalk() {
+        try {
+            // 鏍规嵁杈撻�佺嚎plc閬嶅巻
+            for (DevpSlave devp : slaveProperties.getDevp()) {
+                // 閬嶅巻鍏ュ簱鍙�
+                for (DevpSlave.Sta inSta : devp.getInWalkSta()) {
+                    // 鑾峰彇鍏ュ簱绔欎俊鎭�
+                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                    StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
+                    if (staProtocol == null) {
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+                    Integer workNo = staProtocol.getWorkNo();
+
+                    // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
+                    if (staProtocol.isAutoing() && staProtocol.isLoading()
+                            && staProtocol.isInEnable() && (workNo == 0 || (workNo>9000 && workNo<10000))
+                            && staProtocol.isPakMkWalk()
+                    ) {
+                        if (inSta.isBarcodeSign()){
+                            // 鑾峰彇鏉$爜鎵弿浠俊鎭�
+                            BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
+                            if (barcodeThread == null) {
+                                continue;
+                            }
+                            String barcode = barcodeThread.getBarcode();
+                            if (!Cools.isEmpty(barcode) && !barcode.equals("99999999")) {
+                                // 璇锋眰wms鎺ュ彛锛岃幏鍙栧伐浣滃彿鍜岀洰鏍囧簱浣�
+                                ToWmsDTO toWmsDTO = new ToWmsDTO(barcode, staProtocol.getSiteId(), 0);
+                                TaskWrk taskWrk1 = taskWrkService.selectOne(new EntityWrapper<TaskWrk>().eq("barcode", barcode));
+
+                                if (!Cools.isEmpty(taskWrk1)) {
+                                    log.info("鎵樼洏鐮侊細" + barcode + "浠诲姟妗e瓨鍦�");
+                                    if (taskWrk1.getIoType() == 1 && taskWrk1.getStartPoint().equals(staProtocol.getSiteId().toString())) {
+                                        StaDesc staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
+                                                .eq("CRN_NO", taskWrk1.getCrnNo()).eq("TYPE_NO", 1).eq("STN_NO", staProtocol.getSiteId()));
+
+                                        if (Cools.isEmpty(staDesc)) {
+                                            log.info("鎵樼洏鐮侊細" + barcode + "浠诲姟妗e瓨鍦�");
+                                            return;
+                                        } else {
+                                            staProtocol.setWorkNo(taskWrk1.getWrkNo());
+                                            staProtocol.setStaNo(staDesc.getCrnStn());
+                                            MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                        }
+                                    }
+                                    return;
+                                }
+                            } else {
+                                TaskWrk taskWrk1 = taskWrkService.selectOne(new EntityWrapper<TaskWrk>());
+
+                                if (!Cools.isEmpty(taskWrk1)) {
+                                    if (taskWrk1.getIoType() == 1 && taskWrk1.getStartPoint().equals(staProtocol.getSiteId().toString())) {
+                                        StaDesc staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
+                                                .eq("CRN_NO", taskWrk1.getCrnNo()).eq("TYPE_NO", 1).eq("STN_NO", staProtocol.getSiteId()));
+
+                                        if (Cools.isEmpty(staDesc)) {
+                                            return;
+                                        } else {
+                                            staProtocol.setWorkNo(taskWrk1.getWrkNo());
+                                            staProtocol.setStaNo(staDesc.getCrnStn());
+                                            MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                        }
+                                    }
+                                    return;
+                                }
+                            }
+                        } else {
+                            TaskWrk taskWrk1 = taskWrkService.selectOne(new EntityWrapper<TaskWrk>());
+
+                            if (!Cools.isEmpty(taskWrk1)) {
+                                if (taskWrk1.getIoType() == 1 && taskWrk1.getStartPoint().equals(staProtocol.getSiteId().toString())) {
+                                    StaDesc staDesc = staDescService.selectOne(new EntityWrapper<StaDesc>()
+                                            .eq("CRN_NO", taskWrk1.getCrnNo()).eq("TYPE_NO", 1).eq("STN_NO", staProtocol.getSiteId()));
+
+                                    if (Cools.isEmpty(staDesc)) {
+                                        return;
+                                    } else {
+                                        staProtocol.setWorkNo(taskWrk1.getWrkNo());
+                                        staProtocol.setStaNo(staDesc.getCrnStn());
+                                        MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                    }
+                                }
+                                return;
+                            }
+                        }
+                    }
+
+
+                }
+            }
+        } catch (Exception e) {
+            log.error("generateStoreWrkFile e", e);
+            TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+        }
+    }
 
     /**
      * 鍫嗗灈鏈虹珯鍑哄簱鍒板嚭搴撶珯
      */
     public void crnStnToOutStn() {
         for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+
+            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
+            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnSlave.getId());
+            CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+            if (crnProtocol == null) {
+                continue;
+            }
+            BasCrnp basCrnp = basCrnpService.selectById(crnSlave.getId());
+            if (basCrnp == null) {
+                log.error("{}鍙峰爢鍨涙満灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", crnSlave.getId());
+                continue;
+            }
+            if (!crnSlave.getId().equals(crnProtocol.getLaneNo())) {
+                for (CrnSlave crnOther : slaveProperties.getCrn()) {
+                    if (crnOther.getId().equals(crnProtocol.getLaneNo())) {
+                        crnSlave.updateCrnInStn(crnOther);
+                    }
+                }
+            }
             // 閬嶅巻鍫嗗灈鏈哄嚭搴撶珯
             for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
-                List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("crn_no", crnSlave.getId()).eq("crn_stn", crnStn.getStaNo()));
-                for (StaDesc staDesc : staDescs){
-                    // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
-                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
-                    StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
-                    if (staProtocol == null) {
-                        continue;
-                    } else {
-                        staProtocol = staProtocol.clone();
-                    }
-                    if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 || staProtocol.getStaNo() == 0)) {
-                        // 鏌ヨ宸ヤ綔妗�
-                        TaskWrk taskWrk = taskWrkMapper.selectCrnStaWorking(crnSlave.getId(), staDesc.getStnNo().toString());
-                        if (taskWrk == null) {
+
+                List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("CRN_NO", crnProtocol.getLaneNo()).eq("CRN_STN", crnStn.getStaNo()));
+                for (StaDesc staDesc : staDescs) {
+                    try {
+                        // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
+                        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+                        StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+                        if (staProtocol == null) {
                             continue;
+                        } else {
+                            staProtocol = staProtocol.clone();
                         }
-                        siteController.siteDetlUpdate(Integer.valueOf(taskWrk.getTargetPoint()),taskWrk.getWrkNo().shortValue(),(short)0,"Y",false,false);
-                        taskWrk.setStatus(5);
-                        taskWrk.setWrkSts(14);
-                        taskWrkService.updateById(taskWrk);
+                        if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 || staProtocol.getStaNo() == 0)) {
+                            // 鏌ヨ宸ヤ綔妗�
+                            TaskWrk taskWrk = taskWrkMapper.selectCrnStaWorking(crnProtocol.getLaneNo(), staDesc.getStnNo().toString());
+                            if (taskWrk == null) {
+                                continue;
+                            }
+                            log.info("涓嬪彂杈撻�佺嚎浠诲姟锛歵askWrk:" + JSON.toJSONString(taskWrk));
+//                            R r = siteController.siteDetlUpdate(Integer.valueOf(taskWrk.getTargetPoint()), taskWrk.getWrkNo().shortValue(), (short) 0, "Y", false, false);
+                            staProtocol.setWorkNo(taskWrk.getWrkNo());
+                            staProtocol.setStaNo(staDesc.getCrnStn());
+                            boolean offer = false;
+                            try {
+                                offer = MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol));
+                            } catch (Exception e) {
+                                log.error("涓嬪彂杈撻�佺嚎浠诲姟澶辫触锛氬紓甯�:" + e);
+                                log.error("涓嬪彂杈撻�佺嚎浠诲姟澶辫触锛氬紓甯�:offer:" + offer);
+                            }
+//                            JSONObject jsonObject = JSON.parseObject(JSON.toJSONString(r));
+                            if (offer) {
+                                log.info("涓嬪彂杈撻�佺嚎浠诲姟鎴愬姛锛歵askWrk:" + 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("涓嬪彂杈撻�佺嚎浠诲姟澶辫触锛歵askWrk:" + JSON.toJSONString(taskWrk));
+//                                log.error("涓嬪彂杈撻�佺嚎浠诲姟澶辫触锛氬紓甯镐俊鎭�:"+JSON.toJSONString(r));
+                            }
+                        }
+                    } catch (Exception e) {
+                        log.error("鍑哄簱鍒板嚭搴撶珯寮傚父:寮傚父淇℃伅锛�" + e);
                     }
                 }
 
@@ -404,12 +632,25 @@
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
             CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
             CrnProtocol crnProtocol = crnThread.getCrnProtocol();
-            if (crnProtocol == null) { continue; }
+            if (crnProtocol == null) {
+                continue;
+            }
             BasCrnp basCrnp = basCrnpService.selectById(crn.getId());
             if (basCrnp == null) {
                 log.error("{}鍙峰爢鍨涙満灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", crn.getId());
                 continue;
             }
+
+            if (!crn.getId().equals(crnProtocol.getLaneNo())) {
+                for (CrnSlave crnOther : slaveProperties.getCrn()) {
+                    if (crnOther.getId().equals(crnProtocol.getLaneNo())) {
+                        crn.updateCrnInStn(crnOther);
+                    }
+                }
+            }
+
+            // 搴撲綅绉昏浆
+            this.locToLoc(crn, crnProtocol);
 
             // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
             if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO
@@ -435,8 +676,6 @@
                     }
                 }
             }
-            // 搴撲綅绉昏浆
-            this.locToLoc(crn, crnProtocol);
 
         }
     }
@@ -446,7 +685,8 @@
      */
     public void crnStnToLoc(CrnSlave slave, CrnProtocol crnProtocol) throws IOException {
         for (CrnSlave.CrnStn crnStn : slave.getCrnInStn()) {
-            List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("crn_no", slave.getId()).eq("crn_stn", crnStn.getStaNo()));
+            List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("CRN_NO", crnProtocol.getLaneNo()).eq("CRN_STN", crnStn.getStaNo()));
+
             for (StaDesc staDesc : staDescs) {
                 boolean flag = false;
                 // 鑾峰彇鍫嗗灈鏈哄叆搴撶珯淇℃伅
@@ -464,7 +704,7 @@
                     continue;
                 }
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
-                        && staDetl.getCanining()!=null && staDetl.getCanining().equals("Y")) {
+                        && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
                     flag = true;
                 }
                 if (!flag) {
@@ -472,8 +712,8 @@
                 }
 
                 // 鑾峰彇宸ヤ綔鐘舵�佷负2锛堣澶囦笂璧帮級鐨勫叆搴撳伐浣滄。
-                TaskWrk taskWrk = taskWrkMapper.selectPakIn(slave.getId(), staProtocol.getWorkNo().intValue(), staDesc.getStnNo().toString());
-                if(null == taskWrk) {
+                TaskWrk taskWrk = taskWrkMapper.selectPakIn(crnProtocol.getLaneNo(), staProtocol.getWorkNo().intValue(), staDesc.getStnNo().toString());
+                if (null == taskWrk) {
                     continue;
                 }
 
@@ -483,19 +723,20 @@
                 }
 
                 // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-                if (taskWrkMapper.selectCrnWorking(slave.getId()) != null) {
+                if (taskWrkMapper.selectCrnWorking(crnProtocol.getLaneNo()) != null) {
                     continue;
                 }
 
-                int workNo = commonService.getWorkNo(WorkNoType.PAKIN.type);//鑾峰彇鍏ュ簱宸ヤ綔鍙�
-                taskWrk.setWrkNo(workNo);//宸ヤ綔鍙�
+//                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);
-                taskWrkService.updateById(taskWrk);
 
 //                //鍙栧嚭鍛戒护
 //                List<CommandInfo> commandInfos = commandInfoService.selectByTaskNo(taskWrk.getTaskNo());
@@ -530,7 +771,8 @@
 
                 // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
                 CrnCommand crnCommand = new CrnCommand();
-                crnCommand.setCrnNo(staDesc.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+                crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                crnCommand.setCrnNo(crnProtocol.getLaneNo()); // 鍫嗗灈鏈哄贩閬撶紪鍙�
                 crnCommand.setTaskNo(taskWrk.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                 crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
                 crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
@@ -540,17 +782,23 @@
                 crnCommand.setDestinationPosX(Utils.getRowShort(taskWrk.getTargetPoint()));     // 鐩爣搴撲綅鍒�
                 crnCommand.setDestinationPosY(Utils.getBayShort(taskWrk.getTargetPoint()));     // 鐩爣搴撲綅灞�
                 crnCommand.setDestinationPosZ(Utils.getLevShort(taskWrk.getTargetPoint()));     // 鐩爣搴撲綅鎺�
-                crnCommand.setCommand((short)1);
-                if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, crnCommand),false)) {
+                crnCommand.setCommand((short) 1);
+                if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, crnCommand), false)) {
                     log.error("鍫嗗灈鏈哄懡浠ょ敓鎴愬け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", taskWrk.getCrnNo(), JSON.toJSON(crnCommand));
                     throw new CoolException("鍫嗗灈鏈哄懡浠ょ敓鎴愬け璐�");
-                }else{
-                    try{
+                } else {
+                    try {
+                        taskWrkService.updateById(taskWrk);
+                    } catch (Exception e) {
+                        log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", taskWrk.getWrkNo());
+                        log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽紓甯革細" + e);
+                    }
+                    try {
                         HashMap<String, Object> headParam = new HashMap<>();
-                        headParam.put("taskNo",taskWrk.getTaskNo());
-                        headParam.put("status",taskWrk.getStatus());
-                        headParam.put("ioType",taskWrk.getIoType());
-                        headParam.put("barcode",taskWrk.getBarcode());
+                        headParam.put("taskNo", taskWrk.getTaskNo());
+                        headParam.put("status", taskWrk.getStatus());
+                        headParam.put("ioType", taskWrk.getIoType());
+                        headParam.put("barcode", taskWrk.getBarcode());
                         String response;
                         response = new HttpHandler.Builder()
                                 // .setHeaders(headParam)
@@ -561,16 +809,16 @@
                                 .doPost();
                         JSONObject jsonObject = JSON.parseObject(response);
                         apiLogService.save("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms"
-                                ,wmsUrl+taskStatusFeedbackPath
-                                ,null
-                                ,"127.0.0.1"
-                                ,JSON.toJSONString(headParam)
-                                ,response
-                                ,true
+                                , wmsUrl + taskStatusFeedbackPath
+                                , null
+                                , "127.0.0.1"
+                                , JSON.toJSONString(headParam)
+                                , response
+                                , true
                         );
-                    }catch (Exception e){
-                        log.error("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触", taskWrk);
-                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
+                    } catch (Exception e) {
+                        log.error("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触", JSON.toJSONString(taskWrk));
+//                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
                     }
 
                 }
@@ -584,17 +832,17 @@
      * 鍑哄簱  ===>>  搴撲綅鍒板爢鍨涙満绔�
      * 2022-06-09 TQS淇敼锛屾煡璇㈠伐浣滄。LIST锛岄亶鍘嗕笅鍙戯紝闃叉绗竴涓换鍔″牭濉炲嚭搴�
      */
-    public void locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol){
-        List<TaskWrk> taskWrksInitial = taskWrkMapper.selectPakOut(slave.getId(), null);
-        if (taskWrksInitial.size()==0){
+    public void locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol) {
+        List<TaskWrk> taskWrksInitial = taskWrkMapper.selectPakOut(crnProtocol.getLaneNo(), null);
+        if (taskWrksInitial.size() == 0) {
             return;
         }
         for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
-            List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("crn_no", slave.getId()).eq("crn_stn", crnStn.getStaNo()));
-            for (StaDesc staDesc : staDescs){
+            List<StaDesc> staDescs = staDescMapper.selectList(new EntityWrapper<StaDesc>().eq("CRN_NO", crnProtocol.getLaneNo()).eq("CRN_STN", crnStn.getStaNo()));
+            for (StaDesc staDesc : staDescs) {
                 // 鑾峰彇宸ヤ綔鐘舵�佷负11锛堢敓鎴愬嚭搴揑D锛夌殑鍑哄簱宸ヤ綔妗�
-                List<TaskWrk> taskWrks = taskWrkMapper.selectPakOut(slave.getId(),staDesc.getStnNo().toString());
-                for (TaskWrk taskWrk : taskWrks){
+                List<TaskWrk> taskWrks = taskWrkMapper.selectPakOut(crnProtocol.getLaneNo(), staDesc.getStnNo().toString());
+                for (TaskWrk taskWrk : taskWrks) {
                     if (taskWrk == null) {
                         continue;
                     }
@@ -620,7 +868,7 @@
                     }
 
                     // 鍒ゆ柇鍫嗗灈鏈哄嚭搴撶珯鐘舵��
-                    if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() !=null && staDetl.getCanouting().equals("Y")
+                    if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
                             && staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {
                         // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
 
@@ -630,21 +878,13 @@
                         }
 
                         // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-                        if (taskWrkMapper.selectCrnWorking(slave.getId()) != null) {
+                        if (taskWrkMapper.selectCrnWorking(crnProtocol.getLaneNo()) != null) {
                             break;
                         }
 
-
-                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
-                        Date now = new Date();
-                        taskWrk.setWrkSts(12);
-                        taskWrk.setStatus(2);
-                        taskWrk.setModiTime(now);
-                        if (taskWrkMapper.updateById(taskWrk) == 0) {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", taskWrk.getWrkNo());
-                        }
                         CrnCommand command = new CrnCommand();
-                        command.setCrnNo(taskWrk.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+                        command.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                        command.setLaneNo(crnProtocol.getLaneNo()); // 鍫嗗灈鏈虹紪鍙�
                         command.setTaskNo(taskWrk.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                         command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
                         command.setTaskMode(CrnTaskModeType.PAKIN); // 浠诲姟妯″紡
@@ -654,17 +894,31 @@
                         command.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
                         command.setDestinationPosY(crnStn.getBay().shortValue());     // 鐩爣搴撲綅鍒�
                         command.setDestinationPosZ(crnStn.getLev().shortValue());     // 鐩爣搴撲綅灞�
-                        command.setCommand((short)1);
-                        if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, command),false)) {
-                            log.error("鍫嗗灈鏈哄懡浠ょ敓鎴愬け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", taskWrk.getCrnNo(), JSON.toJSON(command));
+                        command.setCommand((short) 1);
+                        if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, command), false)) {
+                            log.error("鍫嗗灈鏈哄懡浠ょ敓鎴愬け璐ワ紝鍫嗗灈鏈哄彿={}锛屽贩閬�={}锛屼换鍔℃暟鎹�={}", slave.getId(), taskWrk.getCrnNo(), JSON.toJSON(command));
                             throw new CoolException("鍫嗗灈鏈哄懡浠ょ敓鎴愬け璐�");
-                        }else{
-                            try{
+                        } else {
+                            try {
+                                // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
+                                Date now = new Date();
+                                taskWrk.setWrkSts(12);
+                                taskWrk.setStatus(2);
+                                taskWrk.setModiTime(now);
+                                taskWrk.setExecuteTime(now);
+                                if (taskWrkMapper.updateById(taskWrk) == 0) {
+                                    log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", taskWrk.getWrkNo());
+                                }
+                            } catch (Exception e) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", taskWrk.getWrkNo());
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽紓甯革細" + e);
+                            }
+                            try {
                                 HashMap<String, Object> headParam = new HashMap<>();
-                                headParam.put("taskNo",taskWrk.getTaskNo());
-                                headParam.put("status",taskWrk.getStatus());
-                                headParam.put("ioType",taskWrk.getIoType());
-                                headParam.put("barcode",taskWrk.getBarcode());
+                                headParam.put("taskNo", taskWrk.getTaskNo());
+                                headParam.put("status", taskWrk.getStatus());
+                                headParam.put("ioType", taskWrk.getIoType());
+                                headParam.put("barcode", taskWrk.getBarcode());
                                 String response;
                                 response = new HttpHandler.Builder()
                                         // .setHeaders(headParam)
@@ -674,69 +928,19 @@
                                         .build()
                                         .doPost();
                                 JSONObject jsonObject = JSON.parseObject(response);
-                                apiLogService.save("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms"
-                                        ,wmsUrl+taskStatusFeedbackPath
-                                        ,null
-                                        ,"127.0.0.1"
-                                        ,JSON.toJSONString(headParam)
-                                        ,response
-                                        ,true
+                                apiLogService.save("wcs娲惧彂鍑哄簱浠诲姟涓婃姤wms"
+                                        , wmsUrl + taskStatusFeedbackPath
+                                        , null
+                                        , "127.0.0.1"
+                                        , JSON.toJSONString(headParam)
+                                        , response
+                                        , true
                                 );
-                            }catch (Exception e){
-                                log.error("wcs娲惧彂鍑哄簱浠诲姟涓婃姤wms澶辫触", taskWrk);
-                                throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
+                            } catch (Exception e) {
+                                log.error("wcs娲惧彂鍑哄簱浠诲姟涓婃姤wms澶辫触", JSON.toJSONString(taskWrk));
+//                                throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
                             }
-
                         }
-
-//                        // 鍙屾繁搴撲綅涓旀祬搴撲綅鏈夎揣锛屽垯闇�鍏堝娴呭簱浣嶈繘琛屽簱浣嶇Щ杞�
-//                        if (Utils.isDeepLoc(slaveProperties, taskWrk.getStartPoint())) {
-//
-//                            taskWrkMapper.selectPakOutIoType(taskWrk.getCrnNo());
-//
-//                            List<TaskWrk> taskWrks1 = taskWrkMapper.selectPakOutIoType(taskWrk.getCrnNo());
-//                            if (Cools.isEmpty(taskWrks1) && taskWrks1.size()!=0){
-//                                continue;
-//                            }
-//                            String shallowLocNo = Utils.getShallowLoc(slaveProperties, taskWrk.getStartPoint());
-//                            TaskWrk hallowLocNoTask = taskWrkMapper.selectByStartPoint(shallowLocNo);
-//                            if (!Cools.isEmpty(hallowLocNoTask)){
-//                                continue;
-//                            }
-//                        }
-//
-//                        //鍙栧嚭鍛戒护
-//                        List<CommandInfo> commandInfos = commandInfoService.selectByTaskNo(taskWrk.getTaskNo());
-//                        Integer commandStep = taskWrk.getCommandStep();
-//                        if (commandInfos.isEmpty()) {
-//                            continue;//鍛戒护绌�
-//                        }
-//
-//                        //鍒ゆ柇鏈鍛戒护鏄惁鎵ц
-//                        CommandInfo commandInfo2 = commandInfos.get(commandInfos.size() - 1);
-//                        if (commandInfo2.getCommandStatus() != CommandStatusType.CREATE.id) {
-//                            continue;//鎸囦护宸叉墽琛�
-//                        }
-//
-//                        CommandInfo commandInfo = commandInfos.get(commandStep);
-//                        CommandPackage commandPackage = JSON.parseObject(commandInfo.getCommand(), CommandPackage.class);//鍙栧嚭鍛戒护鎶ユ枃
-//                        CrnCommand crnCommand = JSON.parseObject(commandPackage.getCommand().toString(), CrnCommand.class);
-//
-//                        if (!MessageQueue.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, crnCommand))) {
-//                            log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", taskWrk.getCrnNo(), JSON.toJSON(crnCommand));
-//                        } else {
-//
-//                            //寮�濮嬭繍琛�
-//                            String response = CrnStartRunning(taskWrk);
-//                            JSONObject jsonObject = JSON.parseObject(response);
-//                            if (jsonObject.getInteger("code").equals(200)) {
-//
-//                            }else {
-//                                log.error("鍑哄簱寮�濮嬭繍琛岄�氳澶辫触,"+jsonObject.get("msg"));
-//
-//                            }
-//                        }
-
                     }
                 }
             }
@@ -746,14 +950,16 @@
     /**
      * 搴撲綅绉昏浆
      */
-    public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol){
+    public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol) {
         for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
             // 鑾峰彇宸ヤ綔鐘舵�佷负11锛堢敓鎴愬嚭搴揑D锛夌殑绉诲簱宸ヤ綔妗�
-            List<TaskWrk> taskWrks = taskWrkMapper.selectList(new EntityWrapper<TaskWrk>()
-                    .eq("crn_no",slave.getId())
-                    .eq("wrk_sts",11)
-                    .eq("io_type",3));
-            for (TaskWrk taskWrk : taskWrks){
+            List<TaskWrk> taskWrks = taskWrkMapper.selectList(
+                    new EntityWrapper<TaskWrk>()
+                            .eq("CRN_NO", crnProtocol.getLaneNo())
+                            .eq("WRK_STS", 11)
+                            .eq("IO_TYPE", 3)
+                            .orderBy("IO_PRI", false));
+            for (TaskWrk taskWrk : taskWrks) {
 
                 // 鍙屾繁搴撲綅涓旀祬搴撲綅鏈夎揣锛屽垯闇�鍏堝娴呭簱浣嶈繘琛屽簱浣嶇Щ杞�
 //                if (Utils.isDeepLoc(slaveProperties, taskWrk.getStartPoint())) {
@@ -769,7 +975,7 @@
                 }
 
                 // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-                if (taskWrkMapper.selectCrnWorking(slave.getId()) != null) {
+                if (taskWrkMapper.selectCrnWorking(crnProtocol.getLaneNo()) != null) {
                     continue;
                 }
 
@@ -785,11 +991,10 @@
                 // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
 
 
-
-
                 // 1.鍫嗗灈鏈哄紑濮嬬Щ鍔�
                 CrnCommand crnCommand = new CrnCommand();
                 crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                crnCommand.setLaneNo(crnProtocol.getLaneNo()); // 鍫嗗灈鏈虹紪鍙�
                 crnCommand.setTaskNo(taskWrk.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                 crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
                 crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
@@ -800,7 +1005,7 @@
                 crnCommand.setDestinationPosY(Utils.getBayShort(taskWrk.getTargetPoint()));     // 鐩爣搴撲綅鍒�
                 crnCommand.setDestinationPosZ(Utils.getLevShort(taskWrk.getTargetPoint()));     // 鐩爣搴撲綅灞�
                 crnCommand.setCommand((short) 1);
-                if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, crnCommand),false)) {
+                if (!CommandUtils.offer(SlaveType.Crn, taskWrk.getCrnNo(), new Task(2, crnCommand), false)) {
                     log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", taskWrk.getCrnNo(), JSON.toJSON(crnCommand));
                 } else {
                     // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
@@ -808,15 +1013,16 @@
                     taskWrk.setWrkSts(12);
                     taskWrk.setStatus(2);
                     taskWrk.setModiTime(now);
+                    taskWrk.setExecuteTime(now);
                     if (taskWrkMapper.updateById(taskWrk) == 0) {
                         log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", taskWrk.getWrkNo());
                     }
-                    try{
+                    try {
                         HashMap<String, Object> headParam = new HashMap<>();
-                        headParam.put("taskNo",taskWrk.getTaskNo());
-                        headParam.put("status",taskWrk.getStatus());
-                        headParam.put("ioType",taskWrk.getIoType());
-                        headParam.put("barcode",taskWrk.getBarcode());
+                        headParam.put("taskNo", taskWrk.getTaskNo());
+                        headParam.put("status", taskWrk.getStatus());
+                        headParam.put("ioType", taskWrk.getIoType());
+                        headParam.put("barcode", taskWrk.getBarcode());
                         String response;
                         response = new HttpHandler.Builder()
                                 // .setHeaders(headParam)
@@ -827,16 +1033,16 @@
                                 .doPost();
                         JSONObject jsonObject = JSON.parseObject(response);
                         apiLogService.save("wcs娲惧彂绉诲簱浠诲姟涓婃姤wms"
-                                ,wmsUrl+taskStatusFeedbackPath
-                                ,null
-                                ,"127.0.0.1"
-                                ,JSON.toJSONString(headParam)
-                                ,response
-                                ,true
+                                , wmsUrl + taskStatusFeedbackPath
+                                , null
+                                , "127.0.0.1"
+                                , JSON.toJSONString(headParam)
+                                , response
+                                , true
                         );
-                    }catch (Exception e){
-                        log.error("wcs娲惧彂鍑哄簱浠诲姟涓婃姤wms澶辫触", taskWrk);
-                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
+                    } catch (Exception e) {
+                        log.error("wcs娲惧彂绉诲簱搴撲换鍔′笂鎶ms澶辫触", taskWrk);
+//                        throw new CoolException("wcs娲惧彂绉诲簱搴撲换鍔′笂鎶ms澶辫触");
                     }
 
                 }
@@ -849,124 +1055,91 @@
     /**
      * 鎵ц瀵瑰伐浣滄。鐨勫畬鎴愭搷浣�
      */
-//    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("鍫嗗灈鏈哄浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵�侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�傚爢鍨涙満鍙�={}锛屽伐浣滃彿={}", 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()) {
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
             CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
             CrnProtocol crnProtocol = crnThread.getCrnProtocol();
-            if (crnProtocol == null) { continue; }
+            if (crnProtocol == null) {
+                continue;
+            }
+
+            if (!crn.getId().equals(crnProtocol.getLaneNo())) {
+                for (CrnSlave crnOther : slaveProperties.getCrn()) {
+                    if (crnOther.getId().equals(crnProtocol.getLaneNo())) {
+                        crn.updateCrnInStn(crnOther);
+                    }
+                }
+            }
 
             //  鐘舵�侊細绛夊緟纭 骞朵笖  浠诲姟瀹屾垚浣� = 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) {
-                    log.error("鍫嗗灈鏈哄浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵�侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�傚爢鍨涙満鍙�={}锛屽伐浣滃彿={}", crn.getId(), crnProtocol.getTaskNo());
+                TaskWrk taskWrk = taskWrkMapper.selectCrnNoInWorking(crnProtocol.getLaneNo(), crnProtocol.getTaskNo().intValue());
+                if (Cools.isEmpty(taskWrk) && crnProtocol.getTaskNo() != 999) {
+                    log.error("鍫嗗灈鏈哄浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵�侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�傚爢鍨涙満鍙�={}锛屽贩閬撳彿={}锛屽伐浣滃彿={}", crn.getId(), crnProtocol.getLaneNo(), crnProtocol.getTaskNo());
                     continue;
                 }
                 Thread.sleep(300);
                 //纭瀹屾垚淇″彿
-                CrnOperatorParam crnOperatorParam=new CrnOperatorParam();
+                CrnOperatorParam crnOperatorParam = new CrnOperatorParam();
                 crnOperatorParam.setCrnNo(crn.getId());
+                Date now = new Date();
 
                 crnController.crnTaskComplete(crnOperatorParam);
-                if(!Cools.isEmpty(taskWrk)){
-                    if(taskWrk.getIoType()==1&&taskWrk.getWrkSts()==3){
+                if (!Cools.isEmpty(taskWrk)) {
+                    if (taskWrk.getIoType() == 1 && taskWrk.getWrkSts() == 3) {
                         taskWrk.setWrkSts(4);//鍏ュ簱瀹屾垚
                         taskWrk.setStatus(5);//瀹岀粨
                         //鏇存柊搴撲綅鐘舵��
                         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){
+                    } else if (taskWrk.getIoType() == 2 && taskWrk.getWrkSts() == 12) {
                         taskWrk.setWrkSts(13);//鍑哄簱瀹屾垚
                         taskWrk.setStatus(5);//瀹岀粨
                         //鏇存柊搴撲綅鐘舵��
                         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){
+                    } else if (taskWrk.getIoType() == 3 && taskWrk.getWrkSts() == 12) {
                         taskWrk.setWrkSts(4);//鍏ュ簱瀹屾垚
                         taskWrk.setStatus(5);//瀹岀粨
                         //鏇存柊搴撲綅鐘舵��
                         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);
 
 
-                    try{
+                    try {
                         HashMap<String, Object> headParam = new HashMap<>();
-                        headParam.put("taskNo",taskWrk.getTaskNo());
-                        headParam.put("status",taskWrk.getStatus());
-                        headParam.put("ioType",taskWrk.getIoType());
-                        headParam.put("barcode",taskWrk.getBarcode());
+                        headParam.put("taskNo", taskWrk.getTaskNo());
+                        headParam.put("status", taskWrk.getStatus());
+                        headParam.put("ioType", taskWrk.getIoType());
+                        headParam.put("barcode", taskWrk.getBarcode());
                         String response;
+                        log.error("wcs瀹岀粨浠诲姟涓婃姤wms==銆�", headParam);
+
                         response = new HttpHandler.Builder()
                                 // .setHeaders(headParam)
                                 .setUri(wmsUrl)
@@ -974,18 +1147,23 @@
                                 .setJson(JSON.toJSONString(headParam))
                                 .build()
                                 .doPost();
-                        JSONObject jsonObject = JSON.parseObject(response);
+                        log.error("wcs瀹岀粨浠诲姟涓婃姤wms==銆�", response);
+
+//                        JSONObject jsonObject = JSON.parseObject(response);
+//                        log.error("wcs瀹岀粨浠诲姟涓婃姤wms==銆�", jsonObject);
+
                         apiLogService.save("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms"
-                                ,wmsUrl+taskStatusFeedbackPath
-                                ,null
-                                ,"127.0.0.1"
-                                ,JSON.toJSONString(headParam)
-                                ,response
-                                ,true
+                                , wmsUrl + taskStatusFeedbackPath
+                                , null
+                                , "127.0.0.1"
+                                , JSON.toJSONString(headParam)
+                                , response
+                                , true
                         );
-                    }catch (Exception e){
+                    } catch (Exception e) {
                         log.error("wcs瀹岀粨浠诲姟涓婃姤wms澶辫触", taskWrk);
-                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
+                        log.error("wcs瀹岀粨浠诲姟涓婃姤wms澶辫触,鎶ラ敊淇℃伅锛�", e);
+//                        throw new CoolException("wcs娲惧彂鍏ュ簱浠诲姟涓婃姤wms澶辫触");
                     }
                 }
 
@@ -996,7 +1174,7 @@
     /**
      * 鍫嗗灈鏈哄紓甯镐俊鎭褰�
      */
-    public void recCrnErr(){
+    public void recCrnErr() {
         Date now = new Date();
         for (CrnSlave crn : slaveProperties.getCrn()) {
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
@@ -1018,7 +1196,7 @@
                                 continue;
                             }
                             BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm());
-                            String errName = crnError==null? String.valueOf(crnProtocol.getAlarm()):crnError.getErrName();
+                            String errName = crnError == null ? String.valueOf(crnProtocol.getAlarm()) : crnError.getErrName();
                             BasErrLog basErrLog = new BasErrLog(
                                     null,    // 缂栧彿
                                     wrkMast.getWrkNo(),    // 宸ヤ綔鍙�
@@ -1033,7 +1211,7 @@
                                     wrkMast.getSourceStaNo(),    // 婧愮珯
                                     wrkMast.getSourceLocNo(),    // 婧愬簱浣�
                                     wrkMast.getBarcode(),    // 鏉$爜
-                                    (int) crnProtocol.getAlarm1(),    // 寮傚父鐮�
+                                    (int) crnProtocol.getAlarm(),    // 寮傚父鐮�
                                     errName,    // 寮傚父
                                     1,    // 寮傚父鎯呭喌
                                     now,    // 娣诲姞鏃堕棿
@@ -1048,7 +1226,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);
@@ -1061,11 +1239,11 @@
                 } 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());
-                            String errName = crnError==null? String.valueOf(crnProtocol.getAlarm()):crnError.getErrName();
+                            String errName = crnError == null ? String.valueOf(crnProtocol.getAlarm()) : crnError.getErrName();
                             BasErrLog basErrLog = new BasErrLog(
                                     null,    // 缂栧彿
                                     null,    // 宸ヤ綔鍙�
@@ -1080,7 +1258,7 @@
                                     null,    // 婧愮珯
                                     null,    // 婧愬簱浣�
                                     null,    // 鏉$爜
-                                    (int)crnProtocol.getAlarm1(),    // 寮傚父鐮�
+                                    (int) crnProtocol.getAlarm(),    // 寮傚父鐮�
                                     errName,    // 寮傚父
                                     1,    // 寮傚父鎯呭喌
                                     now,    // 娣诲姞鏃堕棿
@@ -1111,178 +1289,9 @@
         }
     }
 
-    //鑷姩娲惧彂浠诲姟
-    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<>());
-        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));
-                }
-                if (basDevp.getAgvTargetPlace()!=0){
-                    basDevp.setAgvStartPlace(0);
-                    basDevpService.updateById(basDevp);
-                }
-            }else {
-                if (basDevp.getAgvTargetPlace()!=0){
-                    staProtocol.setAgvTypeSign((short)1);
-                    staProtocol.setStaNo(basDevp.getDevNo().shortValue());
-                    MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol));
-                }
-                if (basDevp.getAgvTargetPick()!=0){
-                    basDevp.setAgvStartPick(0);
-                    basDevpService.updateById(basDevp);
-                }
-            }
-        }
-    }
-    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){
+    private TaskWrk createTask(GetWmsDto dto, String barcode) {
         String wcsLocNo = dto.getLocNo();
-        if(Cools.isEmpty(wcsLocNo)){
+        if (Cools.isEmpty(wcsLocNo)) {
             return null;
         }
         Date now = new Date();
@@ -1292,6 +1301,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);//鏉$爜
@@ -1299,28 +1311,450 @@
         taskWrk.setCrnNo(locMast.getCrnNo());
         taskWrk.setTargetPoint(wcsLocNo);
         taskWrk.setStartPoint(dto.getStaNo().toString());
-        if(taskWrk.getIoType() == 1){
+        if (taskWrk.getIoType() == 1) {
             taskWrk.setWrkSts(2);
             if (!Cools.isEmpty(taskWrk.getTargetPoint())) {
                 taskWrk.setOriginTargetPoint(taskWrk.getTargetPoint());
             }
-
-//        } else if (param.getIoType() == 2) {
-//            taskWrk.setWrkSts(11);
-//            if (!Cools.isEmpty(param.getStartPoint())) {
-//                taskWrk.setStartPoint(Utils.getWcsLocNo(param.getStartPoint()));//璧风偣
-//                taskWrk.setOriginStartPoint(param.getStartPoint());
-//            }
-//            taskWrk.setTargetPoint(param.getTargetPoint());
-//        }else if (param.getIoType() == 3){
-//            taskWrk.setWrkSts(11);
-//            if (!Cools.isEmpty(param.getStartPoint())) {
-//                taskWrk.setStartPoint(param.getStartPoint());//璧风偣
-//                taskWrk.setOriginStartPoint(param.getStartPoint());
-//            }
         }
         return taskWrk;
     }
 
+    public String rgvOtherTaskWrk(RgvSlave slave) {
+
+        RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, slave.getOtherId());
+        TaskProtocolCache taskProtocolCache = rgvThread.getTaskProtocolCache();
+        ConcurrentHashMap<String, TaskProtocol> allTaskProtocol = taskProtocolCache.getAllTaskProtocol();
+        if (!allTaskProtocol.isEmpty()) {
+            for (TaskProtocol taskProtocol : allTaskProtocol.values()) {
+                if (taskProtocol.getTaskNo() != 0) {
+                    return taskProtocol.getTaskNo().toString();
+                }
+            }
+        }
+        return "鏃�";
+
+    }
+
+    public boolean rgvDetection(RgvSlave slave) {
+        RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId());
+        RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId());
+
+        if (rgvProtocol == null || rgvTaskProtocol == null) {
+            return false;
+        }
+        if (!rgvProtocol.getModeType().equals(RgvModeType.AUTO) || rgvProtocol.getRgvPos().equals(0L) || rgvTaskProtocol.getAvoid() == -1 || rgvProtocol.getRgvPosDestination() == 0L
+                || (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE) && !rgvProtocol.getStatusType().equals(RgvStatusType.ROAM))) {
+            return false;
+        }
+        RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId());
+        RgvTaskProtocol rgvTaskProtocolOther = RgvTaskCache.getRgvStatus(slave.getOtherId());
+
+        if (rgvProtocolOther == null) {
+            return false;
+        }
+        if (rgvProtocolOther.statusEnable) {
+            if (!rgvProtocolOther.getModeType().equals(RgvModeType.AUTO) || rgvProtocolOther.getRgvPos().equals(0L) || rgvTaskProtocolOther.getAvoid() == -1 || rgvProtocolOther.getRgvPosDestination() == 0L) {
+                return false;
+            }
+        }
+        return true;
+    }
+
+    public TaskWrk deviceDetection(RgvSlave.RgvStn inSta) {
+
+        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, inSta.getDevpPlcId());
+        StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
+        if (staProtocol == null) {
+            return null;
+        }
+        // 鍒ゆ柇鏄惁婊¤冻鍙栬揣鏉′欢
+        if (staProtocol.isAutoing()
+//                && staProtocol.isLoading()
+                && staProtocol.getWorkNo() != 0) {
+            TaskWrk taskWrk = taskWrkService.selectByTaskNo(staProtocol.getWorkNo().toString());
+            if (taskWrk != null) {
+                return taskWrk;
+            }
+        }
+        return null;
+    }
+
+    public boolean rgvOtherStatusEnable(RgvSlave slave) {
+        RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId());
+        if (rgvProtocolOther == null) {
+            return true;
+        }
+        if (rgvProtocolOther.statusEnable) {
+//            if (!rgvProtocolOther.getModeType().equals(RgvModeType.AUTO) || rgvProtocolOther.getRgvPos().equals(0L)) {
+            return true;
+//            }
+        }
+        return false;
+    }
+
+    public synchronized void taskStart() {
+        for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
+            try {
+                if (rgvDetection(rgvSlave)) {
+                    String taskNoNow = rgvOtherTaskWrk(rgvSlave);
+                    List<BasDevpPosition> basDevpPositions = basDevpPositionService.selectList(new EntityWrapper<BasDevpPosition>().orderBy("PLC_POSITION", true));
+                    boolean itSmall = new TrackRangeUtils().IsItSmall(rgvSlave);
+                    if (basDevpPositions.isEmpty()) {
+                        log.error("鑾峰彇鎵�鏈夌珯鐐逛俊鎭紓甯�");
+                        continue;
+                    }
+                    List<TaskWrk> taskWrkList = new ArrayList<>();
+                    List<Integer> staList = new ArrayList<>();
+                    for (RgvSlave.RgvStn inSta : rgvSlave.getRgvInSta()) {
+                        TaskWrk taskWrk = deviceDetection(inSta);
+                        if (taskWrk != null) {
+                            if (taskWrk.getTaskNo().equals(taskNoNow)) continue;
+                            taskWrkList.add(taskWrk);
+                            staList.add(inSta.getStaNo());
+                        }
+                    }
+
+                    if (taskWrkList.isEmpty() || staList.isEmpty()) continue;
+
+                    boolean sign = false;
+
+                    if (rgvOtherStatusEnable(rgvSlave)) {
+                        //鍒嗘垚涓婁笅涓ら儴鍒嗕换鍔�
+                        List<Integer>[] avoidRange = RouteUtils.gradeRange(staList, basDevpPositions, itSmall);
+                        List<Integer> rangeListSou = avoidRange[itSmall ? 0 : 1];
+                        List<Integer> rangeListSouOther = avoidRange[itSmall ? 1 : 0];
+                        //灏辫繎鎺掑簭
+                        RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(rgvSlave.getId());
+                        List<Integer> rangeList = RouteUtils.SortNearby(rangeListSou, rgvProtocol.RgvPos, basDevpPositions);
+                        List<Integer> rangeListOther = RouteUtils.SortNearby(rangeListSouOther, rgvProtocol.RgvPos, basDevpPositions);
+
+                        //鎵�灞為儴鍒嗗氨杩涘彇璐�
+
+                        //绛涢�夎寖鍥村唴浠诲姟
+                        //灏辫繎鎺掑簭
+                        //绛涢�夊湪鑼冨洿浠诲姟
+                        Long[][] avoidedRange = new TrackRangeUtils().avoidRangeArr(rgvSlave, trackEntireLength, trackBenchmark, avoidDistance);
+                        List<Integer> belongToRange = RouteUtils.SortNearby(RouteUtils.belongToRange(rangeList, avoidedRange[0], basDevpPositions), rgvProtocol.RgvPos, basDevpPositions);
+
+                        for (Integer staNoNow : belongToRange) {
+                            for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                if (rgvStn.getStaNo().equals(staNoNow)) {
+                                    TaskWrk taskWrk = deviceDetection(rgvStn);
+                                    if (taskWrk != null) {
+                                        BasDevpPosition basDevpPosition = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("DEV_NO", taskWrk.getTargetPointConvert()));
+                                        if (RouteUtils.CheckIfItIsWithinTheRange(rangeList, basDevpPosition.getPlcPosition(), basDevpPositions, itSmall)) {
+                                            sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                        }
+                                    }
+                                    break;
+                                }
+                            }
+                            if (sign) {
+                                break;
+                            }
+                        }
+                        if (!sign) {
+                            //  绛涢�夎寖鍥村唴鍙栬揣浠诲姟
+                            for (Integer staNoNow : belongToRange) {
+                                for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                    if (rgvStn.getStaNo().equals(staNoNow)) {
+                                        sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                        break;
+                                    }
+                                }
+                                if (sign) {
+                                    break;
+                                }
+                            }
+                        }
+
+                        if (!sign) {
+                            for (Integer staNoNow : rangeList) {
+                                for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                    if (rgvStn.getStaNo().equals(staNoNow)) {
+                                        TaskWrk taskWrk = deviceDetection(rgvStn);
+                                        if (taskWrk != null) {
+                                            BasDevpPosition basDevpPosition = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("DEV_NO", taskWrk.getTargetPointConvert()));
+                                            if (RouteUtils.CheckIfItIsWithinTheRange(rangeList, basDevpPosition.getPlcPosition(), basDevpPositions, itSmall)) {
+                                                sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                            }
+                                        }
+                                        break;
+                                    }
+                                }
+                                if (sign) {
+                                    break;
+                                }
+                            }
+                        }
+                        if (!sign) {
+                            //  鍗婅竟鍖哄煙鍐呭彇璐т换鍔�
+                            for (Integer staNoNow : rangeList) {
+                                for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                    if (rgvStn.getStaNo().equals(staNoNow)) {
+                                        sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                        break;
+                                    }
+                                }
+                                if (sign) {
+                                    break;
+                                }
+                            }
+                        }
+                        if (!sign) {
+                            //  鍗婅竟鍖哄煙鍐呮斁璐т换鍔�
+                            for (Integer staNoNow : rangeListOther) {
+                                for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                    if (rgvStn.getStaNo().equals(staNoNow)) {
+                                        TaskWrk taskWrk = deviceDetection(rgvStn);
+                                        if (taskWrk != null) {
+                                            BasDevpPosition basDevpPosition = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("DEV_NO", taskWrk.getTargetPointConvert()));
+                                            if (RouteUtils.CheckIfItIsWithinTheRange(rangeList, basDevpPosition.getPlcPosition(), basDevpPositions, itSmall)) {
+                                                sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                            }
+                                        }
+                                        break;
+                                    }
+                                }
+                                if (sign) {
+                                    break;
+                                }
+                            }
+                        }
+                    } else {
+                        //鍙敤鍖哄煙灏辫繎鍙栬揣
+                        //灏辫繎鎺掑簭
+                        RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(rgvSlave.getId());
+                        List<Integer> rangeList = RouteUtils.SortNearby(staList, rgvProtocol.RgvPos, basDevpPositions);
+                        //  鍗婅竟鍖哄煙鍐呭彇璐т换鍔�
+                        for (Integer staNoNow : rangeList) {
+                            for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+                                if (rgvStn.getStaNo().equals(staNoNow)) {
+                                    sign = taskGenerate(rgvSlave, rgvStn, 0);
+                                    break;
+                                }
+                            }
+                            if (sign) {
+                                break;
+                            }
+                        }
+                    }
+                }
+            } catch (Exception e) {
+                log.error("浠诲姟鐢熸垚澶辫触===銆嬪紓甯镐俊鎭細{}", e.getMessage());
+            }
+        }
+    }
+
+    //鑾峰彇璧风偣涓庣粓鐐瑰璞�
+    public RgvSlave.RgvStn getRgvStnNow(RgvSlave rgvSlave, Integer staNo) {
+        for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+            if (rgvStn.getStaNo().equals(staNo)) {
+                return rgvStn;
+            }
+        }
+        for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvOutSta()) {
+            if (rgvStn.getStaNo().equals(staNo)) {
+                return rgvStn;
+            }
+        }
+        return null;
+    }
+
+    //鑾峰彇璧风偣涓庣粓鐐瑰璞�
+    public RgvSlave.RgvStn[] getRgvStnAll(RgvSlave rgvSlave, Integer souSta, Integer endSta) {
+        RgvSlave.RgvStn[] rgvStns = new RgvSlave.RgvStn[2];
+        for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvInSta()) {
+            if (rgvStn.getStaNo().equals(souSta)) {
+                rgvStns[0] = rgvStn;
+            }
+        }
+        for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvOutSta()) {
+            if (rgvStn.getStaNo().equals(endSta)) {
+                rgvStns[1] = rgvStn;
+            }
+        }
+        return rgvStns;
+    }
+
+    public boolean taskGenerate(RgvSlave rgvSlave, RgvSlave.RgvStn rgvStn, Integer sign) {
+        try {
+            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
+            TaskProtocolCache taskProtocolCache = rgvThread.getTaskProtocolCache();
+
+            TaskProtocol issuedTake = new TaskProtocol();
+            TaskProtocol issuedPut = new TaskProtocol();
+            try {
+                ConcurrentHashMap<String, TaskProtocol> allTaskProtocol = taskProtocolCache.getAllTaskProtocol();
+                if (allTaskProtocol.size() > 0) {
+                    return false;
+                }
+                TaskWrk taskWrk = deviceDetection(rgvStn);
+                if (taskWrk == null) {
+                    return false;
+                }
+                Integer targetPointConvert = taskWrk.getTargetPointConvert();
+                if (targetPointConvert == null) {
+                    return false;
+                }
+                RgvSlave.RgvStn rgvStnEnd = getRgvStnNow(rgvSlave, targetPointConvert);
+                if (rgvStnEnd == null) {
+                    return false;
+                }
+
+                BasDevpPosition basDevpPositionSou = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("DEV_NO", rgvStn.getStaNo()));
+                BasDevpPosition basDevpPositionEnd = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("DEV_NO", targetPointConvert));
+                //鎵ц
+                issuedTake.setTaskNo(Long.valueOf(taskWrk.getTaskNo()));
+                issuedTake.setTaskStatus(1);
+                issuedTake.setTaskNoDirection(issuedTake.gettaskNoDirection$(issuedTake.getTaskNo(), issuedTake.getTaskStatus()));
+                issuedTake.setTargetPosition(basDevpPositionSou.getPlcPosition());
+                issuedTake.setIsRunning(1);
+                issuedTake.setDirection(rgvStn.isDirection());
+
+
+                issuedPut.setTaskNo(Long.valueOf(taskWrk.getTaskNo()));
+                issuedPut.setTaskStatus(2);
+                issuedPut.setTaskNoDirection(issuedPut.gettaskNoDirection$(issuedPut.getTaskNo(), issuedPut.getTaskStatus()));
+                issuedPut.setTargetPosition(basDevpPositionEnd.getPlcPosition());
+                issuedPut.setIsRunning(1);
+                issuedPut.setDirection(rgvStnEnd.isDirection());
+            } catch (Exception e) {
+                log.error("浠诲姟鐢熸垚澶辫触issued1===銆嬪紓甯镐俊鎭細{}", e.getMessage());
+                return false;
+            }
+
+            switch (sign) {
+                case 1:
+                    taskProtocolCache.updateTaskProtocol(issuedTake);
+                    break;
+                case 2:
+                    taskProtocolCache.updateTaskProtocol(issuedPut);
+                    break;
+                default:
+                    taskProtocolCache.updateTaskProtocol(issuedTake);
+                    taskProtocolCache.updateTaskProtocol(issuedPut);
+                    break;
+            }
+        } catch (Exception e) {
+            log.error("浠诲姟鐢熸垚澶辫触issued2===銆嬪紓甯镐俊鎭細{}", e.getMessage());
+        }
+        return true;
+    }
+
+    /**
+     * 鍑哄簱  ===>> 宸ヤ綔妗d俊鎭啓鍏ed鏄剧ず鍣�
+     */
+    public synchronized void ledExecute(Integer mark) {
+
+        for (LedSlave led : slaveProperties.getLed()) {
+            // 鑾峰彇杈撻�佺嚎plc绾跨▼
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
+            // 鍛戒护闆嗗悎
+            List<LedCommand> commands = new ArrayList<>();
+            // 宸ヤ綔妗i泦鍚�
+            List<WrkMast> wrkMasts = new ArrayList<>();
+            for (Integer staNo : led.getStaArr()) {
+                // 鑾峰彇鍙夎溅绔欑偣
+                StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                if (null == staProtocol || null == staProtocol.getWorkNo() || 0 == staProtocol.getWorkNo() || !staProtocol.isLoading()) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                // 鑾峰彇宸ヤ綔妗f暟鎹�
+                LedCommand ledCommand = new LedCommand();
+
+//
+//                ledCommand.setWorkNo(wrkMast.getWrkNo());
+//                ledCommand.setIoType(wrkMast.getIoType());
+//                ledCommand.setTitle("绌烘澘鍑哄簱");
+//                ledCommand.setEmptyMk(true);
+//                ledCommand.setSourceLocNo(wrkMast.getSourceLocNo());
+//                ledCommand.setLocNo(wrkMast.getLocNo());
+//                ledCommand.setStaNo(wrkMast.getStaNo());
+                MatDto matDto = new MatDto();
+                ledCommand.getMatDtos().add(matDto);
+                commands.add(ledCommand);
+            }
+            Set<Integer> workNos = wrkMasts.stream().map(WrkMast::getWrkNo).collect(Collectors.toSet());
+            // 鑾峰彇LED绾跨▼
+            LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
+            // 鐩稿悓宸ヤ綔鍙烽泦鍚堝垯杩囨护
+            if (CollectionUtils.equals(ledThread.getWorkNos(), workNos)) {
+                continue;
+            }
+            // 鍛戒护涓嬪彂 -------------------------------------------------------------------------------
+            if (!commands.isEmpty()) {
+                if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(3, commands))) {
+//                    News.error("{}鍙稬ED鍛戒护涓嬪彂澶辫触锛侊紒锛乕ip锛歿}] [port锛歿}]", led.getId(), led.getIp(), led.getPort());
+                    continue;
+                }else {
+                    ledThread.setLedMk(false);
+                }
+            }
+
+            try {
+                // 淇敼涓绘。led鏍囪
+                for (WrkMast wrkMast : wrkMasts) {
+                    wrkMast.setOveMk("Y");
+                    wrkMast.setModiTime(new Date());
+                    if (wrkMastMapper.updateById(wrkMast) == 0) {
+//                        News.errorNoLog(""+mark+" - 4"+" - 鏇存柊宸ヤ綔妗eけ璐�");
+                        throw new CoolException("鏇存柊宸ヤ綔妗eけ璐�");
+                    }
+                }
+
+                // 鏇存柊绾跨▼褰撳墠宸ヤ綔鍙烽泦鍚�
+                ledThread.setWorkNos(workNos);
+
+            } catch (Exception e) {
+                e.printStackTrace();
+                TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+            }
+
+        }
+//        News.infoNoLog(""+mark+" - 0"+" - 鍑哄簱  ===>> 宸ヤ綔妗d俊鎭啓鍏ed鏄剧ず鍣ㄦ墽琛屽畬鎴�");
+    }
+
+    /**
+     * 鍏朵粬  ===>> LED鏄剧ず鍣ㄥ浣嶏紝鏄剧ず榛樿淇℃伅
+     */
+    public synchronized void ledReset(Integer mark) {
+
+//        News.warnNoLog(""+mark+" - 0"+" - 寮�濮嬫墽琛�:鍏朵粬  ===>> LED鏄剧ず鍣ㄥ浣嶏紝鏄剧ず榛樿淇℃伅");
+        for (LedSlave led : slaveProperties.getLed()) {
+
+            // 鑾峰彇杈撻�佺嚎plc绾跨▼
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
+            // 鍛戒护闆嗗悎
+            boolean reset = true;
+            for (Integer staNo : led.getStaArr()) {
+                // 鑾峰彇鍙夎溅绔欑偣
+                StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                if (staProtocol == null) {
+                    continue;
+                }
+                if (staProtocol.getWorkNo() != 0 && staProtocol.isLoading()) {
+                    reset = false;
+                    break;
+                }
+            }
+            // 鑾峰彇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<>()))) {
+//                    News.error(""+mark+" - 1"+" - {}鍙稬ED鍛戒护涓嬪彂澶辫触锛侊紒锛乕ip锛歿}] [port锛歿}]", led.getId(), led.getIp(), led.getPort());
+                } else {
+
+                }
+            }
+        }
+//        News.infoNoLog(""+mark+" - 0"+" - 鎵ц瀹屾垚锛氬叾浠�  ===>> LED鏄剧ず鍣ㄥ浣嶏紝鏄剧ず榛樿淇℃伅");
+    }
+
 
 }

--
Gitblit v1.9.1