|  |  |  | 
|---|
|  |  |  | import HslCommunication.Profinet.Siemens.SiemensPLCS; | 
|---|
|  |  |  | import HslCommunication.Profinet.Siemens.SiemensS7Net; | 
|---|
|  |  |  | import com.alibaba.fastjson.JSON; | 
|---|
|  |  |  | import com.core.common.Cools; | 
|---|
|  |  |  | import com.core.common.DateUtils; | 
|---|
|  |  |  | import com.core.common.SpringUtils; | 
|---|
|  |  |  | import com.google.common.base.Utf8; | 
|---|
|  |  |  | import com.sun.xml.internal.bind.v2.runtime.output.Encoded; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasDevp; | 
|---|
|  |  |  | import com.zy.asrs.service.BasDevpService; | 
|---|
|  |  |  | import com.zy.asrs.service.WrkMastService; | 
|---|
|  |  |  | import com.zy.core.DevpThread; | 
|---|
|  |  |  | import com.zy.core.Slave; | 
|---|
|  |  |  | import com.zy.core.cache.MessageQueue; | 
|---|
|  |  |  | import com.zy.core.cache.OutputQueue; | 
|---|
|  |  |  | import com.zy.core.cache.SlaveConnection; | 
|---|
|  |  |  | import com.zy.core.enums.IoModeType; | 
|---|
|  |  |  | import com.zy.core.enums.SlaveType; | 
|---|
|  |  |  | import com.zy.core.model.DevpSlave; | 
|---|
|  |  |  | import com.zy.core.model.Task; | 
|---|
|  |  |  | import com.zy.core.model.protocol.StaProtocol; | 
|---|
|  |  |  | import lombok.Data; | 
|---|
|  |  |  | import lombok.extern.slf4j.Slf4j; | 
|---|
|  |  |  | import org.springframework.beans.factory.annotation.Autowired; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import java.text.MessageFormat; | 
|---|
|  |  |  | import java.util.ArrayList; | 
|---|
|  |  |  | 
|---|
|  |  |  | private SiemensS7Net siemensS7Net; | 
|---|
|  |  |  | private Map<Integer, StaProtocol> station = new ConcurrentHashMap<>(); | 
|---|
|  |  |  | private short heartBeatVal = 1; | 
|---|
|  |  |  | public static final ArrayList<Integer> staNos = new ArrayList<Integer>() {{ | 
|---|
|  |  |  | add(101);add(102);add(103);add(104); | 
|---|
|  |  |  | add(201);add(202);add(203);add(204); | 
|---|
|  |  |  | add(301);add(302);add(303);add(304);add(305);add(306); | 
|---|
|  |  |  | }}; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 条码数量 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | private int barcodeSize = 1; | 
|---|
|  |  |  | public IoModeType ioMode = IoModeType.NONE; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public SiemensDevpThread(DevpSlave slave) { | 
|---|
|  |  |  | this.slave = slave; | 
|---|
|  |  |  | 
|---|
|  |  |  | default: | 
|---|
|  |  |  | break; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | // 心跳 | 
|---|
|  |  |  | heartbeat(); | 
|---|
|  |  |  | //                heartbeat(); | 
|---|
|  |  |  | Thread.sleep(400); | 
|---|
|  |  |  | } catch (Exception e) { | 
|---|
|  |  |  | e.printStackTrace(); | 
|---|
|  |  |  | 
|---|
|  |  |  | * 读取状态 ====> 整块plc | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | private void read() throws InterruptedException { | 
|---|
|  |  |  | OperateResultExOne<byte[]> result = siemensS7Net.Read("DB100.0", (short) 40); | 
|---|
|  |  |  | //        // 更新入出库模式 | 
|---|
|  |  |  | //        updateIoMode(); | 
|---|
|  |  |  | int staNoSize = staNos.size(); | 
|---|
|  |  |  | OperateResultExOne<byte[]> result = siemensS7Net.Read("DB100.0", (short) (staNoSize*4)); | 
|---|
|  |  |  | if (result.IsSuccess) { | 
|---|
|  |  |  | for (int i = 1; i <= 8; i++) { | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(i); | 
|---|
|  |  |  | for (int i = 0; i < staNoSize; i++) { | 
|---|
|  |  |  | Integer siteId = staNos.get(i); // 站点编号 | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(siteId); | 
|---|
|  |  |  | if (null == staProtocol) { | 
|---|
|  |  |  | staProtocol = new StaProtocol(); | 
|---|
|  |  |  | staProtocol.setSiteId(i); | 
|---|
|  |  |  | station.put(i, staProtocol); | 
|---|
|  |  |  | staProtocol.setSiteId(siteId); | 
|---|
|  |  |  | station.put(siteId, staProtocol); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | staProtocol.setWorkNo(siemensS7Net.getByteTransform().TransInt16(result.Content, (i-1)*2));     // 工作号 | 
|---|
|  |  |  | staProtocol.setStaNo(siemensS7Net.getByteTransform().TransInt16(result.Content, (i-1)*2+20));   // 目标站 | 
|---|
|  |  |  | staProtocol.setWorkNo(siemensS7Net.getByteTransform().TransInt16(result.Content, i*4));     // 工作号 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | staProtocol.setStaNo(siemensS7Net.getByteTransform().TransInt16(result.Content, i*4 + 2));   // 目标站 | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | Thread.sleep(100); | 
|---|
|  |  |  | OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB100.40", (short) 8); | 
|---|
|  |  |  | //        Thread.sleep(200); | 
|---|
|  |  |  | //        OperateResultExOne<byte[]> result0 = siemensS7Net.Read("DB101.0", (short) 186); | 
|---|
|  |  |  | //        if (result0.IsSuccess) { | 
|---|
|  |  |  | //            for (int i = 0; i < 93; i++) { | 
|---|
|  |  |  | //                Integer siteId = staNos.get(i); // 站点编号 | 
|---|
|  |  |  | //                StaProtocol staProtocol = station.get(siteId); | 
|---|
|  |  |  | //                if (null == staProtocol) { | 
|---|
|  |  |  | //                    staProtocol = new StaProtocol(); | 
|---|
|  |  |  | //                    staProtocol.setSiteId(siteId); | 
|---|
|  |  |  | //                    station.put(siteId, staProtocol); | 
|---|
|  |  |  | //                } | 
|---|
|  |  |  | //                staProtocol.setStaNo(siemensS7Net.getByteTransform().TransInt16(result0.Content, i*2));   // 目标站 | 
|---|
|  |  |  | //            } | 
|---|
|  |  |  | //        } | 
|---|
|  |  |  | Thread.sleep(200); | 
|---|
|  |  |  | OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB150.0", (short) (staNoSize*2)); | 
|---|
|  |  |  | if (result1.IsSuccess) { | 
|---|
|  |  |  | for (int i = 1; i <= 8; i++) { | 
|---|
|  |  |  | boolean[] status = siemensS7Net.getByteTransform().TransBool(result1.Content, i-1, 1); | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(i); | 
|---|
|  |  |  | for (int i = 0; i < staNoSize; i++) { | 
|---|
|  |  |  | Integer siteId = staNos.get(i); // 站点编号 | 
|---|
|  |  |  | boolean[] status = siemensS7Net.getByteTransform().TransBool(result1.Content, i*2, 1); | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(siteId); | 
|---|
|  |  |  | staProtocol.setAutoing(status[0]);  // 自动 | 
|---|
|  |  |  | staProtocol.setLoading(status[1]);  // 有物 | 
|---|
|  |  |  | staProtocol.setInEnable(status[2]); // 可入 | 
|---|
|  |  |  | staProtocol.setOutEnable(status[3]);// 可出 | 
|---|
|  |  |  | staProtocol.setEmptyMk(status[4]);  // 空板信号 | 
|---|
|  |  |  | staProtocol.setFullPlt(status[5]);  // 满托盘 | 
|---|
|  |  |  | staProtocol.setHigh(status[6]);     // 高库位 | 
|---|
|  |  |  | staProtocol.setLow(status[7]);      // 低库位 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (!staProtocol.isPakMk() && !staProtocol.isLoading()) { | 
|---|
|  |  |  | staProtocol.setPakMk(true); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | // 台车位置 | 
|---|
|  |  |  | OperateResultExOne<Short> result2 = siemensS7Net.ReadInt16("DB100.48"); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | Thread.sleep(200); | 
|---|
|  |  |  | OperateResultExOne<byte[]> result2 = siemensS7Net.Read("DB100.190",(short)(barcodeSize*8)); | 
|---|
|  |  |  | if (result2.IsSuccess) { | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(8); | 
|---|
|  |  |  | staProtocol.setPosition(result2.Content); | 
|---|
|  |  |  | } else { | 
|---|
|  |  |  | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】8号台车获取实时位置失败!!!", DateUtils.convert(new Date()))); | 
|---|
|  |  |  | log.error("8号台车获取实时位置失败!!!"); | 
|---|
|  |  |  | for (int i = 0; i < barcodeSize; i++) { | 
|---|
|  |  |  | 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); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //        OperateResultExOne<Short> result2 = siemensS7Net.ReadInt16("DB200.0"); | 
|---|
|  |  |  | //        if (result2.IsSuccess) { | 
|---|
|  |  |  | //            this.ioMode = IoModeType.get(result2.Content); | 
|---|
|  |  |  | //        } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (result.IsSuccess && result1.IsSuccess) { | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | // 根据实时信息更新数据库 | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | List<BasDevp> basDevps = new ArrayList<>(); | 
|---|
|  |  |  | for (int i = 1; i <= 8; i++) { | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(i); | 
|---|
|  |  |  | for (Integer siteId : staNos) { | 
|---|
|  |  |  | StaProtocol staProtocol = station.get(siteId); | 
|---|
|  |  |  | basDevps.add(staProtocol.toSqlModel()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasDevpService basDevpService = SpringUtils.getBean(BasDevpService.class); | 
|---|
|  |  |  | if (!basDevpService.updateBatchById(basDevps)) { | 
|---|
|  |  |  | if (null != basDevpService && !basDevpService.updateBatchById(basDevps)) { | 
|---|
|  |  |  | throw new Exception("更新数据库数据失败"); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } catch (Exception e) { | 
|---|
|  |  |  | e.printStackTrace(); | 
|---|
|  |  |  | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】更新数据库数据失败 ===>> [id:{1}] [ip:{2}] [port:{3}] [rack:{4}] [slot:{5}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot())); | 
|---|
|  |  |  | log.error("更新数据库数据失败 ===>> [id:{}] [ip:{}] [port:{}] [rack:{}] [slot:{}]", slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } else { | 
|---|
|  |  |  | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】读取输送线plc状态信息失败 ===>> [id:{1}] [ip:{2}] [port:{3}] [rack:{4}] [slot:{5}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot())); | 
|---|
|  |  |  | log.error("读取堆垛机plc状态信息失败 ===>> [id:{}] [ip:{}] [port:{}] [rack:{}] [slot:{}]", slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot()); | 
|---|
|  |  |  | //            log.error("读取输送线plc状态信息失败 ===>> [id:{}] [ip:{}] [port:{}] [rack:{}] [slot:{}]", slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | if (null == staProtocol) { | 
|---|
|  |  |  | return; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | OperateResult write = siemensS7Net.Write("DB100." + (staProtocol.getSiteId() - 1) * 2, staProtocol.getWorkNo());    // 工作号 | 
|---|
|  |  |  | Thread.sleep(300); | 
|---|
|  |  |  | OperateResult write1 = siemensS7Net.Write("DB100." + ((staProtocol.getSiteId() - 1) * 2 + 20), staProtocol.getStaNo());    // 目标站 | 
|---|
|  |  |  | //        boolean[] status = new boolean[8]; | 
|---|
|  |  |  | //        status[0] = staProtocol.isAutoing(); | 
|---|
|  |  |  | //        status[1] = staProtocol.isLoading(); | 
|---|
|  |  |  | //        status[2] = staProtocol.isInEnable(); | 
|---|
|  |  |  | //        status[3] = staProtocol.isOutEnable(); | 
|---|
|  |  |  | //        status[4] = staProtocol.isEmptyMk(); | 
|---|
|  |  |  | //        OperateResult write2 = siemensS7Net.Write("DB100." + ((staProtocol.getSiteId() - 1) + 40), status);     //  状态 | 
|---|
|  |  |  | if (!write.IsSuccess || !write1.IsSuccess) { | 
|---|
|  |  |  | int index = staNos.indexOf(staProtocol.getSiteId()); | 
|---|
|  |  |  | short[] array = new short[10]; | 
|---|
|  |  |  | array[0] = staProtocol.getWorkNo(); | 
|---|
|  |  |  | array[1] = staProtocol.getStaNo(); | 
|---|
|  |  |  | OperateResult write = siemensS7Net.Write("DB100." + index*4, array); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //        OperateResult write = siemensS7Net.Write("DB100." + index*2, staProtocol.getWorkNo());    // 工作号 | 
|---|
|  |  |  | //        Thread.sleep(500); | 
|---|
|  |  |  | //        OperateResult write1 = siemensS7Net.Write("DB101." + index*2, staProtocol.getStaNo());    // 目标站 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (!write.IsSuccess) { | 
|---|
|  |  |  | staProtocol = station.get(staProtocol.getSiteId()); | 
|---|
|  |  |  | if (staProtocol.getWorkNo() == 0 && staProtocol.getStaNo() ==0) { | 
|---|
|  |  |  | staProtocol.setPakMk(true); | 
|---|
|  |  |  | 
|---|
|  |  |  | } else { | 
|---|
|  |  |  | 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)); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | // 更新入出库模式 | 
|---|
|  |  |  | private void updateIoMode() throws InterruptedException { | 
|---|
|  |  |  | if (this.ioMode != IoModeType.NONE) { | 
|---|
|  |  |  | if (!siemensS7Net.Write("DB200", this.ioMode.id).IsSuccess) { | 
|---|
|  |  |  | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线1F入出库模式失败。输送线plc编号={1}", slave.getId())); | 
|---|
|  |  |  | log.error("写入输送线1F入出库模式失败。输送线plc编号={}", slave.getId()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | siemensS7Net.ConnectClose(); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public static void main(String[] args) throws Exception { | 
|---|
|  |  |  | DevpSlave slave = new DevpSlave(); | 
|---|
|  |  |  | slave.setIp("192.168.2.125"); | 
|---|
|  |  |  | SiemensDevpThread devpThread = new SiemensDevpThread(slave); | 
|---|
|  |  |  | devpThread.connect(); | 
|---|
|  |  |  | devpThread.read(); | 
|---|
|  |  |  | // 写 | 
|---|
|  |  |  | StaProtocol staProtocol = devpThread.getStation().get(1); | 
|---|
|  |  |  | staProtocol.setWorkNo((short) 232); | 
|---|
|  |  |  | staProtocol.setStaNo((short) 6); | 
|---|
|  |  |  | staProtocol.setAutoing(true); | 
|---|
|  |  |  | staProtocol.setEmptyMk(true); | 
|---|
|  |  |  | staProtocol.setInEnable(true); | 
|---|
|  |  |  | devpThread.write(staProtocol); | 
|---|
|  |  |  | System.out.println("----------------------------------------"); | 
|---|
|  |  |  | // 读 | 
|---|
|  |  |  | devpThread.read(); | 
|---|
|  |  |  | System.out.println(JSON.toJSONString(devpThread.station)); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public static void main(String[] args) { | 
|---|
|  |  |  | System.out.println(staNos.indexOf(129)); | 
|---|
|  |  |  | System.out.println(staNos.size()); | 
|---|
|  |  |  | for (int i = 0; i<staNos.size(); i++) { | 
|---|
|  |  |  | //            System.out.println(i*2); | 
|---|
|  |  |  | //            System.out.println(i*2 + 200); | 
|---|
|  |  |  | //            System.out.println(i); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | int index = staNos.indexOf(128); | 
|---|
|  |  |  | System.out.println(index*2); | 
|---|
|  |  |  | System.out.println(index*2 + 200); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //    public static void main(String[] args) throws Exception { | 
|---|
|  |  |  | //        DevpSlave slave = new DevpSlave(); | 
|---|
|  |  |  | //        slave.setIp("192.168.2.125"); | 
|---|
|  |  |  | //        SiemensDevpThread devpThread = new SiemensDevpThread(slave); | 
|---|
|  |  |  | //        devpThread.connect(); | 
|---|
|  |  |  | //        devpThread.read(); | 
|---|
|  |  |  | //        // 写 | 
|---|
|  |  |  | //        StaProtocol staProtocol = devpThread.getStation().get(1); | 
|---|
|  |  |  | //        staProtocol.setWorkNo((short) 232); | 
|---|
|  |  |  | //        staProtocol.setStaNo((short) 6); | 
|---|
|  |  |  | //        staProtocol.setAutoing(true); | 
|---|
|  |  |  | //        staProtocol.setEmptyMk(true); | 
|---|
|  |  |  | //        staProtocol.setInEnable(true); | 
|---|
|  |  |  | //        devpThread.write(staProtocol); | 
|---|
|  |  |  | //        System.out.println("----------------------------------------"); | 
|---|
|  |  |  | //        // 读 | 
|---|
|  |  |  | //        devpThread.read(); | 
|---|
|  |  |  | //        System.out.println(JSON.toJSONString(devpThread.station)); | 
|---|
|  |  |  | // | 
|---|
|  |  |  | //    } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } | 
|---|