From fe783a3ae2295dba85fd9775b610eb13e4e41f00 Mon Sep 17 00:00:00 2001 From: cpT <1@123> Date: 星期二, 24 六月 2025 22:36:37 +0800 Subject: [PATCH] #改造 --- src/main/java/com/zy/core/thread/RgvThread.java | 555 ++++++++++++++++++++++++++++++++++++++++++------------ 1 files changed, 428 insertions(+), 127 deletions(-) diff --git a/src/main/java/com/zy/core/thread/RgvThread.java b/src/main/java/com/zy/core/thread/RgvThread.java index 723c1c1..70700dc 100644 --- a/src/main/java/com/zy/core/thread/RgvThread.java +++ b/src/main/java/com/zy/core/thread/RgvThread.java @@ -25,10 +25,7 @@ import com.zy.core.model.RgvSlave; import com.zy.core.model.Task; import com.zy.core.model.command.RgvCommand; -import com.zy.core.model.protocol.RgvProtocol; -import com.zy.core.model.protocol.RgvTaskProtocol; -import com.zy.core.model.protocol.StaProtocol; -import com.zy.core.model.protocol.TaskProtocol; +import com.zy.core.model.protocol.*; import lombok.Data; import lombok.extern.slf4j.Slf4j; import org.springframework.beans.factory.annotation.Value; @@ -56,6 +53,7 @@ private Long trackBenchmark = 1L; // # 閬胯璺濈 private Long avoidDistance = 5000L; + private String errorRgv = "-"; /** * 宸ヤ綅1澶嶄綅淇″彿 @@ -67,7 +65,10 @@ private boolean resetFlag2 = false; private boolean connectRgv = false; + public Long currentTimeMilliConnectRgv= 0L; + private boolean delRgvTask = false; + private short wrkSign = 0; public RgvThread(RgvSlave slave) { this.slave = slave; @@ -76,6 +77,12 @@ @Override @SuppressWarnings("InfiniteLoopStatement") public void run() { + initRgv(); + try{ + Thread.sleep(2000); + } catch (Exception e){ + + } connectRgv = this.connect(); while(!connectRgv){ try { @@ -96,7 +103,7 @@ new Thread(this::taskIssued).start(); // 鍚姩婕父绾跨▼ -// new Thread(this::taskWalkIssued).start(); + new Thread(this::taskWalkIssued).start(); // new Thread(this::taskWalkIssued2).start(); // 鍚姩浠诲姟瀹屾垚绾跨▼ @@ -106,6 +113,7 @@ private void rgvConnect() { while (true) { try { + Thread.sleep(1000); if(!connectRgv){ try { connectRgv = this.connect(); @@ -120,7 +128,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "rgv杩炴帴澶辫触"+e.getMessage()); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } initRgv(); // e.printStackTrace(); @@ -131,7 +139,17 @@ private void readStatusRgv() { while (true) { try { + if(!connectRgv){ + try { + Thread.sleep(1000L); + } catch (Exception e){ + + } + initRgv(); + continue; + } Thread.sleep(20); +// System.out.println("璇荤嚎绋�,灏忚溅鍙�"+ slave.getId()+"鏃堕棿鎴筹細"+System.currentTimeMillis()); readStatus(); @@ -141,7 +159,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV鏁版嵁璇诲彇绾跨▼寮傚父"+e.getMessage()); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } initRgv(); // e.printStackTrace(); @@ -157,15 +175,25 @@ private void taskComplete() { while (true) { try { + if(!connectRgv){ + try { + Thread.sleep(1000L); + } catch (Exception e){ + + } + continue; + } if (delRgvTask){ writeDelRgvTask(); delRgvTask = false; continue; } - Thread.sleep(40); + Thread.sleep(50L); + OperateResultExOne<byte[]> result = siemensNet.Read("DB100.12", (short) 1); boolean[] status = siemensNet.getByteTransform().TransBool(result.Content, 0, 1); if (status[0]){ + Thread.sleep(500L); OperateResult result4 = siemensNet.Write("DB100.12.0", false); } } catch (Exception e) { @@ -174,7 +202,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV鏁版嵁浠诲姟涓嬪彂澶嶄綅绾跨▼寮傚父"+e.getMessage()); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } initRgv(); // e.printStackTrace(); @@ -187,65 +215,65 @@ /** * 浠诲姟涓嬪彂 */ - private void taskWalkIssued2() { - while (true) { - try { - // 浼戠湢 1 绉� - Thread.sleep(100); - if (!deviceDetection()) { - continue; - } - RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); - RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); - if (rgvProtocol == null || rgvTaskProtocol == null) { - initRgv(); - rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); - rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); - } - if (rgvTaskProtocol.getAvoid() != 0) { - continue; - } - if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE)){ - continue; - } - if (rgvProtocol.getLoaded() == -1){ - continue; - } - - List<TaskProtocol> allTakeTaskProtocol = taskProtocolCache.getAllWalkTaskProtocol(); - for (TaskProtocol taskProtocol : allTakeTaskProtocol) { - if (taskProtocol.getIsRunning() == 1) {//鍑嗗涓嬪彂 - // 鍙岃溅 - if (rgvOtherStatusEnable()) { - //鍙︿竴鍙拌溅鏄惁鍏佽姝ゅ彴杞︽墽琛� - if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { - continue; - } - } - if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 - && taskProtocol.getTargetPosition()>=rgvProtocol.getRgvPos()-50){ - taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); - break; - } else { - TaskProtocol issued = new TaskProtocol(taskProtocol,true); - write(issued); - taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); - break; - } - } - } - } catch (Exception e) { - log.error("RGV浠诲姟涓嬪彂绾跨▼寮傚父锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); - try{ - DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); - deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV浠诲姟涓嬪彂绾跨▼寮傚父"+e.getMessage()); - } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); - } -// e.printStackTrace(); - } - } - } +// private void taskWalkIssued2() { +// while (true) { +// try { +// // 浼戠湢 1 绉� +// Thread.sleep(100); +// if (!deviceDetection()) { +// continue; +// } +// RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); +// RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); +// if (rgvProtocol == null || rgvTaskProtocol == null) { +// initRgv(); +// rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); +// rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); +// } +// if (rgvTaskProtocol.getAvoid() != 0) { +// continue; +// } +// if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE)){ +// continue; +// } +// if (rgvProtocol.getLoaded() == -1){ +// continue; +// } +// +// List<TaskProtocol> allTakeTaskProtocol = taskProtocolCache.getAllWalkTaskProtocol(); +// for (TaskProtocol taskProtocol : allTakeTaskProtocol) { +// if (taskProtocol.getIsRunning() == 1) {//鍑嗗涓嬪彂 +// // 鍙岃溅 +// if (rgvOtherStatusEnable()) { +// //鍙︿竴鍙拌溅鏄惁鍏佽姝ゅ彴杞︽墽琛� +// if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { +// continue; +// } +// } +// if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 +// && taskProtocol.getTargetPosition()>=rgvProtocol.getRgvPos()-50){ +// taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); +// break; +// } else { +// TaskProtocol issued = new TaskProtocol(taskProtocol,true); +// write(issued); +// taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); +// break; +// } +// } +// } +// } catch (Exception e) { +// log.error("RGV浠诲姟涓嬪彂绾跨▼寮傚父锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); +// try{ +// DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); +// deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV浠诲姟涓嬪彂绾跨▼寮傚父"+e.getMessage()); +// } catch (Exception e2){ +// log.error("e2:"+e2.getMessage()); +// } +//// e.printStackTrace(); +// } +// } +// } /** * 婕父 @@ -253,6 +281,14 @@ private void taskWalkIssued() { while (true) { try { + if(!connectRgv){ + try { + Thread.sleep(1000L); + } catch (Exception e){ + + } + continue; + } // 浼戠湢 1 绉� Thread.sleep(100); @@ -275,7 +311,7 @@ write(issued); rgvTaskProtocol.setAvoid(0); - Thread.sleep(200); +// Thread.sleep(200); RgvTaskCache.updateRgvStatus(rgvTaskProtocol); } catch (Exception e) { @@ -290,12 +326,39 @@ */ private void taskIssued() { while (true) { + if(!connectRgv){ + try { + Thread.sleep(1000L); + } catch (Exception e){ + + } + continue; + } + RgvRunProtocol rgvRun = RgvRunCache.getRgvRun(); + if (!rgvRun.getRgvNo().equals(slave.getId())){ + continue; + } try { + Thread.sleep(100); + rgvRun = RgvRunCache.getRgvRun(); +// System.out.println(JSON.toJSON(rgvRun)); + // 浼戠湢 1 绉� - Thread.sleep(50); - if (!deviceDetection()) { + if (System.currentTimeMillis() - rgvRun.currentTimeMilliOld > 500) { + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + } else { continue; } + if (!deviceDetection()) { + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); + if (!errorRgv.equals("鏃�")){ + RgvErrCache.updateRgvErr(slave.getId(),errorRgv); + } + continue; + } + RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); if (rgvProtocol == null || rgvTaskProtocol == null) { @@ -303,26 +366,23 @@ rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); } - if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE)){ + if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE) || (Math.abs(rgvProtocol.getRgvPos() - rgvProtocol.getRgvPosDestination())>100)){ + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); continue; } if (rgvProtocol.getLoaded() == -1){ + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); + RgvErrCache.updateRgvErr(slave.getId(),"灏忚溅鎺㈢墿鐗╃姸鎬佸紓甯�"); continue; } if (rgvTaskProtocol.getAvoid() != 0) { - if (rgvTaskProtocol.getAvoid() == 1) { - TaskProtocol issued = new TaskProtocol(); - issued.setTaskNo(32222L); - issued.setTargetPosition(rgvTaskProtocol.getAvoidingTheDestination()); - issued.setTaskStatus(1); - issued.setDirection(true); - write(issued); - rgvTaskProtocol.setAvoid(0); - - try{Thread.sleep(50L);} catch (Exception e){} - - RgvTaskCache.updateRgvStatus(rgvTaskProtocol); - } + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); continue; } @@ -335,21 +395,25 @@ if (rgvOtherStatusEnable()) { //鍙︿竴鍙拌溅鏄惁鍏佽姝ゅ彴杞︽墽琛� if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { - continue; + RgvErrCache.updateRgvErr(slave.getId(),errorRgv); + break; } } if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 && taskProtocol.getTargetPosition()>=rgvProtocol.getRgvPos()-50){ taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); + RgvErrCache.updateRgvErr(slave.getId()); break; } else { TaskProtocol issued = new TaskProtocol(taskProtocol,true); write(issued); + RgvErrCache.updateRgvErr(slave.getId()); taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); break; } } } + RgvErrCache.updateRgvErr(slave.getId()); } else { for (TaskProtocol taskProtocol : allTakeTaskProtocol) { if (taskProtocol.getIsRunning() == 1) {//鍑嗗涓嬪彂 @@ -357,7 +421,8 @@ if (rgvOtherStatusEnable()) { //鍙︿竴鍙拌溅鏄惁鍏佽姝ゅ彴杞︽墽琛� if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { - continue; + RgvErrCache.updateRgvErr(slave.getId(),errorRgv); + break; } } if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 @@ -366,49 +431,66 @@ DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, taskProtocol.getTargetPositionStaNoPlcId()); StaProtocol staProtocol = devpThread.getStation().get(taskProtocol.getTargetPositionStaNo()); if (staProtocol == null ) { - continue; + RgvErrCache.updateRgvErr(slave.getId(),"鏈煡鍒板皬杞︿綔涓氱珯"+staProtocol.getStaNo()+"绔欑偣"); + break; } // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 if (!staProtocol.isAutoing() || staProtocol.isLoading() - || staProtocol.getWorkNo() != 0 ){ - continue; + RgvErrCache.updateRgvErr(slave.getId(),"灏忚溅绛夊緟"+staProtocol.getStaNo()+"绔欑偣灏辩华"); + break; + } + } else if (taskProtocol.getTaskStatus()==2){ + DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, taskProtocol.getTargetPositionStaNoPlcId()); + StaProtocol staProtocol = devpThread.getStation().get(taskProtocol.getTargetPositionStaNo()); + if (staProtocol == null ) { + RgvErrCache.updateRgvErr(slave.getId(),"鏈煡鍒板皬杞︿綔涓氱珯"+staProtocol.getStaNo()+"绔欑偣"); + break; + } + // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 + if (!staProtocol.isAutoing() || !staProtocol.isLoading() || staProtocol.getWorkNo()==0 + ){ + RgvErrCache.updateRgvErr(slave.getId(),"灏忚溅绛夊緟"+staProtocol.getStaNo()+"绔欑偣灏辩华"); + break; } } TaskProtocol issued = new TaskProtocol(taskProtocol); write(issued); + RgvErrCache.updateRgvErr(slave.getId()); taskProtocolCache.removeTaskProtocol(taskProtocol.getTaskNoDirection()); break; } else { TaskProtocol issued = new TaskProtocol(taskProtocol,true); write(issued); + RgvErrCache.updateRgvErr(slave.getId()); break; } } } } + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); } catch (Exception e) { log.error("RGV浠诲姟涓嬪彂绾跨▼寮傚父锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV浠诲姟涓嬪彂绾跨▼寮傚父"+e.getMessage()); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } + rgvRun = RgvRunCache.getRgvRun(); + rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; + rgvRun.setRgvNo(slave.getOtherId()); + RgvRunCache.updateRgvStatus(rgvRun); + continue; // e.printStackTrace(); } } } - - public boolean deviceDetection() { - RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); + public boolean isSignRgvTaskProtocol() { RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); - - if (rgvProtocol == null || rgvTaskProtocol == null) { - return false; - } - if (!rgvProtocol.getModeType().equals(RgvModeType.AUTO) || rgvProtocol.getRgvPos().equals(0L) || rgvTaskProtocol.getAvoid() == -1 || rgvProtocol.getRgvPosDestination() == 0L - || (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE) && !rgvProtocol.getStatusType().equals(RgvStatusType.ROAM))) { + if (rgvTaskProtocol == null) { return false; } RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId()); @@ -418,7 +500,52 @@ return false; } if (rgvProtocolOther.statusEnable) { + if (rgvTaskProtocolOther == null) { + return false; + } + } + return true; + } + + + public boolean deviceDetection() { + RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); + RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); + + if (rgvProtocol == null || rgvTaskProtocol == null) { + errorRgv = slave.getId()+"鍙峰皬杞﹁繛鎺ュけ璐�"; + return false; + } + if (!rgvProtocol.getModeType().equals(RgvModeType.AUTO)) { + errorRgv = slave.getId()+"鍙峰皬杞﹂潪鑷姩"; + return false; + } + if (rgvProtocol.getRgvPos().equals(0L) + || rgvTaskProtocol.getAvoid() == -1 + || rgvProtocol.getRgvPosDestination() == 0L) { + errorRgv = slave.getId()+"鍙峰皬杞︾姸鎬佸紓甯�"; + return false; + } + if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE) && !rgvProtocol.getStatusType().equals(RgvStatusType.ROAM)) { + errorRgv = "鏃�"; + return false; + } + if ( (Math.abs(rgvProtocol.getRgvPos() - rgvProtocol.getRgvPosDestination())>100) && !rgvProtocol.getStatusType().equals(RgvStatusType.ROAM)) { + errorRgv = slave.getId()+"鍙峰皬杞﹀瓨鍦ㄨ繍琛岀洰鏍囧�硷紝闇�瑕佸浣嶏紒锛侊紒"; + return false; + } + RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId()); + RgvTaskProtocol rgvTaskProtocolOther = RgvTaskCache.getRgvStatus(slave.getOtherId()); +// System.out.println("rgvTaskProtocol:"+slave.getId()+"sign:"+rgvTaskProtocol.isSignRun()+"/n"+ +// "rgvTaskProtocolOther:"+slave.getOtherId()+"sign:"+rgvTaskProtocolOther.isSignRun()+"/n"); + + if (rgvProtocolOther == null) { + errorRgv = slave.getOtherId()+"鍙峰皬杞﹁繛鎺ュけ璐�"; + return false; + } + if (rgvProtocolOther.statusEnable) { if (!rgvProtocolOther.getModeType().equals(RgvModeType.AUTO) || rgvProtocolOther.getRgvPos().equals(0L) || rgvTaskProtocolOther.getAvoid() == -1 || rgvProtocolOther.getRgvPosDestination() == 0L) { + errorRgv = slave.getOtherId()+"鍙峰皬杞︾姸鎬佸紓甯�"; return false; } } @@ -440,6 +567,10 @@ public boolean otherRgvAvoid(Long targetPosition) { RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); + long onePos = Math.abs(targetPosition - rgvProtocol.getRgvPos()); + if (onePos<50){ + return true; + } RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId()); @@ -447,8 +578,7 @@ Long[][] avoidRange = new TrackRangeUtils().avoidRange(slave, trackEntireLength, trackBenchmark, avoidDistance); if (new TrackRangeUtils().IsItSmall(slave)) { - - if (rgvProtocolOther.getStatusType().equals(RgvStatusType.IDLE)) { + if (rgvProtocolOther.getStatusType().equals(RgvStatusType.IDLE) && (Math.abs(rgvProtocolOther.getRgvPos() - rgvProtocolOther.getRgvPosDestination())<50)) { if ((rgvProtocolOther.getRgvPos() - rgvProtocolOther.getCarBodyJiaoMing()) - (targetPosition + rgvProtocol.getCarBodyKunPeng()) > avoidDistance - 50) {//鏃犻渶閬胯 @@ -469,18 +599,18 @@ if (signNowPosRun){ // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 if (!staProtocol.isAutoing() || staProtocol.isLoading() - || staProtocol.getWorkNo() != 0 ){ if (targetPosition.equals(nowPosRunTask.getTargetPosition())){ if (rgvProtocolOther.getRgvPosDestination() >= rgvProtocolOther.getRgvPos()-50) { long avoid = rgvProtocolOther.getRgvPos() - rgvProtocolOther.getCarBodyJiaoMing() - avoidDistance - rgvProtocol.getCarBodyKunPeng(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -499,17 +629,80 @@ } } if (signNowPosRun){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + } + TaskProtocol nowPosRunTask2 = taskProtocolCacheOther.getNowPosRunTask2(); + if (!Cools.isEmpty(nowPosRunTask2)){ + boolean signNowPosRun = true; + boolean signNowPosA = true; + if (targetPosition - rgvProtocol.getRgvPos()>0){ + if (nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()>0){ + if (rgvProtocol.getRgvPos()>rgvProtocolOther.getRgvPos()){ + signNowPosA = false; + signNowPosRun = false; + } + } + } else if (targetPosition - rgvProtocol.getRgvPos()<0){ + if (nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()<0){ + if (rgvProtocol.getRgvPos()<rgvProtocolOther.getRgvPos()){ + signNowPosA = false; + signNowPosRun = false; + } + } + } + + if (signNowPosA){ + if (nowPosRunTask2.getTaskStatus()==3){ + long twoPos = Math.abs(nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()); + if (Math.abs(onePos - twoPos)>100){ + if (onePos-50>twoPos+50){ + DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, nowPosRunTask2.getTargetPositionStaNoPlcId()); + StaProtocol staProtocol = devpThread.getStation().get(nowPosRunTask2.getTargetPositionStaNo()); + if (staProtocol == null ) { + signNowPosRun =false; + } + if (signNowPosRun){ + // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 + if (staProtocol.isAutoing() && !staProtocol.isLoading() + ){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + } + signNowPosRun =false; + } + } + } else { + long twoPos = Math.abs(nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()); + if (twoPos<100){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + if (Math.abs(onePos - twoPos)>100){ + if (onePos-50>twoPos+50){ + signNowPosRun =false; + } + } + } + } + + if (signNowPosRun){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; return false; } } long avoid = targetPosition + rgvProtocol.getCarBodyKunPeng() + avoidDistance + rgvProtocolOther.getCarBodyJiaoMing(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[0])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -531,11 +724,13 @@ long avoid = targetPosition + rgvProtocol.getCarBodyKunPeng() + avoidDistance + rgvProtocolOther.getCarBodyJiaoMing(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[0])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -558,11 +753,13 @@ long avoid = rgvProtocolOther.getRgvPos() - rgvProtocolOther.getCarBodyJiaoMing() - avoidDistance - rgvProtocol.getCarBodyKunPeng(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -575,6 +772,8 @@ RgvTaskCache.updateRgvStatus(rgvTaskProtocol); return false; } + errorRgv = slave.getOtherId()+"鍙稲GV褰卞搷锛岀瓑寰呬腑..."; + return false; } } else { @@ -585,7 +784,7 @@ } } } else { - if (rgvProtocolOther.getStatusType().equals(RgvStatusType.IDLE)) { + if (rgvProtocolOther.getStatusType().equals(RgvStatusType.IDLE) && (Math.abs(rgvProtocolOther.getRgvPos() - rgvProtocolOther.getRgvPosDestination())<50)) { if ((targetPosition - rgvProtocol.getCarBodyJiaoMing()) - (rgvProtocolOther.getRgvPos() + rgvProtocolOther.getCarBodyKunPeng()) > avoidDistance - 50) {//鏃犻渶閬胯 @@ -605,18 +804,19 @@ if (signNowPosRun){ // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 if (!staProtocol.isAutoing() || staProtocol.isLoading() - || staProtocol.getWorkNo() != 0 ){ if (targetPosition.equals(nowPosRunTask.getTargetPosition())){ if (rgvProtocolOther.getRgvPosDestination() <= rgvProtocolOther.getRgvPos() + 50) { long avoid = rgvProtocolOther.getRgvPos() + rgvProtocolOther.getCarBodyKunPeng() + avoidDistance + rgvProtocol.getCarBodyJiaoMing(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[0])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -635,17 +835,81 @@ } } if (signNowPosRun){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + } + + TaskProtocol nowPosRunTask2 = taskProtocolCacheOther.getNowPosRunTask2(); + if (!Cools.isEmpty(nowPosRunTask2)){ + boolean signNowPosRun = true; + boolean signNowPosA = true; + if (targetPosition - rgvProtocol.getRgvPos()>0){ + if (nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()>0){ + if (rgvProtocol.getRgvPos()>rgvProtocolOther.getRgvPos()){ + signNowPosA = false; + signNowPosRun = false; + } + } + } else if (targetPosition - rgvProtocol.getRgvPos()<0){ + if (nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()<0){ + if (rgvProtocol.getRgvPos()<rgvProtocolOther.getRgvPos()){ + signNowPosA = false; + signNowPosRun = false; + } + } + } + + if (signNowPosA){ + if (nowPosRunTask2.getTaskStatus()==3){ + long twoPos = Math.abs(nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()); + if (Math.abs(onePos - twoPos)>100){ + if (onePos-50>twoPos+50){ + DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, nowPosRunTask2.getTargetPositionStaNoPlcId()); + StaProtocol staProtocol = devpThread.getStation().get(nowPosRunTask2.getTargetPositionStaNo()); + if (staProtocol == null ) { + signNowPosRun =false; + } + if (signNowPosRun){ + // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢 + if (staProtocol.isAutoing() && !staProtocol.isLoading() + ){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + } + signNowPosRun =false; + } + } + } else { + long twoPos = Math.abs(nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()); + if (twoPos<100){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; + return false; + } + if (Math.abs(onePos - twoPos)>100){ + if (onePos-50>twoPos+50){ + signNowPosRun =false; + } + } + } + } + + if (signNowPosRun){ + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟浣滀笟..."; return false; } } long avoid = targetPosition - rgvProtocol.getCarBodyJiaoMing() - avoidDistance - rgvProtocolOther.getCarBodyKunPeng(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -667,11 +931,13 @@ long avoid = targetPosition - rgvProtocol.getCarBodyJiaoMing() - avoidDistance - rgvProtocolOther.getCarBodyKunPeng(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -695,11 +961,13 @@ long avoid = rgvProtocolOther.getRgvPos() + rgvProtocolOther.getCarBodyKunPeng() + avoidDistance + rgvProtocol.getCarBodyJiaoMing(); if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[0])) { log.error("RGV琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + errorRgv = "RGV琛岃蛋鐩爣瓒呭嚭鑼冨洿"; + try{ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV琛岃蛋瓒呭嚭鑼冨洿"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } @@ -712,6 +980,7 @@ RgvTaskCache.updateRgvStatus(rgvTaskProtocol); return false; } + errorRgv = slave.getOtherId()+"鍙稲GV绛夊緟涓�..."; return false; } } else { @@ -722,6 +991,8 @@ } } } + + errorRgv = slave.getOtherId()+"鍙稲GV褰卞搷锛岀瓑寰呬腑..."; return false; } @@ -758,7 +1029,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV寮傚父"+e.getMessage()); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } rgvProtocol.setStatusEnable(true); } @@ -792,11 +1063,18 @@ // OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆慠GV 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("RGV plc杩炴帴澶辫触锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}] [rack:{}] [slot:{}]", slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot()); - try{ - DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); - deviceErrorService.addDeviceError("rgv", slave.getId(), "RGVplc杩炴帴澶辫触"); - } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); + if (System.currentTimeMillis()-currentTimeMilliConnectRgv>1000*60*10){ + try{ + DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); + deviceErrorService.addDeviceError("rgv", slave.getId(), "RGVplc杩炴帴澶辫触"); + } catch (Exception e2){ +// log.error("e2:"+e2.getMessage()); + } + if (currentTimeMilliConnectRgv == 0){ + currentTimeMilliConnectRgv = System.currentTimeMillis()-1000*60*10-1; + } else { + currentTimeMilliConnectRgv = System.currentTimeMillis(); + } } } initRgv(); @@ -825,7 +1103,18 @@ if (rgvProtocol.getRgvPosDestination()==0L){ rgvProtocol.setRgvPosDestination(rgvProtocol.getRgvPos()); } + rgvProtocol.setStatus(siemensNet.getByteTransform().TransInt16(result.Content, 8)); +// rgvProtocol.setStatus((short)1); + + //浣滀笟鍚姩涓� 瑙e喅浠诲姟涓嬪彂鍚庡皬杞︾姸鎬佹湭鏇存柊锛屽皬杞︾姸鎬佷笉鍙婃椂 + if (this.wrkSign == 1 && rgvProtocol.getStatus()!=(short)1){ + this.wrkSign = 0; + } + if (this.wrkSign == 1){ + rgvProtocol.setStatus((short)110); + } + rgvProtocol.setTaskNo((long)siemensNet.getByteTransform().TransInt32(result.Content, 10)); rgvProtocol.setRgvNo((int)siemensNet.getByteTransform().TransInt16(result.Content, 14)); @@ -844,7 +1133,10 @@ rgvProtocol.setErr4(status[11]); rgvProtocol.setErr5(status[12]); rgvProtocol.setErr6(status[13]); - + rgvProtocol.setErr7(status[14]); + rgvProtocol.setErr8(status[15]); +// System.out.println("璇荤嚎绋�"+ slave.getId()+"---"+JSON.toJSONString(rgvProtocol)); +// System.out.println("璇荤嚎绋�,灏忚溅鍙�"+ slave.getId()+"鏃堕棿鎴筹細"+System.currentTimeMillis()+"灏忚溅鏁版嵁锛�"+JSON.toJSONString(rgvProtocol)); OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛", DateUtils.convert(new Date()), slave.getId())); // // 宸ヤ綅1澶嶄綅淇″彿 // if (rgvProtocol.getStatusType().equals(RgvStatusType.WAITING) @@ -857,6 +1149,9 @@ // } // } // } + if (rgvProtocol.getAlarm$()!=0){ + RgvErrCache.updateRgvErr(slave.getId(),rgvProtocol.getAlarmM()); + } try { // 鏍规嵁瀹炴椂淇℃伅鏇存柊鏁版嵁搴� @@ -877,7 +1172,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV plc鏁版嵁搴撴洿鏂板け璐�"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } } } catch (Exception ignore) { @@ -898,7 +1193,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "璇诲彇RGV plc鐘舵�佷俊鎭け璐�"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } } } catch (Exception e) { @@ -910,7 +1205,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "璇诲彇RGV plc鐘舵�佷俊鎭け璐�"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } initRgv(); } @@ -927,15 +1222,14 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV鍐欏叆鍛戒护涓虹┖"); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } return false; } // convertRow(command); // taskProtocol.setRgvNo(slave.getId()); - Long[] array = new Long[11]; +// Long[] array = new Long[11]; OperateResult result41 = siemensNet.Write("DB100.12.0", false); - // array[0] = taskProtocol.getAckFinish1(); // array[1] = taskProtocol.getTaskNo(); // array[2] = taskProtocol.getTaskMode(); @@ -947,8 +1241,13 @@ OperateResult result1 = siemensNet.Write("DB100.4", (short) taskStatus); OperateResult result2 = siemensNet.Write("DB100.6", taskProtocol.getTaskNo().intValue()); OperateResult result3 = siemensNet.Write("DB100.10", taskProtocol.isDirection()? (short) 1 : (short) 2); // 鎵ц鏂瑰悜锛堥潰鏈濊建閬� 瀹氫綅鍊煎乏灏忓彸澶э級 true:宸� false:鍙� + Thread.sleep(20L); OperateResult result4 = siemensNet.Write("DB100.12.0", true); + this.wrkSign = 1; + +// log.info("浠诲姟涓嬪彂绾跨▼,灏忚溅鍙�"+ slave.getId()+"鏃堕棿鎴筹細"+System.currentTimeMillis()); + // if (taskProtocol.getAckFinish1() == 0) { // short commandFinish = 3; //宸ヤ綅1銆�2浠诲姟鍚屾椂鍐欏叆 // Thread.sleep(100L); @@ -976,6 +1275,7 @@ } catch (Exception ignore) { } + readStatus(); if (result != null && result.IsSuccess) { // Thread.sleep(50); // this.readStatus(); @@ -986,7 +1286,7 @@ DeviceErrorService deviceErrorService = SpringUtils.getBean(DeviceErrorService.class); deviceErrorService.addDeviceError("rgv", slave.getId(), "RGV 鍛戒护涓嬪彂"+JSON.toJSON(taskProtocol)); } catch (Exception e2){ - log.error("e2:"+e2.getMessage()); +// log.error("e2:"+e2.getMessage()); } OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(taskProtocol))); return true; @@ -1004,6 +1304,7 @@ OperateResult result1 = siemensNet.Write("DB100.4", (short) 0); OperateResult result2 = siemensNet.Write("DB100.6", (int) 0); OperateResult result3 = siemensNet.Write("DB100.10", (short) 0); // 鎵ц鏂瑰悜锛堥潰鏈濊建閬� 瀹氫綅鍊煎乏灏忓彸澶э級 true:宸� false:鍙� + log.info("浠诲姟瀹屾垚涓嬪彂绾跨▼,灏忚溅鍙�"+ slave.getId()+"鏃堕棿鎴筹細"+System.currentTimeMillis()); try { // 鏃ュ織璁板綍 -- Gitblit v1.9.1