| | |
| | | private Long trackBenchmark = 1L; |
| | | // # 避让距离 |
| | | private Long avoidDistance = 5000L; |
| | | private Long currentTimeMilliOld = 0L; |
| | | |
| | | /** |
| | | * 工位1复位信号 |
| | |
| | | while (true) { |
| | | try { |
| | | Thread.sleep(20); |
| | | System.out.println("读线程"+ slave.getId()); |
| | | |
| | | readStatus(); |
| | | |
| | |
| | | /** |
| | | * 任务下发 |
| | | */ |
| | | 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(); |
| | | // } |
| | | // } |
| | | // } |
| | | |
| | | /** |
| | | * 漫游 |
| | | */ |
| | | private void taskWalkIssued() { |
| | | while (true) { |
| | | try { |
| | | // 休眠 1 秒 |
| | | Thread.sleep(100); |
| | | |
| | | if (!deviceDetection()) { |
| | | continue; |
| | | } |
| | | RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | if (rgvTaskProtocol == null) { |
| | | initRgv(); |
| | | rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | } |
| | | if (rgvTaskProtocol.getAvoid() != 1) { |
| | | continue; |
| | | } |
| | | TaskProtocol issued = new TaskProtocol(); |
| | | issued.setTaskNo(32222L); |
| | | issued.setTargetPosition(rgvTaskProtocol.getAvoidingTheDestination()); |
| | | issued.setTaskStatus(1); |
| | | issued.setDirection(true); |
| | | write(issued); |
| | | rgvTaskProtocol.setAvoid(0); |
| | | |
| | | Thread.sleep(200); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | |
| | | } catch (Exception e) { |
| | | log.error("RGV行走任务下发线程异常!!!" + e.getMessage()); |
| | | // e.printStackTrace(); |
| | | } |
| | | } |
| | | } |
| | | // private void taskWalkIssued() { |
| | | // while (true) { |
| | | // try { |
| | | // // 休眠 1 秒 |
| | | // Thread.sleep(100); |
| | | // |
| | | // if (!deviceDetection()) { |
| | | // continue; |
| | | // } |
| | | // RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | // if (rgvTaskProtocol == null) { |
| | | // initRgv(); |
| | | // rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | // } |
| | | // if (rgvTaskProtocol.getAvoid() != 1) { |
| | | // continue; |
| | | // } |
| | | // TaskProtocol issued = new TaskProtocol(); |
| | | // issued.setTaskNo(32222L); |
| | | // issued.setTargetPosition(rgvTaskProtocol.getAvoidingTheDestination()); |
| | | // issued.setTaskStatus(1); |
| | | // issued.setDirection(true); |
| | | // write(issued); |
| | | // rgvTaskProtocol.setAvoid(0); |
| | | // |
| | | // Thread.sleep(200); |
| | | // RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | // |
| | | // } catch (Exception e) { |
| | | // log.error("RGV行走任务下发线程异常!!!" + e.getMessage()); |
| | | //// e.printStackTrace(); |
| | | // } |
| | | // } |
| | | // } |
| | | |
| | | /** |
| | | * 任务下发 |
| | |
| | | while (true) { |
| | | try { |
| | | // 休眠 1 秒 |
| | | Thread.sleep(50); |
| | | if (!deviceDetection()) { |
| | | if (System.currentTimeMillis() - currentTimeMilliOld > 100) { |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | } else { |
| | | continue; |
| | | } |
| | | if (!deviceDetection()) { |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | if (!signRunStart()){ |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | |
| | | RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); |
| | | RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | if (rgvProtocol == null || rgvTaskProtocol == null) { |
| | |
| | | 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)){ |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | if (rgvProtocol.getLoaded() == -1){ |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | if (rgvTaskProtocol.getAvoid() != 0) { |
| | |
| | | write(issued); |
| | | rgvTaskProtocol.setAvoid(0); |
| | | |
| | | try{Thread.sleep(50L);} catch (Exception e){} |
| | | // try{Thread.sleep(50L);} catch (Exception e){} |
| | | |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | } |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | |
| | |
| | | if (rgvOtherStatusEnable()) { |
| | | //另一台车是否允许此台车执行 |
| | | if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { |
| | | continue; |
| | | break; |
| | | } |
| | | } |
| | | if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 |
| | |
| | | if (rgvOtherStatusEnable()) { |
| | | //另一台车是否允许此台车执行 |
| | | if (!otherRgvAvoid(taskProtocol.getTargetPosition())) { |
| | | continue; |
| | | break; |
| | | } |
| | | } |
| | | if (taskProtocol.getTargetPosition()<=rgvProtocol.getRgvPos()+50 |
| | |
| | | } |
| | | // 判断是否满足入库条件 |
| | | if (!staProtocol.isAutoing() || staProtocol.isLoading() |
| | | || staProtocol.getWorkNo() != 0 |
| | | ){ |
| | | continue; |
| | | } |
| | |
| | | } |
| | | } |
| | | } |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | } catch (Exception e) { |
| | | log.error("RGV任务下发线程异常!!! ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); |
| | | try{ |
| | |
| | | } |
| | | } |
| | | } |
| | | |
| | | 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()); |
| | |
| | | return false; |
| | | } |
| | | if (rgvProtocolOther.statusEnable) { |
| | | if (rgvTaskProtocolOther == null) { |
| | | return false; |
| | | } |
| | | } |
| | | return true; |
| | | } |
| | | |
| | | public boolean signRunStart() { |
| | | RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | if (rgvTaskProtocol == null) { |
| | | return false; |
| | | } |
| | | RgvTaskProtocol rgvTaskProtocolOther = RgvTaskCache.getRgvStatus(slave.getOtherId()); |
| | | if (rgvTaskProtocolOther == null) { |
| | | return false; |
| | | } |
| | | if(!rgvTaskProtocol.isSignRun()) { |
| | | return false; |
| | | } |
| | | if(rgvTaskProtocolOther.isSignRun()) { |
| | | rgvTaskProtocol.setSignRun(rgvTaskProtocol.getRgvNo()==1); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | return false; |
| | | } |
| | | rgvTaskProtocol.setSignRun(false); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | return true; |
| | | } |
| | | |
| | | public boolean signRunEnd() { |
| | | RgvTaskProtocol rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | if (rgvTaskProtocol == null) { |
| | | return false; |
| | | } |
| | | RgvProtocol rgvProtocolOther = RgvStatusCache.getRgvStatus(slave.getOtherId()); |
| | | if (rgvProtocolOther == null) { |
| | | return false; |
| | | } |
| | | if (rgvProtocolOther.statusEnable) { |
| | | RgvTaskProtocol rgvTaskProtocolOther = RgvTaskCache.getRgvStatus(slave.getOtherId()); |
| | | if (rgvTaskProtocolOther == null) { |
| | | return false; |
| | | } |
| | | rgvTaskProtocol.setSignRun(false); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | |
| | | rgvTaskProtocolOther.setSignRun(true); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocolOther); |
| | | } else { |
| | | rgvTaskProtocol.setSignRun(true); |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | } |
| | | return true; |
| | | } |
| | | |
| | | |
| | | public boolean deviceDetection() { |
| | | RgvProtocol rgvProtocol = RgvStatusCache.getRgvStatus(slave.getId()); |
| | | 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) || (Math.abs(rgvProtocol.getRgvPos() - rgvProtocol.getRgvPosDestination())>100)) && !rgvProtocol.getStatusType().equals(RgvStatusType.ROAM))) { |
| | | if (signRunStart()){ |
| | | signRunEnd(); |
| | | } |
| | | 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) { |
| | | return false; |
| | | } |
| | | if (rgvProtocolOther.statusEnable) { |
| | | if (!rgvProtocolOther.getModeType().equals(RgvModeType.AUTO) || rgvProtocolOther.getRgvPos().equals(0L) || rgvTaskProtocolOther.getAvoid() == -1 || rgvProtocolOther.getRgvPosDestination() == 0L) { |
| | | if (signRunStart()){ |
| | | signRunEnd(); |
| | | } |
| | | return false; |
| | | } |
| | | } |
| | |
| | | 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) {//无需避让 |
| | |
| | | if (signNowPosRun){ |
| | | // 判断是否满足入库条件 |
| | | if (!staProtocol.isAutoing() || staProtocol.isLoading() |
| | | || staProtocol.getWorkNo() != 0 |
| | | ){ |
| | | if (targetPosition.equals(nowPosRunTask.getTargetPosition())){ |
| | | if (rgvProtocolOther.getRgvPosDestination() >= rgvProtocolOther.getRgvPos()-50) { |
| | |
| | | } |
| | | } |
| | | } 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) {//无需避让 |
| | |
| | | if (signNowPosRun){ |
| | | // 判断是否满足入库条件 |
| | | if (!staProtocol.isAutoing() || staProtocol.isLoading() |
| | | || staProtocol.getWorkNo() != 0 |
| | | ){ |
| | | if (targetPosition.equals(nowPosRunTask.getTargetPosition())){ |
| | | if (rgvProtocolOther.getRgvPosDestination() <= rgvProtocolOther.getRgvPos() + 50) { |
| | |
| | | rgvProtocol.setErr4(status[11]); |
| | | rgvProtocol.setErr5(status[12]); |
| | | rgvProtocol.setErr6(status[13]); |
| | | System.out.println("读线程"+ slave.getId()+"---"+JSON.toJSONString(rgvProtocol)); |
| | | |
| | | OutputQueue.RGV.offer(MessageFormat.format("【{0}】[id:{1}] <<<<< 实时数据更新成功", DateUtils.convert(new Date()), slave.getId())); |
| | | // // 工位1复位信号 |