| | |
| | | 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; |
| | |
| | | private Long trackBenchmark = 1L; |
| | | // # 避让距离 |
| | | private Long avoidDistance = 5000L; |
| | | private Long currentTimeMilliOld = 0L; |
| | | |
| | | /** |
| | | * 工位1复位信号 |
| | |
| | | */ |
| | | private void taskIssued() { |
| | | while (true) { |
| | | RgvRunProtocol rgvRun = RgvRunCache.getRgvRun(); |
| | | if (!rgvRun.getRgvNo().equals(slave.getId())){ |
| | | continue; |
| | | } |
| | | try { |
| | | Thread.sleep(50); |
| | | rgvRun = RgvRunCache.getRgvRun(); |
| | | System.out.println(JSON.toJSON(rgvRun)); |
| | | |
| | | // 休眠 1 秒 |
| | | if (System.currentTimeMillis() - currentTimeMilliOld > 100) { |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | if (System.currentTimeMillis() - rgvRun.currentTimeMilliOld > 1500) { |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | } else { |
| | | continue; |
| | | } |
| | | if (!deviceDetection()) { |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | continue; |
| | | } |
| | | if (!signRunStart()){ |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.setRgvNo(slave.getOtherId()); |
| | | RgvRunCache.updateRgvStatus(rgvRun); |
| | | continue; |
| | | } |
| | | |
| | |
| | | rgvTaskProtocol = RgvTaskCache.getRgvStatus(slave.getId()); |
| | | } |
| | | if (!rgvProtocol.getStatusType().equals(RgvStatusType.IDLE) || (Math.abs(rgvProtocol.getRgvPos() - rgvProtocol.getRgvPosDestination())>100)){ |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.setRgvNo(slave.getOtherId()); |
| | | RgvRunCache.updateRgvStatus(rgvRun); |
| | | continue; |
| | | } |
| | | if (rgvProtocol.getLoaded() == -1){ |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.setRgvNo(slave.getOtherId()); |
| | | RgvRunCache.updateRgvStatus(rgvRun); |
| | | continue; |
| | | } |
| | | if (rgvTaskProtocol.getAvoid() != 0) { |
| | |
| | | |
| | | RgvTaskCache.updateRgvStatus(rgvTaskProtocol); |
| | | } |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.setRgvNo(slave.getOtherId()); |
| | | RgvRunCache.updateRgvStatus(rgvRun); |
| | | continue; |
| | | } |
| | | |
| | |
| | | DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, taskProtocol.getTargetPositionStaNoPlcId()); |
| | | StaProtocol staProtocol = devpThread.getStation().get(taskProtocol.getTargetPositionStaNo()); |
| | | if (staProtocol == null ) { |
| | | continue; |
| | | break; |
| | | } |
| | | // 判断是否满足入库条件 |
| | | if (!staProtocol.isAutoing() || staProtocol.isLoading() |
| | | ){ |
| | | continue; |
| | | break; |
| | | } |
| | | } |
| | | TaskProtocol issued = new TaskProtocol(taskProtocol); |
| | |
| | | } |
| | | } |
| | | } |
| | | signRunEnd(); |
| | | currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | 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{ |
| | |
| | | } catch (Exception e2){ |
| | | log.error("e2:"+e2.getMessage()); |
| | | } |
| | | rgvRun = RgvRunCache.getRgvRun(); |
| | | rgvRun.currentTimeMilliOld = System.currentTimeMillis()+50; |
| | | rgvRun.setRgvNo(slave.getOtherId()); |
| | | RgvRunCache.updateRgvStatus(rgvRun); |
| | | continue; |
| | | // e.printStackTrace(); |
| | | } |
| | | } |
| | |
| | | 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()); |
| | |
| | | } |
| | | 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()); |
| | |
| | | } |
| | | if (rgvProtocolOther.statusEnable) { |
| | | if (!rgvProtocolOther.getModeType().equals(RgvModeType.AUTO) || rgvProtocolOther.getRgvPos().equals(0L) || rgvTaskProtocolOther.getAvoid() == -1 || rgvProtocolOther.getRgvPosDestination() == 0L) { |
| | | if (signRunStart()){ |
| | | signRunEnd(); |
| | | } |
| | | return false; |
| | | } |
| | | } |
| | |
| | | if (rgvProtocol.getRgvPosDestination()==0L){ |
| | | rgvProtocol.setRgvPosDestination(rgvProtocol.getRgvPos()); |
| | | } |
| | | |
| | | rgvProtocol.setStatus(siemensNet.getByteTransform().TransInt16(result.Content, 8)); |
| | | rgvProtocol.setTaskNo((long)siemensNet.getByteTransform().TransInt32(result.Content, 10)); |
| | | |