#

Junjie

2026-01-15 e14a4372b6bd4a38e40a3a68bde32350d96071ab

 src/main/java/com/zy/core/thread/impl/ZyRgvThread.java

@@ -1,15 +1,21 @@
package com.zy.core.thread.impl;

import HslCommunication.Profinet.Siemens.SiemensPLCS;
import HslCommunication.Profinet.Siemens.SiemensS7Net;
import com.alibaba.fastjson.JSON;
import com.baomidou.mybatisplus.mapper.EntityWrapper;
import com.core.common.DateUtils;
import com.core.common.SpringUtils;
import com.zy.asrs.entity.BasRgv;
import com.zy.asrs.entity.BasRgvOpt;
import com.zy.asrs.entity.DeviceConfig;
import com.zy.asrs.entity.DeviceDataLog;
import com.zy.asrs.service.BasRgvService;
import com.zy.asrs.service.BasRgvOptService;
import com.zy.asrs.utils.Utils;
import com.zy.common.utils.RedisUtil;
import com.zy.core.cache.MessageQueue;
import com.zy.core.cache.OutputQueue;
import com.zy.core.enums.RedisKeyType;
import com.zy.core.enums.RgvTaskModeType;
import com.zy.core.enums.SlaveType;
import com.zy.core.model.CommandResponse;
import com.zy.core.model.Task;
@@ -24,14 +30,18 @@

import java.text.MessageFormat;
import java.util.Date;
import com.zy.asrs.entity.BasRgvErrLog;
import com.zy.asrs.service.BasRgvErrLogService;

@Data
@Slf4j
public class ZyRgvThread implements Runnable, RgvThread {

    private DeviceConfig deviceConfig;
    private RedisUtil redisUtil;
    private ZyRgvConnectDriver zyRgvConnectDriver;
    private RgvProtocol rgvProtocol;
    private int deviceLogCollectTime = 200;

    public ZyRgvThread(DeviceConfig deviceConfig, RedisUtil redisUtil) {
        this.deviceConfig = deviceConfig;
@@ -43,28 +53,39 @@
    public void run() {
        connect();
        initRgv();
        while (true) {
            try {
                int step = 1;
                Task task = MessageQueue.poll(SlaveType.Rgv, deviceConfig.getDeviceNo());
                if (task != null) {
                    step = task.getStep();

        Thread readThread = new Thread(() -> {
            while (true) {
                try {
                    deviceLogCollectTime = Utils.getDeviceLogCollectTime();
                    readStatus();
                    Thread.sleep(100);
                } catch (Exception e) {
                    log.error("RgvThread Fail", e);
                }
                switch (step) {
                    case 1:
                        readStatus();
                        break;
                    case 2:
                        sendCommand((RgvCommand) task.getData());
                        break;
                    default:
                        break;
                }
                Thread.sleep(200);
            } catch (Exception e) {
                e.printStackTrace();
            }
        }
        });
        readThread.start();

        Thread processThread = new Thread(() -> {
            while (true) {
                try {
                    int step = 1;
                    Task task = MessageQueue.poll(SlaveType.Rgv, deviceConfig.getDeviceNo());
                    if (task != null) {
                        step = task.getStep();
                    }
                    if (step == 2) {
                        sendCommand((RgvCommand) task.getData());
                    }

                    Thread.sleep(100);
                } catch (Exception e) {
                    log.error("RgvProcess Fail", e);
                }
            }
        });
        processThread.start();
    }

    private void initRgv() {
@@ -72,7 +93,7 @@
            rgvProtocol = new RgvProtocol();
            rgvProtocol.setRgvNo(deviceConfig.getDeviceNo());
        }
        rgvProtocol.setMode(-1);
        rgvProtocol.setMode(0);
        rgvProtocol.setTaskNo(0);
        rgvProtocol.setStatus(-1);
        rgvProtocol.setRgvPos(0);
@@ -82,9 +103,8 @@

    @Override
    public boolean connect() {
        SiemensS7Net siemensS7Net = new SiemensS7Net(SiemensPLCS.S1200, deviceConfig.getIp());
        zyRgvConnectDriver = new ZyRgvConnectDriver(siemensS7Net, deviceConfig);
        new Thread(zyRgvConnectDriver).start();
        zyRgvConnectDriver = new ZyRgvConnectDriver(deviceConfig);
        zyRgvConnectDriver.start();
        DeviceConnectPool.put(SlaveType.Rgv, deviceConfig.getDeviceNo(), zyRgvConnectDriver);
        return true;
    }
@@ -112,7 +132,7 @@
            rgvProtocol.setLastCommandTime(System.currentTimeMillis());
        }

        if (System.currentTimeMillis() - rgvProtocol.getDeviceDataLog() > 200) {
        if (System.currentTimeMillis() - rgvProtocol.getDeviceDataLog() > deviceLogCollectTime) {
            DeviceDataLog deviceDataLog = new DeviceDataLog();
            deviceDataLog.setOriginData(JSON.toJSONString(s));
            deviceDataLog.setWcsData(JSON.toJSONString(rgvProtocol));
@@ -122,11 +142,65 @@
            redisUtil.set(RedisKeyType.DEVICE_LOG_KEY.key + System.currentTimeMillis(), deviceDataLog, 60 * 60 * 24);
            rgvProtocol.setDeviceDataLog(System.currentTimeMillis());
        }

        try {
            BasRgvErrLogService errLogService = SpringUtils.getBean(BasRgvErrLogService.class);
            if (errLogService != null) {
                String errFlagKey = RedisKeyType.DEVICE_ERR_ACTIVE_RGV.key + rgvProtocol.getRgvNo();
                Object active = redisUtil.get(errFlagKey);
                if (rgvProtocol.getAlarm() != null && rgvProtocol.getAlarm() > 0) {
                    if (active == null) {
                        BasRgvErrLog log = new BasRgvErrLog();
                        log.setTaskNo(rgvProtocol.getTaskNo());
                        log.setStartTime(new Date());
                        log.setRgvNo(rgvProtocol.getRgvNo());
                        log.setErrCode(rgvProtocol.getAlarm());
                        log.setStatus(1);
                        log.setCreateTime(new Date());
                        log.setSystemStatus(JSON.toJSONString(rgvProtocol));
                        errLogService.insert(log);
                        if (log.getId() != null) {
                            redisUtil.set(errFlagKey, log.getId(), 60 * 60 * 24);
                        }
                    }
                } else {
                    if (active != null) {
                        Long id = Long.valueOf(String.valueOf(active));
                        BasRgvErrLog update = new BasRgvErrLog();
                        update.setId(id);
                        update.setEndTime(new Date());
                        update.setStatus(2);
                        update.setUpdateTime(new Date());
                        errLogService.updateById(update);
                        redisUtil.del(errFlagKey);
                    }
                }
            }
        } catch (Exception ignore) {}

        BasRgvService basRgvService = null;
        try {
            basRgvService = SpringUtils.getBean(BasRgvService.class);
        } catch (Exception e) {

        }
        if (basRgvService != null) {
            BasRgv basRgv = basRgvService.selectOne(new EntityWrapper<BasRgv>().eq("rgv_no", deviceConfig.getDeviceNo()));
            if(basRgv == null) {
                basRgv = new BasRgv();
                basRgv.setRgvNo(deviceConfig.getDeviceNo());
                basRgv.setStatus(1);
                basRgv.setCreateTime(new Date());
                basRgvService.insert(basRgv);
            }
        }
    }

    @Override
    public void close() {
        zyRgvConnectDriver.close();
        if (zyRgvConnectDriver != null) {
            zyRgvConnectDriver.close();
        }
    }

    @Override
@@ -135,13 +209,25 @@
    }

    @Override
    public RgvCommand getTransportCommand(Integer taskNo, Integer rgvNo, Integer sourcePos, Integer targetPos) {
        RgvCommand cmd = new RgvCommand();
        cmd.setRgvNo(rgvNo);
        cmd.setTaskNo(taskNo);
        cmd.setTaskMode(RgvTaskModeType.FETCH_PUT.id);
        cmd.setSourcePos(sourcePos);
        cmd.setTargetPos(targetPos);
        cmd.setCommand(1);
        return cmd;
    }

    @Override
    public RgvCommand getMoveCommand(Integer taskNo, Integer rgvNo, Integer targetPos) {
        RgvCommand cmd = new RgvCommand();
        cmd.setRgvNo(rgvNo);
        cmd.setTaskNo(taskNo.shortValue());
        cmd.setTaskMode((short) 1);
        cmd.setTargetPos(targetPos.shortValue());
        cmd.setCommand((short) 1);
        cmd.setTaskNo(taskNo);
        cmd.setTaskMode(RgvTaskModeType.X_MOVE.id);
        cmd.setTargetPos(targetPos);
        cmd.setCommand(1);
        return cmd;
    }

@@ -149,16 +235,41 @@
    public RgvCommand getResetCommand(Integer rgvNo) {
        RgvCommand cmd = new RgvCommand();
        cmd.setRgvNo(rgvNo);
        cmd.setTaskNo((short) 0);
        cmd.setAckFinish((short) 1);
        cmd.setTaskMode((short) 0);
        cmd.setCommand((short) 1);
        cmd.setTaskNo(0);
        cmd.setAckFinish(1);
        cmd.setTaskMode(0);
        cmd.setCommand(1);
        return cmd;
    }

    @Override
    public synchronized CommandResponse sendCommand(RgvCommand command) {
        rgvProtocol.setLastCommandTime(System.currentTimeMillis());
        return zyRgvConnectDriver.sendCommand(command);
        CommandResponse response = null;
        try {
            response = zyRgvConnectDriver.sendCommand(command);
            return response;
        } finally {
            BasRgvOptService bean = SpringUtils.getBean(BasRgvOptService.class);
            ZyRgvStatusEntity statusEntity = zyRgvConnectDriver.getStatus();
            BasRgvOpt basRgvOpt = new BasRgvOpt(
                    command.getTaskNo(),
                    command.getRgvNo(),
                    new Date(),
                    String.valueOf(command.getTaskMode()),
                    String.valueOf(command.getSourcePos()),
                    String.valueOf(command.getTargetPos()),
                    null,
                    null,
                    null,
                    JSON.toJSONString(command),
                    JSON.toJSONString(statusEntity),
                    1,
                    JSON.toJSONString(response)
            );
            if (bean != null) {
                bean.insert(basRgvOpt);
            }
        }
    }
}
}