From b53dff5d5ee6ab0d4ab138e14be643843869d00d Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期一, 23 十一月 2020 11:12:28 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/controller/CrnController.java |  348 +++++++++++++++++++++++++++++++++++++++++++++++++--------
 1 files changed, 296 insertions(+), 52 deletions(-)

diff --git a/src/main/java/com/zy/asrs/controller/CrnController.java b/src/main/java/com/zy/asrs/controller/CrnController.java
index f4914b9..75e0789 100644
--- a/src/main/java/com/zy/asrs/controller/CrnController.java
+++ b/src/main/java/com/zy/asrs/controller/CrnController.java
@@ -1,26 +1,38 @@
 package com.zy.asrs.controller;
 
 import com.alibaba.fastjson.JSON;
+import com.baomidou.mybatisplus.mapper.EntityWrapper;
 import com.core.annotations.ManagerAuth;
+import com.core.common.Cools;
 import com.core.common.R;
+import com.core.exception.CoolException;
 import com.zy.asrs.domain.enums.CrnStatusType;
+import com.zy.asrs.domain.param.CrnDemoParam;
 import com.zy.asrs.domain.param.CrnOperatorParam;
 import com.zy.asrs.domain.vo.CommandLogVo;
 import com.zy.asrs.domain.vo.CrnMsgTableVo;
 import com.zy.asrs.domain.vo.CrnStateTableVo;
+import com.zy.asrs.entity.BasCrnError;
+import com.zy.asrs.entity.BasCrnp;
 import com.zy.asrs.entity.WrkMast;
+import com.zy.asrs.mapper.BasCrnErrorMapper;
+import com.zy.asrs.service.BasCrnpService;
 import com.zy.asrs.service.WrkMastService;
+import com.zy.asrs.service.impl.MainServiceImpl;
+import com.zy.core.CrnThread;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.OutputQueue;
 import com.zy.core.cache.SlaveConnection;
+import com.zy.core.enums.CrnLiftPosType;
 import com.zy.core.enums.CrnModeType;
+import com.zy.core.enums.CrnTaskModeType;
 import com.zy.core.enums.SlaveType;
 import com.zy.core.model.CrnSlave;
 import com.zy.core.model.Task;
 import com.zy.core.model.command.CrnCommand;
 import com.zy.core.model.protocol.CrnProtocol;
 import com.zy.core.properties.SlaveProperties;
-import com.zy.core.thread.CrnThread;
+import com.zy.core.properties.SystemProperties;
 import lombok.extern.slf4j.Slf4j;
 import org.springframework.beans.factory.annotation.Autowired;
 import org.springframework.web.bind.annotation.PostMapping;
@@ -29,7 +41,6 @@
 
 import java.util.ArrayList;
 import java.util.List;
-import java.util.concurrent.atomic.AtomicInteger;
 
 /**
  * 鍫嗗灈鏈烘帴鍙�
@@ -39,11 +50,18 @@
 @RestController
 @RequestMapping("/crn")
 public class CrnController {
-    private static AtomicInteger integer = new AtomicInteger();
+
     @Autowired
     private SlaveProperties slaveProperties;
     @Autowired
     private WrkMastService wrkMastService;
+    @Autowired
+    private BasCrnErrorMapper basCrnErrorMapper;
+    @Autowired
+    private BasCrnpService basCrnpService;
+    @Autowired
+    private MainServiceImpl mainService;
+
 
     @ManagerAuth(memo = "杩涜涓殑鍛戒护")
     @PostMapping("/command/ongoing")
@@ -76,21 +94,21 @@
     @ManagerAuth(memo = "鍫嗗灈鏈轰俊鎭〃")
     public R crnStateTable(){
         List<CrnStateTableVo> list = new ArrayList<>();
-        for (CrnSlave crn : slaveProperties.getCrn()) {
+        List<BasCrnp> crnps = basCrnpService.selectList(new EntityWrapper<BasCrnp>().orderBy("crn_no"));
+        for (BasCrnp basCrnp : crnps) {
+            // 琛ㄦ牸琛�
+            CrnStateTableVo vo = new CrnStateTableVo();
+            vo.setCrnNo(basCrnp.getCrnNo());   //  鍫嗗灈鏈哄彿
+            list.add(vo);
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
-            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
+            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, basCrnp.getCrnNo());
             if (crnThread == null) {
-                log.error("{}鍙峰爢鍨涙満杩炴帴澶辫触", crn.getId());
                 continue;
             }
             CrnProtocol crnProtocol = crnThread.getCrnProtocol();
             if (crnProtocol == null) {
-                log.error("{}鍙峰爢鍨涙満杩炴帴澶辫触", crn.getId());
                 continue;
             }
-            // 琛ㄦ牸琛�
-            CrnStateTableVo vo = new CrnStateTableVo();
-            vo.setCrnNo(crn.getId());   //  鍫嗗灈鏈哄彿
             vo.setWorkNo(crnProtocol.getTaskNo());  //  浠诲姟鍙�
             if (crnProtocol.getTaskNo()>0) {
                 WrkMast wrkMast = wrkMastService.selectById(crnProtocol.getTaskNo());
@@ -98,16 +116,19 @@
                     vo.setStatusType(CrnStatusType.process(wrkMast.getIoType()).getDesc());   //  妯″紡鐘舵��
                 }
             } else {
-                vo.setStatusType(crnProtocol.modeType.equals(CrnModeType.AUTO)? CrnStatusType.AUTO.getDesc(): CrnStatusType.UN_AUTO.getDesc());   //  妯″紡鐘舵��
+                vo.setStatusType(crnProtocol.modeType.equals(CrnModeType.AUTO)? CrnStatusType.MACHINE_AUTO.getDesc(): CrnStatusType.MACHINE_UN_AUTO.getDesc());   //  妯″紡鐘舵��
             }
             vo.setStatus(crnProtocol.getStatusType().desc);     //  鐘舵��
-            vo.setWarn(""); //  鎶ヨ todo
-            vo.setLoading(crnProtocol.getLoaded()==1?"Y":"N");  //  鏈夌墿
+            vo.setLoading(crnProtocol.getLoaded()==1?"鏈夌墿":"鏃犵墿");  //  鏈夌墿
             vo.setBay(crnProtocol.getBay());    //  鍒�
             vo.setLev(crnProtocol.getLevel());  //  灞�
-            vo.setForkOffset(crnProtocol.getForkPosType().desc);    //  璐у弶浣嶇疆
-            vo.setLiftPos(crnProtocol.getLiftPosType().desc);   //  杞借揣鍙颁綅缃�
-            list.add(vo);
+            vo.setXOrigin(crnProtocol.getBay()==1?"鏄�":"鍚�");     //  璧拌鍘熺偣
+            vo.setYOrigin(crnProtocol.getLevel()==1?"鏄�":"鍚�");     // 鍗囬檷鍘熺偣
+            vo.setForkOffset(crnProtocol.getForkPosType().desc);    // 璐у弶浣嶇疆
+            vo.setXLocation(crnProtocol.getWalkPos() == 1?"鏄�":"鍚�");      // 璧拌瀹氫綅
+            vo.setYLocation(crnProtocol.getLiftPosType().equals(CrnLiftPosType.NONE)?"鍚�":"鏄�");      // 鍗囬檷瀹氫綅
+            vo.setStop(crnProtocol.getCrnError1().controlStop||crnProtocol.getCrnError1().mainStop||crnProtocol.getCrnError1().remoteStop?"鏄�":"鍚�");       //  鎬ュ仠
+            vo.setWarnCode(String.valueOf(crnProtocol.getAlarm1()));  //  寮傚父鐮�
         }
         return R.ok().add(list);
     }
@@ -116,9 +137,14 @@
     @ManagerAuth(memo = "鍫嗗灈鏈烘暟鎹〃")
     public R crnMsgTable(){
         List<CrnMsgTableVo> list = new ArrayList<>();
-        for (CrnSlave crn : slaveProperties.getCrn()) {
+        List<BasCrnp> crnps = basCrnpService.selectList(new EntityWrapper<BasCrnp>().orderBy("crn_no"));
+        for (BasCrnp basCrnp : crnps) {
+            // 琛ㄦ牸琛�
+            CrnMsgTableVo vo = new CrnMsgTableVo();
+            vo.setCrnNo(basCrnp.getCrnNo());   //  鍫嗗灈鏈哄彿
+            list.add(vo);
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
-            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
+            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, basCrnp.getCrnNo());
             if (crnThread == null) {
                 continue;
             }
@@ -126,10 +152,12 @@
             if (crnProtocol == null) {
                 continue;
             }
-            // 琛ㄦ牸琛�
-            CrnMsgTableVo vo = new CrnMsgTableVo();
-            vo.setCrnNo(crn.getId());   //  鍫嗗灈鏈哄彿
+
             vo.setWorkNo(crnProtocol.getTaskNo());  //  浠诲姟鍙�
+            BasCrnError crnError = basCrnErrorMapper.selectById(crnProtocol.getAlarm1());
+            if (null != crnError) {
+                vo.setError(crnError.getErrName());
+            }
             if (crnProtocol.getTaskNo()>0) {
                 WrkMast wrkMast = wrkMastService.selectById(crnProtocol.getTaskNo());
                 if (wrkMast != null) {
@@ -140,10 +168,15 @@
                     vo.setLocNo(wrkMast.getLocNo());    //  鐩爣搴撲綅
                 }
             } else {
-                vo.setStatus(crnProtocol.modeType.equals(CrnModeType.AUTO)? CrnStatusType.AUTO.getDesc(): CrnStatusType.UN_AUTO.getDesc());   //  妯″紡鐘舵��
+                vo.setStatus(crnProtocol.modeType.equals(CrnModeType.AUTO)? CrnStatusType.MACHINE_AUTO.getDesc(): CrnStatusType.MACHINE_UN_AUTO.getDesc());   //  妯″紡鐘舵��
             }
-            list.add(vo);
-
+            vo.setXspeed(crnProtocol.getXSpeed());  //  璧拌閫熷害锛坢/min)
+            vo.setYspeed(crnProtocol.getYSpeed());  //  鍗囬檷閫熷害锛坢/min)
+            vo.setZspeed(crnProtocol.getZSpeed());  //  鍙夌墮閫熷害锛坢/min)
+            vo.setXdistance(crnProtocol.getXDistance());  //  璧拌璺濈(Km)
+            vo.setYdistance(crnProtocol.getYDistance());  //  鍗囬檷璺濈(Km)
+            vo.setXduration(crnProtocol.getXDuration());    //  璧拌鏃堕暱(H)
+            vo.setYduration(crnProtocol.getYDuration());    //  鍗囬檷鏃堕暱(H)
         }
         return R.ok().add(list);
     }
@@ -154,19 +187,30 @@
         StringBuilder str = new StringBuilder();
         String s;
         int i = 0;
-        while( (s = OutputQueue.CRN.poll()) != null && i <=10) {
+        while((s = OutputQueue.CRN.poll()) != null && i <=10) {
             str.append("\n").append(s);
             i++;
         }
-//        str = new StringBuilder("\n" + new Date().toLocaleString() + "銆�2020-5-29 13:14:22銆戞壂鎻弍lcA 鐩爣绔�--273283723728327636432343234323422732837237283276364323432343234227328372372832763643234323432342");
         return R.ok().add(str.toString());
     }
 
-    public static void main(String[] args) {
-        for (int i =0; i<10; i++) {
-
+    @PostMapping("/demo/switch")
+    @ManagerAuth(memo = "鍫嗗灈鏈烘紨绀�")
+    public R crnDemo(CrnDemoParam param) throws InterruptedException {
+        if (Cools.isEmpty(param.getCrnId())){
+            return R.error();
         }
+        if (Cools.isEmpty(param.getPassword())){
+            return R.error("璇疯緭鍏ュ彛浠�");
+        }
+        if (!param.getPassword().equals(SystemProperties.WCS_PASSWORD)){
+            return R.error("鍙d护閿欒");
+        }
+        Thread.sleep(200L);
+        mainService.crnDemoOfLocMove(param.getCrnId());
+        return R.ok();
     }
+
 
     /****************************************************************/
     /************************** 鎵嬪姩鎿嶄綔 ******************************/
@@ -175,61 +219,261 @@
     @ManagerAuth(memo = "鍏ュ簱")
     @PostMapping("/operator/put")
     public R crnPut(CrnOperatorParam param){
-        return R.ok("鍏ュ簱鎴愬姛");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.PAKIN); // 浠诲姟妯″紡
+        command.setSourcePosX(param.getSourceRow());     // 婧愬簱浣嶆帓
+        command.setSourcePosY(param.getSourceBay());     // 婧愬簱浣嶅垪
+        command.setSourcePosZ(param.getSourceLev());     // 婧愬簱浣嶅眰
+        command.setDestinationPosX(param.getRow());     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY(param.getBay());     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ(param.getLev());     // 鐩爣搴撲綅灞�
+        staNoProcess(param, command);
+        return crnControl(command)?R.ok():R.error();
     }
 
     @ManagerAuth(memo = "鍑哄簱")
     @PostMapping("/operator/take")
     public R crnTake(CrnOperatorParam param){
-        return R.ok("鍑哄簱鎴愬姛");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.PAKOUT); // 浠诲姟妯″紡
+        command.setSourcePosX(param.getSourceRow());     // 婧愬簱浣嶆帓
+        command.setSourcePosY(param.getSourceBay());     // 婧愬簱浣嶅垪
+        command.setSourcePosZ(param.getSourceLev());     // 婧愬簱浣嶅眰
+        command.setDestinationPosX(param.getRow());     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY(param.getBay());     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ(param.getLev());     // 鐩爣搴撲綅灞�
+        staNoProcess(param, command);
+        return crnControl(command)?R.ok():R.error();
     }
 
     @ManagerAuth(memo = "搴撲綅杞Щ")
     @PostMapping("/operator/stockMove")
     public R crnStockMove(CrnOperatorParam param){
-        return R.ok("搴撲綅杞Щ鎴愬姛");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡
+        command.setSourcePosX(param.getSourceRow());     // 婧愬簱浣嶆帓
+        command.setSourcePosY(param.getSourceBay());     // 婧愬簱浣嶅垪
+        command.setSourcePosZ(param.getSourceLev());     // 婧愬簱浣嶅眰
+        command.setDestinationPosX(param.getRow());     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY(param.getBay());     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ(param.getLev());     // 鐩爣搴撲綅灞�
+        staNoProcess(param, command);
+        return crnControl(command)?R.ok():R.error();
     }
 
     @ManagerAuth(memo = "绔欏埌绔�")
     @PostMapping("/operator/siteMove")
     public R crnSiteMove(CrnOperatorParam param){
-        return R.ok("绔欏埌绔欐垚鍔�");
-    }
-
-    @ManagerAuth(memo = "鍧愭爣绉诲姩")
-    @PostMapping("/operator/coorMove")
-    public R crnCoorMove(CrnOperatorParam param){
-        return R.ok("鍧愭爣绉诲姩鎴愬姛");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.SITE_MOVE); // 浠诲姟妯″紡
+        command.setSourcePosX(param.getSourceStaNo());     // 婧愬簱浣嶆帓
+        command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+        command.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
+        command.setDestinationPosX(param.getStaNo());     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY((short) 0);     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+        staNoProcess(param, command);
+        return crnControl(command)?R.ok():R.error();
     }
 
     @ManagerAuth(memo = "鍥炲師鐐�")
     @PostMapping("/operator/bacOrigin")
     public R crnBacOrigin(CrnOperatorParam param){
-        return R.ok("鍥炲師鐐规垚鍔�");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡
+        command.setSourcePosX((short) 0);     // 婧愬簱浣嶆帓
+        command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+        command.setSourcePosZ((short) 0);     // 婧愬簱浣嶅眰
+        command.setDestinationPosX((short) 0);     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY((short) 0);     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ((short) 0);     // 鐩爣搴撲綅灞�
+        return crnControl(command)?R.ok():R.error();
+    }
+
+    @ManagerAuth(memo = "鍙嶅師鐐�")
+    @PostMapping("/operator/reverseOrigin")
+    public R reverseOrigin(CrnOperatorParam param){
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡
+        command.setSourcePosX((short) 0);     // 婧愬簱浣嶆帓
+        command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+        command.setSourcePosZ((short) 0);     // 婧愬簱浣嶅眰
+        command.setDestinationPosX((short) 0);     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY((short) 34);     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ((short) 5);     // 鐩爣搴撲綅灞�
+        return crnControl(command)?R.ok():R.error();
+    }
+
+    @ManagerAuth(memo = "鍧愭爣绉诲姩")
+    @PostMapping("/operator/coorMove")
+    public R crnCoorMove(CrnOperatorParam param){
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.OFFSET_MOVE); // 浠诲姟妯″紡
+        command.setSourcePosX(param.getSourceRow());     // 婧愬簱浣嶆帓
+        command.setSourcePosY(param.getSourceBay());     // 婧愬簱浣嶅垪
+        command.setSourcePosZ(param.getSourceLev());     // 婧愬簱浣嶅眰
+        command.setDestinationPosX(param.getRow());     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY(param.getBay());     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ(param.getLev());     // 鐩爣搴撲綅灞�
+        staNoProcess(param, command);
+        return crnControl(command)?R.ok():R.error();
     }
 
     @ManagerAuth(memo = "浠诲姟瀹屾垚")
     @PostMapping("/operator/taskComplete")
     public R crnTaskComplete(CrnOperatorParam param){
-        return R.ok("浠诲姟瀹屾垚");
+        CrnCommand command = new CrnCommand();
+        command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+        command.setTaskNo((short) 0); // 宸ヤ綔鍙�
+        command.setAckFinish((short) 1);  // 浠诲姟瀹屾垚纭浣�
+        command.setTaskMode(CrnTaskModeType.NONE); // 浠诲姟妯″紡
+        command.setSourcePosX((short) 0);     // 婧愬簱浣嶆帓
+        command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+        command.setSourcePosZ((short) 0);     // 婧愬簱浣嶅眰
+        command.setDestinationPosX((short) 0);     // 鐩爣搴撲綅鎺�
+        command.setDestinationPosY((short) 0);     // 鐩爣搴撲綅鍒�
+        command.setDestinationPosZ((short) 0);     // 鐩爣搴撲綅灞�
+        return crnControl(command)?R.ok():R.error();
     }
 
-    @ManagerAuth(memo = "鏆傚仠")
-    @PostMapping("/operator/pause")
-    public R crnPause(CrnOperatorParam param){
-        return R.ok("鏆傚仠鎴愬姛");
-    }
-
-    @ManagerAuth(memo = "鍚姩")
-    @PostMapping("/operator/boot")
-    public R crnBoot(CrnOperatorParam param){
-        return R.ok("鍚姩鎴愬姛");
-    }
+//    @ManagerAuth(memo = "鏆傚仠")
+//    @PostMapping("/operator/pause")
+//    public R crnPause(CrnOperatorParam param){
+//        return R.ok("鏆傚仠鎴愬姛");
+//    }
+//
+//    @ManagerAuth(memo = "鍚姩")
+//    @PostMapping("/operator/boot")
+//    public R crnBoot(CrnOperatorParam param){
+//        return R.ok("鍚姩鎴愬姛");
+//    }
 
     @ManagerAuth(memo = "娓呴櫎鍛戒护")
     @PostMapping("/operator/clearCommand")
     public R crnClearCommand(CrnOperatorParam param){
+        if (param.getCrnNo() == null) {
+            throw new CoolException("璇烽�夋嫨鍫嗗灈鏈�");
+        }
+        MessageQueue.clear(SlaveType.Crn, param.getCrnNo());
         return R.ok("娓呴櫎鍛戒护鎴愬姛");
     }
 
+    @ManagerAuth(memo = "鎵嬪姩澶嶄綅")
+    @PostMapping("/operator/handleReset")
+    public R handleReset(CrnOperatorParam param) throws Exception {
+        if (param.getCrnNo() == null) {
+            throw new CoolException("璇烽�夋嫨鍫嗗灈鏈�");
+        }
+        // 鑾峰彇鍫嗗灈鏈虹紦瀛�
+        for (CrnSlave crn : slaveProperties.getCrn()) {
+            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
+            if (param.getCrnNo().equals(crn.getId())) {
+                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
+                if (crnThread == null) {
+                    throw new CoolException("鍫嗗灈鏈轰笉鍦ㄧ嚎");
+                }
+                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                if (crnProtocol == null) {
+                    throw new CoolException("鍫嗗灈鏈轰笉鍦ㄧ嚎");
+                }
+                // 鍙湁鍑虹幇鎸囧畾寮傚父鎵嶈繘琛屽浣�
+                if (crnProtocol.getCrnError3().leftTakeNoneErr
+                        || crnProtocol.getCrnError3().rightTakeNoneErr
+                        || crnProtocol.getCrnError3().leftTakeThenLoadErr
+                        || crnProtocol.getCrnError3().rightTakeThenLoadErr) {
+                    CrnCommand command = new CrnCommand();
+                    command.setCrnNo(param.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+                    command.setAckFinish((short) 1);  // 浠诲姟瀹屾垚纭浣�
+                    command.setTaskMode(CrnTaskModeType.NONE); // 浠诲姟妯″紡
+                    // 寤舵椂鍙戦��
+                    Thread.sleep(3000L);
+                    if (MessageQueue.offer(SlaveType.Crn, crn.getId(), new Task(2, command))) {
+                        return R.ok();
+                    } else {
+                        throw new CoolException("鍛戒护涓嬪彂澶辫触");
+                    }
+                }
+            }
+        }
+
+        return R.error();
+    }
+
+    private boolean crnControl(CrnCommand command){
+        if (command.getCrnNo() == null) {
+            throw new CoolException("璇烽�夋嫨鍫嗗灈鏈�");
+        }
+        for (CrnSlave crn : slaveProperties.getCrn()) {
+            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
+            if (command.getCrnNo().equals(crn.getId())) {
+                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
+                if (crnThread == null) {
+                    throw new CoolException("鍫嗗灈鏈轰笉鍦ㄧ嚎");
+                }
+                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                if (crnProtocol == null) {
+                    throw new CoolException("鍫嗗灈鏈轰笉鍦ㄧ嚎");
+                }
+                // 绌洪棽鍒ゆ柇
+//                if (crnProtocol.getStatusType().equals(com.zy.core.enums.CrnStatusType.IDLE) && crnProtocol.getTaskNo() == 0) {
+                    if (MessageQueue.offer(SlaveType.Crn, crn.getId(), new Task(2, command))) {
+                        return true;
+                    } else {
+                        throw new CoolException("鍛戒护涓嬪彂澶辫触");
+                    }
+//                } else {
+//                    throw new CoolException("鍫嗗灈鏈轰笉鍦ㄧ┖闂茬姸鎬�");
+//                }
+            }
+        }
+        return false;
+    }
+
+    private void staNoProcess(CrnOperatorParam param, CrnCommand command){
+        if (param.getSourceStaNo()!=null) {
+            if (param.getSourceStaNo() == 5) {
+                command.setSourcePosX((short) 2);     // 婧愬簱浣嶆帓
+                command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+                command.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
+            } else if (param.getSourceStaNo() == 6) {
+                command.setSourcePosX((short) 1);     // 婧愬簱浣嶆帓
+                command.setSourcePosY((short) 0);     // 婧愬簱浣嶅垪
+                command.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
+            }
+        }
+        if (param.getStaNo()!=null) {
+            if (param.getStaNo() == 5) {
+                command.setDestinationPosX((short) 2);     // 鐩爣搴撲綅鎺�
+                command.setDestinationPosY((short) 0);     // 鐩爣搴撲綅鍒�
+                command.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+            } else if (param.getStaNo() == 6) {
+                command.setDestinationPosX((short) 1);     // 鐩爣搴撲綅鎺�
+                command.setDestinationPosY((short) 0);     // 鐩爣搴撲綅鍒�
+                command.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+            }
+        }
+    }
+
+
 }

--
Gitblit v1.9.1