电梯三楼逻辑

acs/nladmin-system/src/main/java/org/nl/acs/device_driver/basedriver/agv/utils/SocketUtil.java

@@ -51,6 +51,15 @@ public class SocketUtil {
                         (byte) 0XF8,
                 };
             }
+            if(agvaddr==2423){
+                call = new byte[]{(byte) 0X1A, (byte) 0X1B,
+                        (byte) 0X02, (byte) 0X01,
+                        (byte) 0X02, (byte) 0X04,
+                        (byte) 0X01, (byte) 0X03,
+                        (byte) 0X00, (byte) 0XFF,
+                        (byte) 0XF9,
+                };
+            }
             if(action==0X0A) {
                 move = new byte[]{(byte) 0X1A, (byte) 0X1B,
                         (byte) 0X02, (byte) 0X01,
@@ -73,7 +82,8 @@ public class SocketUtil {
             int[] arr = packageResult();
             if (arr[7] == 0x00) {
                 if ((arr[9] == 0x01 && agvaddr==2421)||
-                        (arr[9] == 0x02 && agvaddr==2422)) {
+                        (arr[9] == 0x02 && agvaddr==2422)||
+                        (arr[9] == 0x03 && agvaddr==2423)) {
                     log.info("电梯已就位，下发开门指令");
                     write(move);
                     packageResult();