From 6d25ccf7d7a582ab861e4b9dc0a38cb6cbf21588 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期五, 16 六月 2023 09:43:44 +0800
Subject: [PATCH] 提升机状态读取

---
 src/main/java/com/zy/core/thread/LiftThread.java |  321 ++++++++++++++++++++++++++++++++++++-----------------
 1 files changed, 218 insertions(+), 103 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/LiftThread.java b/src/main/java/com/zy/core/thread/LiftThread.java
index fc9225e..d1b2299 100644
--- a/src/main/java/com/zy/core/thread/LiftThread.java
+++ b/src/main/java/com/zy/core/thread/LiftThread.java
@@ -5,39 +5,34 @@
 import HslCommunication.Core.Types.OperateResultExOne;
 import HslCommunication.ModBus.ModbusTcpNet;
 import com.alibaba.fastjson.JSON;
-import com.core.common.Cools;
 import com.core.common.DateUtils;
 import com.core.common.SpringUtils;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.BasLift;
 import com.zy.asrs.entity.BasLiftOpt;
-import com.zy.asrs.entity.BasShuttle;
-import com.zy.asrs.entity.BasShuttleOpt;
 import com.zy.asrs.service.BasLiftOptService;
 import com.zy.asrs.service.BasLiftService;
-import com.zy.asrs.service.BasShuttleOptService;
-import com.zy.asrs.service.BasShuttleService;
 import com.zy.common.utils.CommonUtils;
 import com.zy.common.utils.RedisUtil;
+import com.zy.core.DevpThread;
 import com.zy.core.News;
 import com.zy.core.ThreadHandler;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.OutputQueue;
+import com.zy.core.cache.SlaveConnection;
 import com.zy.core.enums.*;
+import com.zy.core.model.DevpSlave;
 import com.zy.core.model.LiftSlave;
 import com.zy.core.model.Task;
-import com.zy.core.model.command.LiftAssignCommand;
-import com.zy.core.model.command.LiftCommand;
-import com.zy.core.model.command.ShuttleAssignCommand;
-import com.zy.core.model.command.ShuttleCommand;
+import com.zy.core.model.command.*;
 import com.zy.core.model.protocol.LiftProtocol;
+import com.zy.core.model.protocol.StaProtocol;
 import lombok.Data;
 import lombok.extern.slf4j.Slf4j;
 
 import java.text.MessageFormat;
 import java.util.ArrayList;
 import java.util.Date;
-import java.util.HashMap;
 import java.util.List;
 
 /**
@@ -118,7 +113,7 @@
 
     private void readStatus() {
         try {
-            OperateResultExOne<byte[]> result = modbusTcpNet.Read("29", (short) 50);
+            OperateResultExOne<byte[]> result = modbusTcpNet.Read("41117", (short) 50);
             if (result.IsSuccess) {
                 if (null == liftProtocol) {
                     liftProtocol = new LiftProtocol();
@@ -132,63 +127,63 @@
                 liftProtocol.setLiftLock(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content, 0)));
                 //浣嶇疆鍒拌揪鍙嶉
                 liftProtocol.setPositionArrivalFeedback(modbusTcpNet.getByteTransform().TransInt16(content,2));
-                //鍑嗗灏辩华
-                liftProtocol.setReady(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content,4)));
-                //杩愯涓�
-                liftProtocol.setRunning(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content,6)));
-                //鑱旀満/鍗曟満
-                liftProtocol.setMode(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content,8)));
 
-                //浠ヤ笅鍙傛暟骞舵湭杩涜璋冩暣(闇�瑕佸悗缁拡瀵瑰疄鏈鸿繘琛岃幏鍙栧拰璋冭瘯)
+                byte by = modbusTcpNet.getByteTransform().TransByte(content, 5);
+                int[] datas = CommonUtils.byteToBits(by);
+                //鍑嗗灏辩华
+                liftProtocol.setReady(CommonUtils.intToBoolean(datas[0]));
+                //杩愯涓�
+                liftProtocol.setRunning(CommonUtils.intToBoolean(datas[1]));
+                //鑱旀満/鍗曟満
+                liftProtocol.setMode(CommonUtils.intToBoolean(datas[2]));
                 //杈撻�佺嚎鍓嶇鍏夌數鏈夎揣
-                liftProtocol.setLineFrontHasStock(modbusTcpNet.getByteTransform().TransBool(content,10));
+                liftProtocol.setLineFrontHasStock(CommonUtils.intToBoolean(datas[3]));
                 //杈撻�佺嚎姝h浆鍙嶉
-                liftProtocol.setForwardRotationFeedback(modbusTcpNet.getByteTransform().TransBool(content,12));
+                liftProtocol.setForwardRotationFeedback(CommonUtils.intToBoolean(datas[4]));
                 //杈撻�佺嚎鍙嶈浆鍙嶉
-                liftProtocol.setReverseFeedback(modbusTcpNet.getByteTransform().TransBool(content,14));
+                liftProtocol.setReverseFeedback(CommonUtils.intToBoolean(datas[5]));
                 //杈撻�佺嚎鐢垫満杩囪浇
-                liftProtocol.setMotorOverload(modbusTcpNet.getByteTransform().TransBool(content,16));
+                liftProtocol.setMotorOverload(CommonUtils.intToBoolean(datas[6]));
                 //杈撻�佺嚎鏈鍏夌數鏈夎揣
-                liftProtocol.setLineEndHasStock(modbusTcpNet.getByteTransform().TransBool(content,18));
+                liftProtocol.setLineEndHasStock(CommonUtils.intToBoolean(datas[7]));
                 //杩涜緭閫佺嚎鍗℃墭鐩樻姤璀�
-                liftProtocol.setInConveyLineCardTrayAlarm(modbusTcpNet.getByteTransform().TransBool(content,20));
+                liftProtocol.setInConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[8]));
                 //鍑鸿緭閫佺嚎鍗℃墭鐩樻姤璀�
-                liftProtocol.setOutConveyLineCardTrayAlarm(modbusTcpNet.getByteTransform().TransBool(content,22));
+                liftProtocol.setOutConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[9]));
                 //骞冲彴浣嶇疆鍋忓樊鎶ヨ
-                liftProtocol.setPlatPositionDeviationAlarm(modbusTcpNet.getByteTransform().TransBool(content,24));
+                liftProtocol.setPlatPositionDeviationAlarm(CommonUtils.intToBoolean(datas[10]));
                 //骞冲彴鎵煩鍋忓樊鎶ヨ
-                liftProtocol.setPlatTorqueDeviationAlarm(modbusTcpNet.getByteTransform().TransBool(content,26));
+                liftProtocol.setPlatTorqueDeviationAlarm(CommonUtils.intToBoolean(datas[11]));
                 //骞冲彴鍥涘悜杞︽娴�
-                liftProtocol.setPlatShuttleCheck(modbusTcpNet.getByteTransform().TransBool(content,28));
+                liftProtocol.setPlatShuttleCheck(CommonUtils.intToBoolean(datas[12]));
+
+
                 //鏈氨缁姸鎬�
-                liftProtocol.setNotReady(modbusTcpNet.getByteTransform().TransInt16(content,30));
+                liftProtocol.setNotReady(modbusTcpNet.getByteTransform().TransInt16(content,6));
                 //浼烘湇1閿欒
-                liftProtocol.setServoError1(modbusTcpNet.getByteTransform().TransInt16(content,32));
+                liftProtocol.setServoError1(modbusTcpNet.getByteTransform().TransInt16(content,8));
                 //浼烘湇2閿欒
-                liftProtocol.setServoError2(modbusTcpNet.getByteTransform().TransInt16(content,34));
+                liftProtocol.setServoError2(modbusTcpNet.getByteTransform().TransInt16(content,10));
                 //浼烘湇3閿欒
-                liftProtocol.setServoError3(modbusTcpNet.getByteTransform().TransInt16(content,36));
+                liftProtocol.setServoError3(modbusTcpNet.getByteTransform().TransInt16(content,12));
                 //浼烘湇4閿欒
-                liftProtocol.setServoError4(modbusTcpNet.getByteTransform().TransInt16(content,38));
+                liftProtocol.setServoError4(modbusTcpNet.getByteTransform().TransInt16(content,14));
                 //鎻愬崌鏈哄疄闄呴�熷害鍙嶉
-                liftProtocol.setLiftActualSpeed(modbusTcpNet.getByteTransform().TransInt16(content,40));
+                liftProtocol.setLiftActualSpeed(modbusTcpNet.getByteTransform().TransInt16(content,16));
 
                 ///璇诲彇鎻愬崌鏈虹姸鎬�-end
 
-                //灏忚溅澶勪簬杩愯鐘舵�侊紝灏嗘爣璁扮疆涓簍rue
+                //鎻愬崌鏈哄浜庤繍琛岀姸鎬侊紝灏嗘爣璁扮疆涓簍rue
                 if (liftProtocol.getRunning()) {
                     liftProtocol.setPakMk(true);
                 }
 
-                //鎻愬崌鏈哄浜庨攣瀹氥�佹湭杩愯銆佸氨缁�佹爣璁皌rue銆佹湁浠诲姟鍙�
-                if (liftProtocol.getLiftLock()
-                        && !liftProtocol.getRunning()
-                        && liftProtocol.getReady()
+                //鎻愬崌鏈哄浜庢湭杩愯銆佸氨缁�佹爣璁皌rue銆佹湁浠诲姟鍙�
+                if (!liftProtocol.getRunning()
                         && liftProtocol.getPakMk()
-                        && liftProtocol.getTaskNo() != 0
-                        && liftProtocol.getAssignCommand() != null) {
+                        && liftProtocol.getTaskNo() != 0) {
                     //杩樻湁鏈畬鎴愮殑鍛戒护
-                    executeWork(liftProtocol.getAssignCommand());
+                    executeWork(liftProtocol.getTaskNo());
                 }
 
                 //灏嗘彁鍗囨満鐘舵�佷繚瀛樿嚦鏁版嵁搴�
@@ -271,12 +266,24 @@
             //鍥涘眰楂樺害璁惧畾
             array[5] = command.getHeight4();
         }
+        if (command.getHeight5() != null) {
+            //鍥涘眰楂樺害璁惧畾
+            array[6] = command.getHeight5();
+        }
         if (command.getLiftLockShortValue() != null) {
             //鎻愬崌鏈洪攣瀹�
             array[29] = command.getLiftLockShortValue();
         }
 
-        OperateResult result = modbusTcpNet.Write("0", array);;
+        if (array[2] == 0) {
+            // 寮�濮嬩换鍔�
+            short[] tmp = new short[2];
+            tmp[0] = array[0];
+            tmp[1] = array[1];
+            array = tmp;
+        }
+
+        OperateResult result = modbusTcpNet.Write("41088", array);;
         if (result != null && result.IsSuccess) {
             News.info("鎻愬崌鏈哄懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command));
             OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command)));
@@ -290,9 +297,6 @@
 
     //鍒嗛厤浠诲姟
     private void assignWork(LiftAssignCommand assignCommand) {
-        //灏嗘map瀛樺叆redis涓�
-        HashMap<String, Object> map = new HashMap<>();
-
         //鎵嬪姩妯″紡鎸囦护
         if (!assignCommand.getAuto()) {
             LiftCommand command = new LiftCommand();
@@ -304,23 +308,26 @@
             }
             liftProtocol.setTaskNo(assignCommand.getTaskNo());
             switch (assignCommand.getTaskMode()) {
-                case 1://涓婂崌涓�灞�
-                    command.setRun((short) 1);//鍗囬檷
-                    command.setDistPosition(++lev);
+                case 1://绉诲姩鎻愬崌鏈�
+                    command = getLiftUpDownCommand(assignCommand.getLev());//鑾峰彇鎻愬崌鏈轰笂鍗囦笅闄嶅懡浠�
                     break;
-                case 2://涓嬮檷涓�灞�
-                    command.setRun((short) 1);//涓嬮檷
-                    command.setDistPosition(--lev);
+                case 3://鏃犺揣姝h浆
+                    command = getLiftTurnCommand(3);//鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠�
                     break;
-                case 3://鏈夎揣姝h浆
-                    command.setRun((short) 6);
+                case 4://鏃犺揣鍙嶈浆
+                    command = getLiftTurnCommand(4);//鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠�
                     break;
-                case 4://鏈夎揣鍙嶈浆
-                    command.setRun((short) 3);
+                case 5://鏈夎揣姝h浆
+                    command = getLiftTurnCommand(1);//鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠�
                     break;
-                case 5://澶嶄綅
-                    command.setRun((short) 0);
-                    command.setLiftLock(false);
+                case 6://鏈夎揣鍙嶈浆
+                    command = getLiftTurnCommand(2);//鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠�
+                    break;
+                case 7://閾炬潯鍋滄
+                    command = getLiftTurnCommand(5);//鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠�
+                    break;
+                case 0://澶嶄綅
+                    command = getResetCommand();//鑾峰彇澶嶄綅鍛戒护
                     break;
                 default:
             }
@@ -328,68 +335,87 @@
             assignCommand.setCommands(commands);
         }
 
-        //鎻愬崌鏈哄彿
-        map.put("lift_no", assignCommand.getLiftNo());
-        //宸ヤ綔鍙�
-        map.put("wrk_no", assignCommand.getTaskNo());
-        //鍛戒护鎵ц姝ュ簭
-        map.put("commandStep", 0);
-        //鍛戒护
-        map.put("assignCommand", assignCommand);
+        LiftRedisCommand redisCommand = new LiftRedisCommand();
+        redisCommand.setLiftNo(assignCommand.getLiftNo());//鎻愬崌鏈哄彿
+        redisCommand.setWrkNo(assignCommand.getTaskNo());//宸ヤ綔鍙�
+        redisCommand.setCommandStep(0);//鍛戒护鎵ц姝ュ簭
+        redisCommand.setAssignCommand(assignCommand);//鍛戒护
         //浠诲姟鏁版嵁淇濆瓨鍒皉edis
-        redisUtil.set("lift_wrk_no_" + assignCommand.getTaskNo(), JSON.toJSONString(map));
+        redisUtil.set("lift_wrk_no_" + assignCommand.getTaskNo(), JSON.toJSONString(redisCommand));
         liftProtocol.setAssignCommand(assignCommand);
         liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);
         //鎵ц涓嬪彂浠诲姟
-        executeWork(assignCommand);
+        executeWork(assignCommand.getTaskNo());
     }
 
     //鎵ц浠诲姟
-    private boolean executeWork(LiftAssignCommand assignCommand) {
+    private boolean executeWork(Short wrkNo) {
         //璇诲彇redis鏁版嵁
-        if (assignCommand == null) {
+        if (wrkNo == null) {
             return false;
         }
 
         //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂)
         liftProtocol.setPakMk(false);
 
-        Object o = redisUtil.get("lift_wrk_no_" + assignCommand.getTaskNo());
+        Object o = redisUtil.get("lift_wrk_no_" + wrkNo);
         if (o == null) {
             return false;
         }
-        HashMap map = JSON.parseObject(o.toString(), HashMap.class);
-        List<LiftCommand> commands = assignCommand.getCommands();
+        LiftRedisCommand redisCommand = JSON.parseObject(o.toString(), LiftRedisCommand.class);
+        List<LiftCommand> commands = redisCommand.getAssignCommand().getCommands();
         //褰撳墠姝ュ簭
-        int commandStep = Integer.parseInt(map.get("commandStep").toString());
+        int commandStep = redisCommand.getCommandStep();
         //鎬绘搴�
         int size = commands.size();
+        LiftAssignCommand assignCommand = redisCommand.getAssignCommand();
 
         //鍙栧嚭鍛戒护
         LiftCommand command = commands.get(commandStep);
+        if (command.getOperaStaNo() != null && command.getDevpId() != null) {
+            //绔欑偣鍜岃緭閫佺嚎ID涓嶄负null锛岄渶瑕佷笅鍙戠珯鐐规寚浠よ皟搴︽寚瀹氱珯鐐硅繘琛岄摼鏉¤浆鍔�
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, command.getDevpId());
+            StaProtocol staProtocol = devpThread.getStation().get(command.getOperaStaNo().intValue());
+            if (!staProtocol.isLiftArrival()) {//閾炬潯杞姩鏉′欢锛岄渶瑕佹湁鎻愬崌鏈哄埌浣嶄俊鍙�
+                liftProtocol.setPakMk(true);
+                return false;
+            }
+            staProtocol.setWorkNo(wrkNo);//璁剧疆浠诲姟鍙�
+            if (command.getStaNo() != null) {
+                staProtocol.setStaNo(command.getStaNo());//璁剧疆鐩爣绔�
+            }
+
+            if (command.getRotationDire() != null) {
+                staProtocol.setRotationDire(command.getRotationDire());//绔欑偣閾炬潯杞姩淇″彿
+            }
+            Integer devpId = command.getDevpId();
+            boolean result1 = MessageQueue.offer(SlaveType.Devp, devpId, new Task(3, staProtocol));//涓嬪彂鍛戒护浣胯緭閫佺嚎閾炬潯杩愯浆
+        }
+
         //涓嬪彂鍛戒护
         if (!write(command)) {
             News.error("鎻愬崌鏈哄懡浠や笅鍙戝け璐ワ紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
             return false;
         }else {
             News.info("鎻愬崌鏈哄懡浠や笅鍙戞垚鍔燂紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
+            liftProtocol.setWrkTime(new Date());//鏇存柊宸ヤ綔鏃堕棿
 
             //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚
             if (commandStep < size - 1) {
                 //鏇存柊redis鏁版嵁
                 //姝ュ簭澧炲姞
                 commandStep++;
-                map.put("commandStep", commandStep);
+                redisCommand.setCommandStep(commandStep);
                 //浠诲姟鏁版嵁淇濆瓨鍒皉edis
-                redisUtil.set("lift_wrk_no_" + map.get("wrk_no").toString(), JSON.toJSONString(map));
+                redisUtil.set("lift_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand));
             }else {
                 //宸叉墽琛屽畬鎴�
                 //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘�
                 BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class);
                 if (liftOptService != null) {
                     BasLiftOpt opt = new BasLiftOpt(
-                            assignCommand.getTaskNo().intValue(),
-                            assignCommand.getLiftNo().intValue(),
+                            redisCommand.getWrkNo().intValue(),
+                            redisCommand.getLiftNo().intValue(),
                             new Date(),
                             null,
                             null,
@@ -399,31 +425,11 @@
                     liftOptService.insert(opt);
                 }
                 //鍒犻櫎redis
-                redisUtil.del("lift_wrk_no_" + map.get("wrk_no").toString());
+                redisUtil.del("lift_wrk_no_" + redisCommand.getWrkNo());
 
-                if (assignCommand.getAuto()) {
-                    //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting
-                    liftProtocol.setProtocolStatus(LiftProtocolStatusType.WAITING);
-                    News.info("鎻愬崌鏈轰换鍔℃墽琛屽畬鎴愮瓑寰呯‘璁や腑锛屾彁鍗囨満鍙�={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
-                }else {
-                    //鎵嬪姩妯″紡涓嶆姏鍑虹瓑寰呯姸鎬�
-                    if (assignCommand.getTaskMode() == 5) {
-                        liftProtocol.setTaskNo((short) 0);
-                        liftProtocol.setShuttleNo((short) 0);
-                        liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
-                        liftProtocol.setPakMk(true);
-                    }
-                    News.info("鎻愬崌鏈烘墜鍔ㄤ换鍔℃墽琛屽畬鎴愶紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
-                }
-
-                //涓嬪彂涓�鏉℃彁鍗囨満瑙i攣鍛戒护
-                LiftCommand liftCommand = new LiftCommand();
-                liftCommand.setRun((short) 0);
-                liftCommand.setLiftNo(command.getLiftNo());
-                liftCommand.setLiftLock(false);
-                if (write(liftCommand)) {
-                    News.info("鎻愬崌鏈虹姸鎬佸凡瑙i攣锛屾彁鍗囨満鍙�={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
-                }
+                //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WAITING);
+                News.info("鎻愬崌鏈轰换鍔℃墽琛屽畬鎴愮瓑寰呯‘璁や腑锛屾彁鍗囨満鍙�={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
 
             }
         }
@@ -432,6 +438,115 @@
     }
 
     /**
+     * 鑾峰彇鎻愬崌鏈鸿В閿佸懡浠�
+     */
+    public LiftCommand getUnlockCommand(Short liftNo) {
+        LiftCommand command = new LiftCommand();
+        command.setRun((short) 0);
+        command.setLiftNo(liftNo);
+        command.setLiftLock(false);
+        return command;
+    }
+
+    /**
+     * 鑾峰彇澶嶄綅鍛戒护
+     */
+    public LiftCommand getResetCommand() {
+        LiftCommand command = new LiftCommand();
+        command.setRun((short) 5);
+        command.setLiftLock(false);
+        return command;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈轰笂鍗囦笅闄嶅懡浠�
+     */
+    public LiftCommand getLiftUpDownCommand(Integer lev) {
+        LiftCommand command = new LiftCommand();
+        command.setRun((short) 1);//鍗囬檷
+        Short position = LiftLevType.getRealLev(lev);//鑾峰彇鎻愬崌鏈哄疄闄呮ゼ灞傛暟鍊�
+        command.setDistPosition(position);
+//        command.setSpeed((short) 200);
+//        command.setHeight2((short) 180);
+//        command.setHeight3((short) 1645);
+//        command.setHeight4((short) (2 * 1645));
+//        command.setHeight5((short) (3 * 1645));
+        return command;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈轰笂鍗囦笅闄嶅懡浠�
+     */
+    public LiftCommand getLiftUpDownCommand(Short liftNo, Short taskNo, Integer lev) {
+        LiftCommand command = new LiftCommand();
+        Short position = LiftLevType.getRealLev(lev);//鑾峰彇鎻愬崌鏈哄疄闄呮ゼ灞傛暟鍊�
+        command.setRun((short) 1);//鍗囬檷
+        command.setLiftNo(liftNo);//鎻愬崌鏈哄彿
+        command.setTaskNo(taskNo);//浠诲姟鍙�
+        command.setDistPosition(position);//鐩爣妤煎眰
+//        command.setSpeed((short) 200);
+//        command.setHeight2((short) 180);
+//        command.setHeight3((short) 1645);
+//        command.setHeight4((short) 3290);
+//        command.setHeight5((short) 4945);
+        return command;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠わ紝direction锛�1=銆嬫湁璐ф杞紝2=銆嬫湁璐у弽杞紝3=>鏃犺揣姝h浆锛�4=>鏃犺揣鍙嶈浆
+     */
+    public LiftCommand getLiftTurnCommand(Integer direction) {
+        LiftCommand command = new LiftCommand();
+        Short run = 0;
+        switch (direction) {
+            case 1:
+                run = 6;//鏈夎揣姝h浆
+                break;
+            case 2:
+                run = 3;//鏈夎揣鍙嶈浆
+                break;
+            case 3:
+                run = 2;//鏃犺揣姝h浆
+                break;
+            case 4:
+                run = 7;//鏃犺揣鍙嶈浆
+                break;
+            case 5:
+                run = 4;//閾炬潯鍋滄
+        }
+        command.setRun(run);
+        return command;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈鸿浆鍔ㄥ懡浠わ紝direction锛�1=銆嬫湁璐ф杞紝2=銆嬫湁璐у弽杞�
+     */
+    public LiftCommand getLiftTurnCommand(Short liftNo, Short taskNo, Integer direction) {
+        LiftCommand command = new LiftCommand();
+        Short run = 0;
+        switch (direction) {
+            case 1:
+                run = 6;//鏈夎揣姝h浆
+                break;
+            case 2:
+                run = 3;//鏈夎揣鍙嶈浆
+                break;
+            case 3:
+                run = 2;//鏃犺揣姝h浆
+                break;
+            case 4:
+                run = 7;//鏃犺揣鍙嶈浆
+                break;
+            case 5:
+                run = 4;//閾炬潯鍋滄
+        }
+        command.setRun(run);
+        command.setLiftNo(liftNo);//鎻愬崌鏈哄彿
+        command.setTaskNo(taskNo);//浠诲姟鍙�
+        return command;
+    }
+
+    /**
      * 鍒濆鍖栨彁鍗囨満
      */
     private void initLift() {

--
Gitblit v1.9.1