自动化立体仓库 - WCS系统
*
lsh
2025-04-01 e61e2780013d4650a277245965b80a32e8e5cc6d
src/main/java/com/zy/core/thread/SiemensCrnThread.java
@@ -355,10 +355,65 @@
        array[7] = command.getDestinationPosY();
        array[8] = command.getDestinationPosZ();
        array[9] = command.getCommand();
        OperateResult result18 = siemensNet.Write("DB100.18", (short)0);
        try{
            Thread.sleep(100L);
        } catch (Exception e){}
        // 作业信息
        OperateResult result = siemensNet.Write("DB100.0", array);
//        int i=0;
//        do{
//            //堆垛机任务写入后,回读一次,看是否成功
//            try{
//                Thread.sleep(100L);
//            } catch (Exception e){}
//            OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 20);
//            if (resultRead.IsSuccess) {
//                CrnCommand one = new CrnCommand();
//                one.setTaskNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 2));
//                one.setTaskMode(siemensNet.getByteTransform().TransInt16(resultRead.Content, 4));
//                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
//                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
//                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
//                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
//                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
//                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
//                if (!command.getTaskNo().equals(one.getTaskNo()) || !command.getTaskMode().equals(one.getTaskMode())
//                        || !command.getSourcePosX().equals(one.getSourcePosX()) || !command.getSourcePosY().equals(one.getSourcePosY())
//                        || !command.getSourcePosZ().equals(one.getSourcePosZ()) || !command.getDestinationPosX().equals(one.getDestinationPosX())
//                        || !command.getDestinationPosY().equals(one.getDestinationPosY()) || !command.getDestinationPosZ().equals(one.getDestinationPosZ())
//                ){
//                    i++;
//                    log.error("堆垛机命令地址写入后回读失败[id:{}]>>>>重写[{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), i,JSON.toJSON(command),JSON.toJSON(one));
//                    result = siemensNet.Write("DB100.0", array);
//                }else{
//                    break;
//                }
//            }
//        }while(i<5);
        if (command.getAckFinish() == 0) {
            short commandFinish = 1;
            try{
                Thread.sleep(100L);
            } catch (Exception e){}
            result = siemensNet.Write("DB100.18", commandFinish);
            int signFinish = 1;
            while (signFinish<5){
                OperateResultExOne<byte[]> result10018 = siemensNet.Read("DB100.18", (short) 2);
                short transInt16 = siemensNet.getByteTransform().TransInt16(result10018.Content, 0);
                if (transInt16 != commandFinish){
                    log.info("下发DB100.18  回读失败" + "commandFinish:"+commandFinish);
                    log.info("下发DB100.18  回读失败" + "array:"+ JSON.toJSONString(array));
                    result = siemensNet.Write("DB100.18", commandFinish);
                    signFinish++;
                }else {
                    log.info("下发DB100.18" + "commandFinish:"+commandFinish);
                    log.info("下发DB100.18" + "array:"+ JSON.toJSONString(array));
                    break;
                }
            }
        }
        if (command.getAckFinish() != 1) {
            BasCrnOptService bean = SpringUtils.getBean(BasCrnOptService.class);
            BasCrnOpt basCrnOpt = new BasCrnOpt(
@@ -401,19 +456,22 @@
                one.setAckFinish(siemensNet.getByteTransform().TransInt16(resultRead.Content, 0));
                one.setTaskNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 2));
                //one.setTaskMode(siemensNet.getByteTransform().TransInt16(resultRead.Content, 4));
                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
//                one.setSourceStaNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 18));
//                one.setDestinationStaNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 20));
                if (!crnCommand.getTaskNo().equals(one.getTaskNo()) || !crnCommand.getAckFinish().equals(one.getAckFinish())
                        || !crnCommand.getSourcePosZ().equals(one.getSourcePosZ()) ||  !crnCommand.getSourcePosX().equals(one.getSourcePosX()) || !crnCommand.getSourcePosY().equals(one.getSourcePosY())
                        || !crnCommand.getDestinationPosZ().equals(one.getDestinationPosZ()) ||  !crnCommand.getDestinationPosX().equals(one.getDestinationPosX()) || !crnCommand.getDestinationPosY().equals(one.getDestinationPosY())
                if (!one.getTaskNo().equals(array[1]) || !one.getAckFinish().equals(array[0])
                        || !one.getSourcePosZ().equals(array[5]) ||  !one.getSourcePosX().equals(array[3])
                        || !one.getSourcePosY().equals(array[4])
                        || !one.getDestinationPosZ().equals(array[8]) ||  !one.getDestinationPosX().equals(array[6])
                        || !one.getDestinationPosY().equals(array[7])
                ){
                    log.error("堆垛机命令地址写入后回读失败[id:{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one));
                    log.error("传参==堆垛机命令地址写入后回读失败[id:{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one));
                    log.error("实发==堆垛机命令地址写入后回读失败[id:{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one));
                    log.error("堆垛机命令回读失败后,重新添加任务到队列 ===>> [id:{}],{}", slave.getId(), JSON.toJSON(crnCommand));
                    MessageQueue.offer(SlaveType.Crn, slave.getId(), new Task(5, crnCommand));
                    Thread.sleep(100);
@@ -474,30 +532,88 @@
        array[7] = command.getDestinationPosY();
        array[8] = command.getDestinationPosZ();
        array[9] = command.getCommand();
        OperateResult result18 = siemensNet.Write("DB100.18", (short)0);
        try{
            Thread.sleep(100L);
        } catch (Exception e){}
        // 作业信息
        OperateResult result = siemensNet.Write("DB100.0", array);
        // 日志记录
            if (command.getAckFinish() != 1) {
                BasCrnOptService bean = SpringUtils.getBean(BasCrnOptService.class);
                BasCrnOpt basCrnOpt = new BasCrnOpt(
                        command.getTaskNo().intValue(),    // 任务号
                        command.getCrnNo(),    // 堆垛机[非空]
                        new Date(),    // 下发时间
                        command.getTaskModeType() == null ? null : command.getTaskModeType().toString(),    // 模式
                        command.getSourcePosX().intValue(),    // 源排
                        command.getSourcePosY().intValue(),    // 源列
                        command.getSourcePosZ().intValue(),    // 源层
                        null,    // 源站
                        command.getDestinationPosX().intValue(),    // 目标排
                        command.getDestinationPosY().intValue(),    // 目标列
                        command.getDestinationPosZ().intValue(),    // 目标层
                        null,    // 目标站
                        null,    // 响应结果
                        null,    // 修改时间
                        null    // 修改人员
                );
                bean.insert(basCrnOpt);
//        int i=0;
//        do{
//            //堆垛机任务写入后,回读一次,看是否成功
//            try{
//                Thread.sleep(100L);
//            } catch (Exception e){}
//            OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 20);
//            if (resultRead.IsSuccess) {
//                CrnCommand one = new CrnCommand();
//                one.setTaskNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 2));
//                one.setTaskMode(siemensNet.getByteTransform().TransInt16(resultRead.Content, 4));
//                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
//                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
//                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
//                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
//                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
//                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
//                if (!command.getTaskNo().equals(one.getTaskNo()) || !command.getTaskMode().equals(one.getTaskMode())
//                        || !command.getSourcePosX().equals(one.getSourcePosX()) || !command.getSourcePosY().equals(one.getSourcePosY())
//                        || !command.getSourcePosZ().equals(one.getSourcePosZ()) || !command.getDestinationPosX().equals(one.getDestinationPosX())
//                        || !command.getDestinationPosY().equals(one.getDestinationPosY()) || !command.getDestinationPosZ().equals(one.getDestinationPosZ())
//                ){
//                    i++;
//                    log.error("堆垛机命令地址写入后回读失败[id:{}]>>>>重写[{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), i,JSON.toJSON(command),JSON.toJSON(one));
//                    result = siemensNet.Write("DB100.0", array);
//                }else{
//                    break;
//                }
//            }
//        }while(i<5);
        if (command.getAckFinish() == 0) {
            short commandFinish = 1;
            try{
                Thread.sleep(100L);
            } catch (Exception e){}
            result = siemensNet.Write("DB100.18", commandFinish);
            int signFinish = 1;
            while (signFinish<5){
                OperateResultExOne<byte[]> result10018 = siemensNet.Read("DB100.18", (short) 2);
                short transInt16 = siemensNet.getByteTransform().TransInt16(result10018.Content, 0);
                if (transInt16 != commandFinish){
                    log.info("下发DB100.18  回读失败" + "commandFinish:"+commandFinish);
                    log.info("下发DB100.18  回读失败" + "array:"+ JSON.toJSONString(array));
                    result = siemensNet.Write("DB100.18", commandFinish);
                    signFinish++;
                }else {
                    log.info("下发DB100.18" + "commandFinish:"+commandFinish);
                    log.info("下发DB100.18" + "array:"+ JSON.toJSONString(array));
                    break;
                }
            }
        }
        // 日志记录
        if (command.getAckFinish() != 1) {
            BasCrnOptService bean = SpringUtils.getBean(BasCrnOptService.class);
            BasCrnOpt basCrnOpt = new BasCrnOpt(
                    command.getTaskNo().intValue(),    // 任务号
                    command.getCrnNo(),    // 堆垛机[非空]
                    new Date(),    // 下发时间
                    command.getTaskModeType() == null ? null : command.getTaskModeType().toString(),    // 模式
                    command.getSourcePosX().intValue(),    // 源排
                    command.getSourcePosY().intValue(),    // 源列
                    command.getSourcePosZ().intValue(),    // 源层
                    null,    // 源站
                    command.getDestinationPosX().intValue(),    // 目标排
                    command.getDestinationPosY().intValue(),    // 目标列
                    command.getDestinationPosZ().intValue(),    // 目标层
                    null,    // 目标站
                    null,    // 响应结果
                    null,    // 修改时间
                    null    // 修改人员
            );
            bean.insert(basCrnOpt);
        }
//        } catch (Exception ignore) {}
        //更新命令日志
@@ -567,22 +683,49 @@
            //堆垛机任务写入后,回读一次,看是否成功
            Thread.sleep(500);
            OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 24);
            /*
            *
            *  if (command.getTaskNo() == 0 && command.getAckFinish() == 0 && command.getAuto() != 1) {
            command.setTaskNo((short) 999);
        }
        command.setCrnNo(slave.getId());
        short[] array = new short[10];
        if (Cools.isEmpty(command.getAckFinish())) {
            array[0] = 5;
        } else {
            array[0] = command.getAckFinish();
        }
        array[1] = command.getTaskNo();
        array[2] = command.getTaskMode();
        array[3] = command.getSourcePosX();
        array[4] = command.getSourcePosY();
        array[5] = command.getSourcePosZ();
        array[6] = command.getDestinationPosX();
        array[7] = command.getDestinationPosY();
        array[8] = command.getDestinationPosZ();
        array[9] = command.getCommand();
        // 作业信息
        OperateResult result = siemensNet.Write("DB100.0", array);
            * */
            if (resultRead.IsSuccess) {
                CrnCommand one = new CrnCommand();
                one.setAckFinish(siemensNet.getByteTransform().TransInt16(resultRead.Content, 0));
                one.setTaskNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 2));
                //one.setTaskMode(siemensNet.getByteTransform().TransInt16(resultRead.Content, 4));
                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
                one.setSourcePosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6));
                one.setSourcePosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8));
                one.setSourcePosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 10));
                one.setDestinationPosX(siemensNet.getByteTransform().TransInt16(resultRead.Content, 12));
                one.setDestinationPosY(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14));
                one.setDestinationPosZ(siemensNet.getByteTransform().TransInt16(resultRead.Content, 16));
//                one.setSourceStaNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 18));
//                one.setDestinationStaNo(siemensNet.getByteTransform().TransInt16(resultRead.Content, 20));
                if (!crnCommand.getTaskNo().equals(one.getTaskNo()) || !crnCommand.getAckFinish().equals(one.getAckFinish())
                        || !crnCommand.getSourcePosZ().equals(one.getSourcePosZ()) ||  !crnCommand.getSourcePosX().equals(one.getSourcePosX()) || !crnCommand.getSourcePosY().equals(one.getSourcePosY())
                        || !crnCommand.getDestinationPosZ().equals(one.getDestinationPosZ())  ||  !crnCommand.getDestinationPosX().equals(one.getDestinationPosX()) || !crnCommand.getDestinationPosY().equals(one.getDestinationPosY())
                if (!one.getTaskNo().equals(array[1]) || !one.getAckFinish().equals(array[0])
                        || !one.getSourcePosZ().equals(array[5]) ||  !one.getSourcePosX().equals(array[3])
                        || !one.getSourcePosY().equals(array[4])
                        || !one.getDestinationPosZ().equals(array[8]) ||  !one.getDestinationPosX().equals(array[6])
                        || !one.getDestinationPosY().equals(array[7])
                ){
                    log.error("堆垛机命令地址写入后回读失败[id:{}] >>>>> 写入[{}],===>>回读[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one));
                    log.error("堆垛机命令回读失败后,重新添加任务到队列 ===>> [id:{}],{}", slave.getId(), JSON.toJSON(crnCommand));