| | |
| | | public class SiemensDevpThread implements Runnable, DevpThread { |
| | | |
| | | public static final ArrayList<Integer> staNos1 = new ArrayList<Integer>() {{ |
| | | add(100); |
| | | add(101); |
| | | add(102); |
| | | add(103); |
| | |
| | | add(118); |
| | | add(119); |
| | | add(120); |
| | | add(121); |
| | | add(122); |
| | | add(123); |
| | | add(124); |
| | | add(125); |
| | | add(1001); |
| | | add(1002); |
| | | add(1003); |
| | | add(1004); |
| | | |
| | | add(201); |
| | | add(202); |
| | | add(203); |
| | | add(204); |
| | | add(205); |
| | | add(206); |
| | | add(207); |
| | | add(208); |
| | | add(209); |
| | | add(210); |
| | | add(211); |
| | | add(212); |
| | | add(213); |
| | | add(214); |
| | | add(215); |
| | | add(216); |
| | | add(217); |
| | | }}; |
| | | |
| | | public static final ArrayList<Integer> staNos2 = new ArrayList<Integer>() {{ |
| | | add(301); |
| | | add(302); |
| | | add(303); |
| | | add(304); |
| | | add(305); |
| | | add(306); |
| | | add(307); |
| | | add(308); |
| | | }}; |
| | | /** |
| | | * 入出库模式 |
| | |
| | | private DevpSlave slave; |
| | | private SiemensS7Net siemensS7Net; |
| | | private Map<Integer, StaProtocol> station = new ConcurrentHashMap<>(); |
| | | /*public static final ArrayList<Integer> staNos2 = new ArrayList<Integer>() {{ |
| | | add(200);add(201);add(202);add(203); |
| | | add(204);add(205);add(206);add(207); |
| | | add(208);add(209);add(210);add(211); |
| | | add(212);add(213);add(214);add(215); |
| | | add(216);add(217);add(218);add(219); |
| | | add(220);add(221);add(222);add(223); |
| | | add(224);add(225);add(226);add(227); |
| | | add(228);add(229);add(230);add(231); |
| | | add(232);add(233);add(234);add(235); |
| | | }}; |
| | | public static final ArrayList<Integer> staNos3 = new ArrayList<Integer>() {{ |
| | | add(300);add(301);add(302);add(303); |
| | | add(304);add(305);add(306);add(307); |
| | | }}; |
| | | public static final ArrayList<Integer> staNos4 = new ArrayList<Integer>() {{ |
| | | add(400);add(401);add(402);add(403); |
| | | add(404);add(405);add(406);add(407); |
| | | }};*/ |
| | | private short heartBeatVal = 1; |
| | | |
| | | /** |
| | | * 条码数量 |
| | | */ |
| | | private int barcodeSize = 1; |
| | | private int barcodeSize = 8; |
| | | |
| | | public SiemensDevpThread(DevpSlave slave) { |
| | | this.slave = slave; |
| | |
| | | switch (slave.getId()) { |
| | | case 1: |
| | | return staNos1; |
| | | /*case 2: |
| | | case 2: |
| | | return staNos2; |
| | | case 3: |
| | | return staNos3; |
| | | case 4: |
| | | return staNos4;*/ |
| | | default: |
| | | throw new CoolException("服务器异常"); |
| | | } |
| | |
| | | write((StaProtocol) task.getData()); |
| | | read(); |
| | | break; |
| | | // 写数据 ID+目标站 |
| | | case 4: |
| | | writeAgvOk((StaProtocol) task.getData()); |
| | | read(); |
| | | break; |
| | | /* case 3: |
| | | write2((StaProtocol)task.getData()); |
| | | read(); |
| | | break;*/ |
| | | default: |
| | | break; |
| | | } |
| | | // 心跳 |
| | | // heartbeat(); |
| | | Thread.sleep(400); |
| | | } catch (Exception e) { |
| | | e.printStackTrace(); |
| | |
| | | } |
| | | } |
| | | |
| | | // OperateResultExOne<byte[]> resultAgvAndPlc = siemensS7Net.Read("DB102.0", (short) 30); |
| | | // if (resultAgvAndPlc.IsSuccess) { |
| | | // for (int i = 0; i < staNoSize; i++) { |
| | | // int sign =(i+2)/2-1; |
| | | // if ((i+2)%2!=0){ |
| | | // Integer siteId = staNos.get(i); // 站点编号 |
| | | // StaProtocol staProtocol = station.get(siteId); |
| | | // if (null == staProtocol) { |
| | | // staProtocol = new StaProtocol(); |
| | | // staProtocol.setSiteId(siteId); |
| | | // station.put(siteId, staProtocol); |
| | | // } |
| | | // staProtocol.setAgvStartPick(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlc.Content, sign*6+4)); // 允许取货 |
| | | // staProtocol.setAgvStartPlace((short)0); // 允许放货 |
| | | // continue; |
| | | // } |
| | | // Integer siteId = staNos.get(i); // 站点编号 |
| | | // StaProtocol staProtocol = station.get(siteId); |
| | | // if (null == staProtocol) { |
| | | // staProtocol = new StaProtocol(); |
| | | // staProtocol.setSiteId(siteId); |
| | | // station.put(siteId, staProtocol); |
| | | // } |
| | | // staProtocol.setAgvStartPick(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlc.Content, sign*6)); // 允许取货 |
| | | // staProtocol.setAgvStartPlace(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlc.Content, sign*6 + 2)); // 允许放货 |
| | | // } |
| | | // } |
| | | |
| | | // OperateResultExOne<byte[]> resultAgvAndPlcOk = siemensS7Net.Read("DB132.0", (short) 30); |
| | | // if (resultAgvAndPlcOk.IsSuccess) { |
| | | // for (int i = 0; i < staNoSize; i++) { |
| | | // int sign =(i+2)/2-1; |
| | | // if ((i+2)%2!=0){ |
| | | // Integer siteId = staNos.get(i); // 站点编号 |
| | | // StaProtocol staProtocol = station.get(siteId); |
| | | // if (null == staProtocol) { |
| | | // staProtocol = new StaProtocol(); |
| | | // staProtocol.setSiteId(siteId); |
| | | // station.put(siteId, staProtocol); |
| | | // } |
| | | // staProtocol.setAgvTargetPick(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlcOk.Content, sign*6+4)); // 允许取货 |
| | | // staProtocol.setAgvTargetPlace((short)0); // 允许放货 |
| | | // continue; |
| | | // } |
| | | // Integer siteId = staNos.get(i); // 站点编号 |
| | | // StaProtocol staProtocol = station.get(siteId); |
| | | // if (null == staProtocol) { |
| | | // staProtocol = new StaProtocol(); |
| | | // staProtocol.setSiteId(siteId); |
| | | // station.put(siteId, staProtocol); |
| | | // } |
| | | // try{ |
| | | // staProtocol.setAgvTargetPick(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlcOk.Content, sign*6)); // 取货完成 |
| | | // if (staProtocol.getAgvTargetPick()!=0){ |
| | | // System.out.println(staProtocol.getAgvTargetPick()); |
| | | // } |
| | | // staProtocol.setAgvTargetPlace(siemensS7Net.getByteTransform().TransInt16(resultAgvAndPlcOk.Content, sign*6 + 2)); // 放货完成 |
| | | // if (staProtocol.getAgvTargetPlace()!=0){ |
| | | // System.out.println(staProtocol.getAgvTargetPlace()); |
| | | // } |
| | | // }catch (Exception e){ |
| | | // log.error(""+e); |
| | | // } |
| | | // } |
| | | // } |
| | | |
| | | |
| | | if (slave.getId() == 1) { |
| | | //条码 |
| | |
| | | } |
| | | |
| | | |
| | | // //RGV台车位置 |
| | | // Thread.sleep(200); |
| | | // OperateResultExOne<byte[]> result3 = siemensS7Net.Read("DB100.0",(short)4); |
| | | // if (result3.IsSuccess) { |
| | | // for (int i = 0; i < 2; i++) { |
| | | // Integer siteId = i==0 ? 1 : 2; // 站点编号 |
| | | // StaProtocol staProtocol = station.get(siteId); |
| | | // if (null == staProtocol) { |
| | | // staProtocol = new StaProtocol(); |
| | | // staProtocol.setSiteId(siteId); |
| | | // station.put(siteId, staProtocol); |
| | | // } |
| | | // staProtocol.setNearbySta(String.valueOf(siemensS7Net.getByteTransform().TransInt16(result3.Content, i*2))); |
| | | //// String aa = staProtocol.getNearbySta(); |
| | | //// System.out.println(siteId + "===>>" + staProtocol.getNearbySta()); |
| | | // } |
| | | // } |
| | | |
| | | // OperateResultExOne<Short> result2 = siemensS7Net.ReadInt16("DB200.0"); |
| | | // if (result2.IsSuccess) { |
| | | // this.ioMode = IoModeType.get(result2.Content); |
| | | // } |
| | | |
| | | if (result.IsSuccess) { |
| | | |
| | | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】[id:{1}] <<<<< 实时数据更新成功", DateUtils.convert(new Date()), slave.getId())); |
| | |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * 写入 ID+目标站 =====> 单站点写入 |
| | | */ |
| | | private void writeAgvOk(StaProtocol staProtocol) throws InterruptedException { |
| | | if (null == staProtocol) { |
| | | return; |
| | | } |
| | | ArrayList<Integer> staNos = getStaNo(); |
| | | int index = staNos.indexOf(staProtocol.getSiteId()); |
| | | if (staProtocol.getAgvTypeSign() == 0 || staProtocol.getAgvTypeSign() == 2) { //0取货 |
| | | switch (staProtocol.getSiteId()) { |
| | | case 100: |
| | | index = 32; |
| | | break; |
| | | case 101: |
| | | index = 34; |
| | | break; |
| | | case 102: |
| | | index = 38; |
| | | break; |
| | | case 103: |
| | | index = 40; |
| | | break; |
| | | case 104: |
| | | index = 44; |
| | | break; |
| | | case 105: |
| | | index = 46; |
| | | break; |
| | | case 106: |
| | | index = 50; |
| | | break; |
| | | case 107: |
| | | index = 52; |
| | | break; |
| | | default: |
| | | return; |
| | | } |
| | | } else { |
| | | switch (staProtocol.getSiteId()) { |
| | | case 100: |
| | | index = 30; |
| | | break; |
| | | case 102: |
| | | index = 36; |
| | | break; |
| | | case 104: |
| | | index = 42; |
| | | break; |
| | | case 106: |
| | | index = 48; |
| | | break; |
| | | default: |
| | | return; |
| | | } |
| | | } |
| | | |
| | | OperateResult write = null; |
| | | //任务下发次数 |
| | | int writeCount = 0; |
| | | do { |
| | | short textWrite = 1;// 任务完成 |
| | | if (staProtocol.getAgvTypeSign() > 1) { |
| | | textWrite = 0;// 任务复位 |
| | | } |
| | | write = siemensS7Net.Write("DB102." + index, textWrite); |
| | | if (write.IsSuccess) { |
| | | writeCount = 6; |
| | | } else { |
| | | writeCount++; |
| | | log.error("写入输送线取放货完成命令后读取失败。输送线plc编号={},站点数据={},写入次数={}", slave.getId(), JSON.toJSON(staProtocol), writeCount); |
| | | } |
| | | } while (writeCount < 5); |
| | | |
| | | if (!write.IsSuccess) { |
| | | OutputQueue.DEVP.offer(MessageFormat.format("【{0}】写入输送线站点数据失败。输送线plc编号={1},站点数据={2}", slave.getId(), JSON.toJSON(staProtocol))); |
| | | log.error("写入输送线取放货完成站点数据失败。输送线plc编号={},站点数据={}", slave.getId(), JSON.toJSON(staProtocol)); |
| | | } 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 write(StaProtocol staProtocol) throws InterruptedException { |
| | | if (null == staProtocol) { |
| | |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * 心跳 |
| | | */ |
| | | private void heartbeat() { |
| | | if (heartBeatVal == 1) { |
| | | heartBeatVal = 2; |
| | | } else { |
| | | heartBeatVal = 1; |
| | | } |
| | | OperateResult write = siemensS7Net.Write("DB100.50", heartBeatVal); |
| | | if (!write.IsSuccess) { |
| | | log.error("输送线plc编号={} 心跳失败", slave.getId()); |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * 设置入库标记 |