| | |
| | | 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()); |
| | | |
| | |
| | | private void taskComplete() { |
| | | while (true) { |
| | | try { |
| | | if(!connectRgv){ |
| | | try { |
| | | Thread.sleep(1000L); |
| | | } catch (Exception e){ |
| | | |
| | | } |
| | | continue; |
| | | } |
| | | if (delRgvTask){ |
| | | writeDelRgvTask(); |
| | | delRgvTask = false; |
| | |
| | | private void taskWalkIssued() { |
| | | while (true) { |
| | | try { |
| | | if(!connectRgv){ |
| | | try { |
| | | Thread.sleep(1000L); |
| | | } catch (Exception e){ |
| | | |
| | | } |
| | | continue; |
| | | } |
| | | // 休眠 1 秒 |
| | | Thread.sleep(100); |
| | | |
| | |
| | | */ |
| | | 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; |
| | |
| | | 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()+"号RGV等待作业..."; |
| | | return false; |
| | | } |
| | | } |
| | | signNowPosRun =false; |
| | | } |
| | | } |
| | | } else { |
| | | long twoPos = Math.abs(nowPosRunTask2.getTargetPosition() - rgvProtocolOther.getRgvPos()); |
| | | if (twoPos<100){ |
| | | errorRgv = slave.getOtherId()+"号RGV等待作业..."; |
| | | return false; |
| | | } |
| | | if (Math.abs(onePos - twoPos)>100){ |
| | | if (onePos-50>twoPos+50){ |
| | | signNowPosRun =false; |
| | | } |
| | | } |
| | | } |
| | | } |
| | | |
| | | if (signNowPosRun){ |
| | | errorRgv = slave.getOtherId()+"号RGV等待作业..."; |
| | | 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()); |