提升机状态读取、提升机高度设定、提升机操作方案

Junjie

2023-06-10 e1783e196a4ada918268b9f81bfb3a19641e0626

 src/main/java/com/zy/core/thread/SiemensDevpThread.java

@@ -10,6 +10,7 @@
import com.core.common.SpringUtils;
import com.zy.asrs.entity.BasDevp;
import com.zy.asrs.service.BasDevpService;
import com.zy.common.utils.CommonUtils;
import com.zy.core.DevpThread;
import com.zy.core.News;
import com.zy.core.cache.MessageQueue;
@@ -41,11 +42,11 @@
    private SiemensS7Net siemensS7Net;
    private Map<Integer, StaProtocol> station = new ConcurrentHashMap<>();
    private short heartBeatVal = 1;
    private int barcodeSize = 2;
    private int barcodeSize = 1;
    public static final ArrayList<Integer> staNos = new ArrayList<Integer>() {{
        add(100);add(101);add(102);
        add(200);add(201);add(202);
        add(300);add(301);add(302);
        add(103);add(104);add(105);
        add(106);add(107);add(108);
    }};

    public boolean charge0;
@@ -75,6 +76,10 @@
                    // 写数据 ID+目标站
                    case 2:
                        write((StaProtocol)task.getData());
                        break;
                    // 出入库模式
                    case 3:
                        write3((StaProtocol)task.getData());
                        break;
                    default:
                        break;
@@ -127,7 +132,7 @@
            }
        }
        Thread.sleep(200);
        OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB102.100", (short) (staNos.size()));
        OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB101.0", (short) (staNos.size()));
        if (result1.IsSuccess) {
            for (int i = 0; i < staNos.size(); i++) {
                Integer siteId = staNos.get(i); // 站点编号
@@ -150,10 +155,12 @@

        //读条码
        Thread.sleep(100);
        OperateResultExOne<byte[]> result2 = siemensS7Net.Read("DB100.150",(short)31);
        OperateResultExOne<byte[]> result2 = siemensS7Net.Read("DB100.200",(short)24);
        if (result2.IsSuccess) {
            for (int i = 0; i < barcodeSize; i++) {
                String barcode = siemensS7Net.getByteTransform().TransString(result2.Content,i*16,15, "UTF-8");
            for (int i = 0; i <= barcodeSize; i++) {
                byte[] bytes = siemensS7Net.getByteTransform().TransByte(result2.Content, i * 8, 8);
                String barcode = CommonUtils.bytesToBarcode(bytes);
//                String barcode = siemensS7Net.getByteTransform().TransString(result2.Content,i*8,8, "UTF-8");
                BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, i + 1);
                if(!Cools.isEmpty(barcodeThread) && !barcodeThread.getBarcode().equals(barcode)) {
                    barcodeThread.setBarcode(barcode);
@@ -161,47 +168,61 @@
            }
        }

        // 充电信号位
        // 充电信号位1
        Thread.sleep(50);
        OperateResultExOne<byte[]> result3 = siemensS7Net.Read("DB102.128", (short)1);
        if (result3.IsSuccess) {
            boolean[] status = siemensS7Net.getByteTransform().TransBool(result3.Content, 0, 1);
            charge0 = status[0];
            charge1 = status[1];
            charge2 = status[2];
        OperateResultExOne<byte[]> result32 = siemensS7Net.Read("DB102.109", (short)1);
        if (result32.IsSuccess) {
            boolean[] status = siemensS7Net.getByteTransform().TransBool(result32.Content, 0, 1);
            charge0 = status[0];  //1:可以充电   0：可能离线 可能在充电
        }
        // 充电信号位2
        Thread.sleep(50);
        OperateResultExOne<byte[]> result31 = siemensS7Net.Read("DB100.201", (short)1);
        if (result31.IsSuccess) {
            boolean[] status = siemensS7Net.getByteTransform().TransBool(result31.Content, 0, 1);
            charge1 = status[0];
        }

        // 外形检测 - 102
        Thread.sleep(50);
        OperateResultExOne<byte[]> result4 = siemensS7Net.Read("DB102.129", (short)1);
        if (result4.IsSuccess) {
            boolean[] status = siemensS7Net.getByteTransform().TransBool(result4.Content, 0, 1);
        OperateResultExOne<byte[]> result102 = siemensS7Net.Read("DB100.100", (short)2);
        if (result102.IsSuccess) {
            //出入库模式
            short outInModel = siemensS7Net.getByteTransform().TransInt16(result102.Content, 0);
            StaProtocol staProtocol = station.get(102);
            staProtocol.setFrontErr(status[0]);
            staProtocol.setBackErr(status[1]);
            staProtocol.setHighErr(status[2]);
            staProtocol.setLeftErr(status[3]);
            staProtocol.setRightErr(status[4]);
            staProtocol.setWeightErr(status[5]);
            staProtocol.setBarcodeErr(status[6]);
            staProtocol.setOutInModel(outInModel);
        }
        // 外形检测 - 203
        Thread.sleep(50);
        OperateResultExOne<byte[]> result5 = siemensS7Net.Read("DB102.130", (short)1);
        if (result5.IsSuccess) {
            boolean[] status = siemensS7Net.getByteTransform().TransBool(result5.Content, 0, 1);
            StaProtocol staProtocol = station.get(202);
            staProtocol.setFrontErr(status[0]);
            staProtocol.setBackErr(status[1]);
            staProtocol.setHighErr(status[2]);
            staProtocol.setLeftErr(status[3]);
            staProtocol.setRightErr(status[4]);
            staProtocol.setWeightErr(status[5]);
            staProtocol.setBarcodeErr(status[6]);
        }
//        // 外形检测 - 201
//        Thread.sleep(50);
//        OperateResultExOne<byte[]> result201 = siemensS7Net.Read("DB102.112", (short)1);
//        if (result201.IsSuccess) {
//            boolean[] status = siemensS7Net.getByteTransform().TransBool(result201.Content, 0, 1);
//            StaProtocol staProtocol = station.get(201);
//            staProtocol.setFrontErr(status[0]);
//            staProtocol.setBackErr(status[1]);
//            staProtocol.setHighErr(status[2]);
//            staProtocol.setLeftErr(status[3]);
//            staProtocol.setRightErr(status[4]);
//            staProtocol.setWeightErr(status[5]);
//            staProtocol.setBarcodeErr(status[6]);
//        }
//        // 外形检测 - 301
//        Thread.sleep(50);
//        OperateResultExOne<byte[]> result301 = siemensS7Net.Read("DB102.114", (short)1);
//        if (result301.IsSuccess) {
//            boolean[] status = siemensS7Net.getByteTransform().TransBool(result301.Content, 0, 1);
//            StaProtocol staProtocol = station.get(301);
//            staProtocol.setFrontErr(status[0]);
//            staProtocol.setBackErr(status[1]);
//            staProtocol.setHighErr(status[2]);
//            staProtocol.setLeftErr(status[3]);
//            staProtocol.setRightErr(status[4]);
//            staProtocol.setWeightErr(status[5]);
//            staProtocol.setBarcodeErr(status[6]);
//        }


        if (result.IsSuccess && result1.IsSuccess) {

            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】[id:{1}] <<<<< 实时数据更新成功",DateUtils.convert(new Date()), slave.getId()));

            // 根据实时信息更新数据库
@@ -227,6 +248,67 @@
    }

    /**
     * plc与提升机交互
     */
    private void write4(Integer siteId, Integer direction) throws InterruptedException {
        if (Cools.isEmpty(siteId, direction)) {
            return;
        }
        switch (siteId) {
            case 102:
                siemensS7Net.Write("DB100.300", direction.shortValue());
                break;
            case 105:
                siemensS7Net.Write("DB100.302", direction.shortValue());
                break;
            case 106:
                siemensS7Net.Write("DB100.304", direction.shortValue());
                break;
            case 107:
                siemensS7Net.Write("DB100.306", direction.shortValue());
                break;
            case 108:
                siemensS7Net.Write("DB100.308", direction.shortValue());
                break;
        }
    }

    /**
     * 写入 ID+目标站 =====> 单站点写入
     */
    private void write3(StaProtocol staProtocol) throws InterruptedException {
        if (Cools.isEmpty(staProtocol)) {
            return;
        }
        Short outAndIn = staProtocol.getOutInModel();
        Integer siteId = staProtocol.getSiteId();
        Short run = 1;//正转
        if (outAndIn == 1) {//入库
            run = 1;//正转
        } else {
            run = 2;//反转
        }
        switch (siteId) {
            case 102:
                siemensS7Net.Write("DB100.300", run);
                break;
            case 105:
                siemensS7Net.Write("DB100.302", run);
                break;
            case 106:
                siemensS7Net.Write("DB100.304", run);
                break;
            case 107:
                siemensS7Net.Write("DB100.306", run);
                break;
            case 108:
                siemensS7Net.Write("DB100.308", run);
                break;
        }

    }

    /**
     * 写入 ID+目标站 =====> 单站点写入
     */
    private void write(StaProtocol staProtocol) throws InterruptedException {
@@ -234,20 +316,74 @@
            return;
        }
        int index = staNos.indexOf(staProtocol.getSiteId());
        OperateResult write = siemensS7Net.Write("DB100." + index*4, staProtocol.getWorkNo());    // 工作号
        Thread.sleep(500);
        OperateResult write1 = siemensS7Net.Write("DB100." + (index*4+2), staProtocol.getStaNo());    // 目标站
        short[] array = new short[2];
        array[0] = staProtocol.getWorkNo();
        array[1] = staProtocol.getStaNo();
//        OperateResult write = siemensS7Net.Write("DB100." + index*4, staProtocol.getWorkNo());    // 工作号
//        Thread.sleep(500);
//        OperateResult write1 = siemensS7Net.Write("DB100." + (index*4+2), staProtocol.getStaNo());    // 目标站

        if (!write.IsSuccess || !write1.IsSuccess) {
        OperateResult writeResult;
        //任务下发次数
        int writeCount = 0;
        //任务下发成功标识
        boolean writeFlag = false;
        while(writeCount < 5){
            writeResult = siemensS7Net.Write("DB100." + index*4, array);    // 工作号、目标站
            if(writeResult.IsSuccess){
                Thread.sleep(200);
                OperateResultExOne<byte[]> readResult = siemensS7Net.Read("DB100." + index*4, (short)4);
                if(readResult.IsSuccess){
                    short workNo = siemensS7Net.getByteTransform().TransInt16(readResult.Content, 0);
                    short staNo = siemensS7Net.getByteTransform().TransInt16(readResult.Content, 2);
                    if(staProtocol.getWorkNo().equals(workNo) && staProtocol.getStaNo().equals(staNo)){
                        //任务命令写入成功
                        writeFlag = true;
                        log.info("写入输送线命令后返回成功，并且回读成功。输送线plc编号={}，{}，写入次数={}", slave.getId(), JSON.toJSON(staProtocol), writeCount);
                        break;
                    } else {//返回结果是成功了，但是真实值不相同
                        writeCount++;
                        OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线命令后返回成功，但是读取任务值不一致。输送线plc编号={1}，站点数据={2},写入次数={3}",
                                slave.getId(), JSON.toJSON(staProtocol),writeCount));
                        log.error("写入输送线命令后返回成功，但是读取任务值不一致。输送线plc编号={}，{}，写入次数={}", slave.getId(), JSON.toJSON(staProtocol), writeCount);
                    }
                } else {
                    writeCount++;
                    OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线命令后读取失败。输送线plc编号={1}，站点数据={2},写入次数={3}",
                            slave.getId(), JSON.toJSON(staProtocol), writeCount));
                    log.error("写入输送线命令后读取失败。输送线plc编号={}，站点数据={},写入次数={}", slave.getId(), JSON.toJSON(staProtocol), writeCount);
                }
            } else {
                writeCount++;
                OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线命令失败。输送线plc编号={1}，站点数据={2},写入次数={3}",
                        slave.getId(), JSON.toJSON(staProtocol),writeCount));
                log.error("写入输送线命令失败。输送线plc编号={}，站点数据={},写入次数={}", slave.getId(), JSON.toJSON(staProtocol), writeCount);
            }
            Thread.sleep(200);
        }

        //写命令尝试了5次还是失败了
        if(!writeFlag){
            staProtocol = station.get(staProtocol.getSiteId());
            if (staProtocol.getWorkNo() == 0 && staProtocol.getStaNo() ==0) {
                staProtocol.setPakMk(true);
            }
            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线站点数据失败。输送线plc编号={1}，站点数据={2}", slave.getId(), JSON.toJSON(staProtocol)));
            News.error("写入输送线站点数据失败。输送线plc编号={}，站点数据={}", slave.getId(), JSON.toJSON(staProtocol));
            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线命令尝试5次失败。输送线plc编号={1}，站点数据={2}", slave.getId(), JSON.toJSON(staProtocol)));
            log.error("写入输送线命令尝试5次失败。输送线plc编号={}，站点数据={}", slave.getId(), JSON.toJSON(staProtocol));

            //重新添加数据到任务队列
            boolean result = MessageQueue.offer(SlaveType.Devp, slave.getId(), new Task(2, staProtocol));
            read();//读取1次设备状态
            return;
        } else {
            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】 输送线命令下发 [id:{1}] >>>>> {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(staProtocol)));
            News.info("输送线命令下发 [id:{}] >>>>> 命令下发： {}",  slave.getId(), JSON.toJSON(staProtocol));
            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】 输送线命令下发成功 [id:{1}] >>>>> {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(staProtocol)));
            log.info("输送线命令下发 [id:{}] >>>>> 命令下发成功： {}",  slave.getId(), JSON.toJSON(staProtocol));

            Integer siteId = staProtocol.getSiteId();
            staProtocol = station.get(siteId);
            if ((siteId == 101 || siteId == 201)&&(staProtocol.getWorkNo() == 0 && staProtocol.getStaNo() ==0)) {
                staProtocol.setPakMk(true);
            }
        }
    }