From 1da55d544dffc8d8b2e88efb4532776e71b0b11c Mon Sep 17 00:00:00 2001 From: Junjie <fallin.jie@qq.com> Date: 星期五, 15 九月 2023 16:39:09 +0800 Subject: [PATCH] # --- src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java | 3127 +++++++++++++++++++++++++--------------------------------- 1 files changed, 1,337 insertions(+), 1,790 deletions(-) diff --git a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java index 0d68a9c..70fc05b 100644 --- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java +++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java @@ -2,9 +2,7 @@ import com.alibaba.fastjson.JSON; import com.alibaba.fastjson.JSONObject; -import com.baomidou.mybatisplus.mapper.EntityWrapper; import com.core.common.Cools; -import com.core.common.SpringUtils; import com.core.exception.CoolException; import com.zy.asrs.entity.*; import com.zy.asrs.mapper.*; @@ -12,11 +10,9 @@ import com.zy.asrs.utils.Utils; import com.zy.common.model.*; import com.zy.common.model.enums.NavigationMapType; -import com.zy.common.model.enums.WrkChargeType; import com.zy.common.service.CommonService; import com.zy.common.service.erp.ErpService; import com.zy.common.utils.*; -import com.zy.core.CrnThread; import com.zy.core.DevpThread; import com.zy.core.News; import com.zy.core.cache.MessageQueue; @@ -53,6 +49,8 @@ @Autowired private WrkMastMapper wrkMastMapper; @Autowired + private WrkMastService wrkMastService; + @Autowired private WrkDetlService wrkDetlService; @Autowired private LocMastService locMastService; @@ -70,6 +68,8 @@ private BasShuttleService basShuttleService; @Autowired private BasShuttleErrLogService basShuttleErrLogService; + @Autowired + private BasLiftErrLogService basLiftErrLogService; @Autowired private BasShuttleErrService basShuttleErrService; @Autowired @@ -92,6 +92,10 @@ private OrderMapper orderMapper; @Autowired private OrderDetlMapper orderDetlMapper; + @Autowired + private BasLiftService basLiftService; + @Autowired + private ShuttleDispatchUtils shuttleDispatchUtils; @Autowired private RedisUtil redisUtil; @@ -198,16 +202,17 @@ } // 杩囨护鐩樼偣/鎷f枡/骞舵澘浠诲姟 -// if (null != wrkMastMapper.selectPickStepByBarcode(barcode)) { -// continue; -// } + WrkMast wrkMast1 = wrkMastMapper.selectPickStepByBarcode(barcode); + if (null != wrkMast1) { + continue; + } // 鍒ゆ柇閲嶅宸ヤ綔妗� -// WrkMast wrkMast = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode); -// if (wrkMast != null) { -// News.error("宸ヤ綔妗d腑宸插瓨鍦ㄨ绔欑姸鎬佷负锛� 2.璁惧涓婅蛋 锛夌殑鏁版嵁,宸ヤ綔鍙�={}", wrkMast.getWrkNo()); -// continue; -// } + WrkMast wrkMast2 = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode); + if (wrkMast2 != null) { + News.error("宸ヤ綔妗d腑宸插瓨鍦ㄨ绔欑姸鎬佷负锛� 2.璁惧涓婅蛋 锛夌殑鏁版嵁,宸ヤ綔鍙�={}", wrkMast2.getWrkNo()); + continue; + } try { LocTypeDto locTypeDto = new LocTypeDto(staProtocol); @@ -259,9 +264,9 @@ News.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response); } else if (code == 700) { staProtocol.setWorkNo((short) 32002); - staProtocol.setStaNo(inSta.getBackSta().shortValue()); + staProtocol.setRollback102(1);//102绔欏洖閫�淇″彿 devpThread.setPakMk(staProtocol.getSiteId(), false); - MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol)); + MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(5, staProtocol)); // led 寮傚父鏄剧ず if (ledThread != null) { @@ -380,6 +385,7 @@ /** * 鎷f枡銆佸苟鏉裤�佺洏鐐瑰啀鍏ュ簱 */ + @Transactional public synchronized void stnToCrnStnPick(){ for (DevpSlave devp : slaveProperties.getDevp()) { // 閬嶅巻鎷f枡鍏ュ簱鍙� @@ -395,25 +401,20 @@ } if (staProtocol.isAutoing() && staProtocol.isLoading() - && staProtocol.isInEnable() - // 0 - 9990 鎴栬�� 9996 - && (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9990) + && (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9999) && staProtocol.getStaNo().equals(staProtocol.getSiteId().shortValue()) && staProtocol.isPakMk()){ // 鑾峰彇鏉$爜鎵弿浠俊鎭� -// BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode()); -// if (barcodeThread == null) { -// continue; -// } + BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode()); + if (barcodeThread == null) { + continue; + } + String barcode = barcodeThread.getBarcode(); WrkMast wrkMast = null; - if (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9990) { - wrkMast = wrkMastMapper.selectPickStep(staProtocol.getWorkNo()); - if (null == wrkMast) { - continue; - } - } else { + wrkMast = wrkMastMapper.selectPickStepByBarcode(barcode); + if (wrkMast == null) { continue; } // if (staProtocol.getWorkNo() == 9996) { @@ -453,6 +454,7 @@ // News.error("{}鏉$爜閿欒锛屾殏鏃犳嫞鏂欎换鍔★紒", barcode); // } // } + if ((wrkMast.getIoType() != 103 && wrkMast.getIoType() != 104 && wrkMast.getIoType() != 107) || Cools.isEmpty(wrkMast.getStaNo()) || Cools.isEmpty(wrkMast.getSourceStaNo()) ) { continue; @@ -507,14 +509,22 @@ wrkMast.setSourceStaNo(pickSta.getStaNo()); // 婧愮珯 wrkMast.setStaNo(dto.getStaNo()); // 鐩爣绔� wrkMast.setCrnNo(dto.getCrnNo()); - wrkMast.setLocNo(dto.getLocNo()); // 鐩爣搴撲綅 = 鍑哄簱鏃剁殑婧愬簱浣� - wrkMast.setSourceLocNo(""); // 婧愬簱浣嶆竻绌� + wrkMast.setLocNo(sourceLocNo); // 鐩爣搴撲綅 = 鍑哄簱鏃剁殑婧愬簱浣� + wrkMast.setShuttleNo(null); // 绌挎杞︽竻绌� wrkMast.setModiTime(new Date()); if (wrkMastMapper.updateById(wrkMast) == 0) { throw new CoolException(wrkMast.getWrkNo() + "鏇存柊宸ヤ綔妗f暟鎹姸鎬佸け璐�"); } if (wrkMastMapper.setSteEmpty(wrkMast.getWrkNo()) == 0) { throw new CoolException(wrkMast.getWrkNo() + "鏇存柊宸ヤ綔妗f暟鎹姸鎬佸け璐�"); + } + + // 淇敼搴撲綅鐘舵�� Q.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴� + LocMast locMast = locMastService.selectById(sourceLocNo); + locMast.setLocSts("Q"); + locMast.setModiTime(new Date()); + if (!locMastService.updateById(locMast)) { + throw new CoolException("淇敼搴撲綅鐘舵�佸け璐�"); } // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护 @@ -563,7 +573,7 @@ * 鍒濆鍖栧疄鏃跺湴鍥� */ public synchronized void initRealtimeBasMap() { - for (int i = 1; i <= 4; i++) {//鎬诲叡鍥涘眰妤� + for (int i = 1; i <= 10; i++) {//鎬诲叡鍥涘眰妤� Object data = redisUtil.get("realtimeBasMap_" + i); if (data == null) {//redis鍦板浘鏁版嵁涓虹┖锛屼粠鏁版嵁搴撲腑鑾峰彇 BasMap basMap = basMapService.selectLatestMap(i); @@ -571,7 +581,7 @@ //鏁版嵁搴撲腑涔熶笉瀛樺湪鍦板浘鏁版嵁锛屼粠鍦板浘鏂囦欢涓幏鍙� //杞藉叆鍦板浘 NavigateMapData mapData = new NavigateMapData(i); - List<List<MapNode>> lists = mapData.getJsonData(-1, null);//鑾峰彇瀹屾暣鍦板浘(鍖呮嫭鍏ュ簱鍑哄簱) + List<List<MapNode>> lists = mapData.getJsonData(-1, null, null);//鑾峰彇瀹屾暣鍦板浘(鍖呮嫭鍏ュ簱鍑哄簱) //瀛樺叆鏁版嵁搴� basMap = new BasMap(); @@ -627,11 +637,11 @@ } Short shuttleNo = redisCommand.getShuttleNo(); - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo.intValue()); + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo.intValue()); if (shuttleThread == null) { continue; } - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); if (shuttleProtocol == null) { continue; } @@ -640,7 +650,7 @@ } //鍥涘悜绌挎杞﹀浜庣┖闂茬姸鎬侊紝杩涜浠诲姟鐨勬仮澶� - shuttleProtocol.setTaskNo(redisCommand.getWrkNo());//灏嗗洓鍚戠┛姊溅绾跨▼鍒嗛厤浠诲姟鍙� + shuttleProtocol.setTaskNo(redisCommand.getWrkNo().intValue());//灏嗗洓鍚戠┛姊溅绾跨▼鍒嗛厤浠诲姟鍙� shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WORKING);//宸ヤ綔鐘舵�� } } @@ -650,7 +660,7 @@ /** * 鍏ュ簱 ===>> 鍥涘悜绌挎杞﹀叆搴撲綔涓氫笅鍙� */ - public synchronized void shuttleIoInExecute() { + public synchronized void shuttleInExecute() { // 鏍规嵁杈撻�佺嚎plc閬嶅巻 for (DevpSlave devp : slaveProperties.getDevp()) { // 閬嶅巻鍏ュ簱绔� @@ -664,139 +674,24 @@ staProtocol = staProtocol.clone(); } Short workNo = staProtocol.getWorkNo(); + BasDevp basDevp = basDevpService.selectById(staProtocol.getSiteId()); + if (basDevp == null) { + continue;//绔欑偣淇℃伅涓嶅瓨鍦� + } // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢锛岃嚜鍔ㄣ�佹湁鐗┿�佸洓鍚戠┛姊溅鍙彇淇″彿 - if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isShuttleTakeEnable()) { - WrkMast wrkMast = wrkMastMapper.selectRackInStep48(workNo, staProtocol.getSiteId()); - if (wrkMast != null) { - if (wrkMast.getWrkSts() == 4 || wrkMast.getWrkSts() == 8) { - ShuttleThread shuttleThread = null; - HashMap<String, Object> searchIdleShuttle = null; + if (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isShuttleTakeEnable())) { + continue; + } - LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); - LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + WrkMast wrkMast = wrkMastMapper.selectRackInStep4(workNo, staProtocol.getSiteId()); + if (wrkMast == null) { + continue; + } - if (wrkMast.getWrkSts() == 4) { - //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅 - searchIdleShuttle = this.searchIdleShuttle(wrkMast); - shuttleThread = (ShuttleThread) searchIdleShuttle.get("result"); - }else if(wrkMast.getWrkSts() == 8){//鐘舵��8锛岄渶瑕佸悜灏忚溅涓嬪彂鍛戒护浠庢彁鍗囨満绉诲姩鍑哄幓锛岄渶瑕佸垽鏂彁鍗囨満鐘舵槸鍚︾┖闂层�佹彁鍗囨満鏄惁鍒拌揪鐩爣妤煎眰銆佺洰鏍囨ゼ灞傜珯鐐规槸鍚﹀瓨鍦ㄣ�佺洰鏍囨ゼ灞傜珯鐐规槸鍚︾粰鍑烘彁鍗囨満鍒颁綅淇″彿 - //鐘舵��8锛岀瓑寰呭懡浠よ繘琛屽叆搴撴惉杩愬姩浣� - - //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂� - if (!liftProtocol.isIdle()) { - continue;//鎻愬崌鏈哄繖 - } - - //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌浣嶏紝鍒ゆ柇绔欑偣鏄惁缁欏嚭鎻愬崌鏈哄埌浣嶄俊鍙� - String locNo = wrkMast.getLocNo(); - int lev = Utils.getLev(locNo);//鐩爣浜岀淮鐮佹墍鍦ㄦゼ灞� - int liftLev = liftProtocol.getLev().intValue();//鎻愬崌鏈烘墍鍦ㄦゼ灞� - if (liftLev != lev) { - continue;//鎻愬崌鏈轰笉鍦ㄧ洰鏍囨ゼ灞傝烦杩� - } - - Integer staNo = Utils.levToOutInStaNo(lev >= 2 ? lev + 1 : lev); - //鑾峰彇鐩爣绔欎俊鎭� - StaProtocol staProtocol1 = devpThread.getStation().get(staNo); - if (staProtocol1 == null) { - continue;//绔欑偣淇℃伅涓嶅瓨鍦� - } - if (!staProtocol1.isLiftArrival()) { - continue;//绔欑偣鎻愬崌鏈哄埌浣嶄俊鍙穎alse - } - - Integer shuttleNo = wrkMast.getShuttleNo();//鍥涘悜绌挎杞﹀彿 - shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo); - } - - if (shuttleThread == null) { - continue; - } - - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (!shuttleProtocol.isIdle()) { - continue; - } - - wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿 - - //鍒嗛厤浠诲姟鍙� - shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue()); - //鍒嗛厤婧愬簱浣� - shuttleProtocol.setSourceLocNo(wrkMast.getSourceLocNo()); - - //鍒涘缓鍒嗛厤鍛戒护 - ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 - assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� - assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//鍏ュ嚭搴撴ā寮� - String currentLocNo = shuttleProtocol.getCurrentLocNo(); - assignCommand.setSourceLocNo(currentLocNo);//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) - - String locNo = wrkMast.getLocNo();//褰撳墠宸ヤ綔妗e簱浣嶅彿 - Integer currentLev = wrkMast.getWrkSts() == 4 ? Utils.getLev(currentLocNo) : liftProtocol.getLev();//灏忚溅褰撳墠灞傞珮 - - //鎻愬崌鏈哄彛绔欑偣搴撲綅鍙� - String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev); - - if (wrkMast.getWrkSts() == 8 || Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) { - //鍚屼竴灞傜洿鎺ュ彇璐ф棤闇�缁忚繃鎻愬崌鏈� - //鐩存帴璁$畻杞﹀埌鎻愬崌鏈哄彇璐у啀鍒板簱浣嶈矾寰勬寚浠� - List<ShuttleCommand> commands = this.shuttleAssignCommand(wrkMast.getWrkSts() == 4 ? currentLocNo : liftSiteLocNo, liftSiteLocNo, locNo, assignCommand, shuttleThread); - if (commands == null) { - continue;//鎵句笉鍒拌矾寰勭瓑寰呬笅涓�娆� - } - if (wrkMast.getWrkSts() == 8) { - //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛 - Integer staNo = Utils.levToOutInStaNo(currentLev >= 2 ? currentLev + 1 : currentLev);//绔欑偣鍙� - BasDevp basDevp = basDevpService.selectById(staNo); - - short startCode = liftProtocol.getBarcode();//鎻愬崌鏈哄唴閮ㄤ簩缁寸爜 - Short distCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈哄彛绔欑偣浜岀淮鐮� - Short runDirection = ShuttleRunDirection.BOTTOM.id;//杩愯鏂瑰悜 - //鑾峰彇鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1400, runDirection, startCode, 1400, 500); - commands.add(0, moveCommand);//灏嗚鎸囦护娣诲姞鍒伴槦澶� - } - assignCommand.setCommands(commands); - //鍒嗛厤鐩爣搴撲綅 - shuttleProtocol.setLocNo(wrkMast.getLocNo()); - //鐩爣搴撲綅 - assignCommand.setLocNo(wrkMast.getLocNo()); - wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓� - }else { - //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿 - - //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞 - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread); - if (commands == null) { - continue;//鏈壘鍒拌矾寰� - } - - //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅 - BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo); - Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮� - - //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, endStartCode, 1400, 500); - commands.add(moveCommand); - - //鍒嗛厤鐩爣搴撲綅 - shuttleProtocol.setLocNo(liftSiteLocNo); - //鐩爣搴撲綅 - assignCommand.setLocNo(liftSiteLocNo); - assignCommand.setCommands(commands); - wrkMast.setWrkSts(5L);//灏忚溅杩佺Щ鐘舵�� - } - - if (wrkMastMapper.updateById(wrkMast) > 0) { - //涓嬪彂浠诲姟 - MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); - } - } - - } + boolean step1 = this.shuttleInExecuteStep1(wrkMast, basDevp);//灏忚溅鎼叆搴撲腑 + if (!step1) { + continue; } } @@ -804,434 +699,150 @@ } - //鑾峰彇璧风偣-缁堢偣鎸囦护 - public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String locNo, Integer mapType, ShuttleAssignCommand assignCommand, ShuttleThread shuttleThread) { - //鑾峰彇灏忚溅绉诲姩閫熷害 - BasShuttle basShuttle = basShuttleService.selectById(assignCommand.getShuttleNo()); - Integer runSpeed = 1000; - if (basShuttle != null) { - Integer runSpeed1 = basShuttle.getRunSpeed(); - if (runSpeed1 != null) { - runSpeed = runSpeed1; + /** + * 鍏ュ簱-灏忚溅鎼叆搴撲腑 + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + public boolean shuttleInExecuteStep1(WrkMast wrkMast, BasDevp basDevp) { + if (wrkMast.getWrkSts() == 4) { + if (wrkMast.getShuttleNo() == null) {//娌℃湁缁戝畾灏忚溅锛岃繘琛岃皟搴� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo());//璋冨害灏忚溅鍒拌揣鐗╂墍鍦ㄨ緭閫佺珯鐐硅繘琛屽彇璐� + return false; } - } - //璁$畻灏忚溅璧风偣鍒颁腑鐐规墍闇�鍛戒护 - List<NavigateNode> calc = NavigateUtils.calc(startLocNo, locNo, mapType); - List<ShuttleCommand> commands = new ArrayList<>(); - if (calc == null) { - return null; - } - - List<NavigateNode> allNode = new ArrayList<>(); - allNode.addAll(calc); - - //鑾峰彇鍒嗘璺緞 - ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc); - //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 - for (ArrayList<NavigateNode> nodes : data) { - //寮�濮嬭矾寰� - NavigateNode startPath = nodes.get(0); - //涓棿璺緞 - NavigateNode middlePath = nodes.get(nodes.size() - 2); - //鐩爣璺緞 - NavigateNode endPath = nodes.get(nodes.size() - 1); - Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ()); - //鑾峰彇绉诲姩鍛戒护 - ShuttleCommand command = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCodeNum, middleToDistDistance, runSpeed); - commands.add(command); - } - - assignCommand.setNodes(allNode);//褰撳墠浠诲姟鎵�鍗犵敤鐨勮妭鐐筶ist - //鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� - NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(startLocNo)); - navigateMapData.writeNavigateNodeToRedisMap(allNode, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� - - return commands; - } - - //鑾峰彇璧风偣-涓偣-缁堢偣鎸囦护 - public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String middleLocNo, String locNo, ShuttleAssignCommand assignCommand, ShuttleThread shuttleThread) { - //鑾峰彇灏忚溅绉诲姩閫熷害 - BasShuttle basShuttle = basShuttleService.selectById(assignCommand.getShuttleNo()); - Integer runSpeed = 1000; - if (basShuttle != null) { - Integer runSpeed1 = basShuttle.getRunSpeed(); - if (runSpeed1 != null) { - runSpeed = runSpeed1; + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; } - } - - List<NavigateNode> allNode = new ArrayList<>(); - - //璁$畻灏忚溅璧风偣鍒颁腑鐐规墍闇�鍛戒护 - List<NavigateNode> calc = NavigateUtils.calc(startLocNo, middleLocNo, NavigationMapType.NORMAL.id);//灏忚溅鏃犺揣锛岃蛋姝e父搴撲綅閫氶亾 - List<ShuttleCommand> commands = new ArrayList<>(); - - if (calc != null) { - allNode.addAll(calc); - //鑾峰彇鍒嗘璺緞 - ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(calc); - //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 - for (ArrayList<NavigateNode> nodes : data) { - //寮�濮嬭矾寰� - NavigateNode startPath = nodes.get(0); - //涓棿璺緞 - NavigateNode middlePath = nodes.get(nodes.size() - 2); - //鐩爣璺緞 - NavigateNode endPath = nodes.get(nodes.size() - 1); - Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� - - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ()); - //鑾峰彇绉诲姩鍛戒护 - ShuttleCommand command = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCodeNum, middleToDistDistance, runSpeed); - commands.add(command); + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; } + if (!shuttleProtocol.isIdle()) { + return false; + } + //鍒ゆ柇灏忚溅浠ょ墝鏄惁鏈鍗犻 + if (shuttleProtocol.getToken() != 0) { + return false;//灏忚溅宸茶鐙崰锛岀姝㈠啀娲惧彂浠诲姟 + } + + //鍒ゆ柇灏忚溅鏄惁鍒拌揪杈撻�佺珯鐐瑰簱浣� + if (!shuttleProtocol.getCurrentLocNo().equals(basDevp.getLocNo())) { + //灏忚溅涓嶅湪杈撻�佺珯鐐逛綅缃� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo(), wrkMast.getShuttleNo());//璋冨害灏忚溅鍒拌揣鐗╂墍鍦ㄨ緭閫佺珯鐐硅繘琛屽彇璐� + return false; + } + + //灏忚溅宸叉姷杈捐緭閫佺珯鐐逛綅缃紝杩涜鎼繍璐х墿 + NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo(), wrkMast.getLocNo()); + if (result == null) {//璺緞璁$畻澶辫触 + return false; + } + + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//鍏ュ簱妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(result.getCommands());//杩愯鍛戒护 + assignCommand.setNodes(result.getNodes());//璺緞鑺傜偣 + + wrkMast.setWrkSts(5L);//4.鎻愬崌鏈烘惉杩愬畬鎴� => 5.灏忚溅鎼繍涓� + wrkMast.setModiTime(new Date()); + shuttleProtocol.setToken(wrkMast.getWrkNo());//鐙崰灏忚溅浠ょ墝 + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + } + + return false; } - - //灏忚溅鎸囦护鍒拌揪鐩爣浣嶇疆鍚庯紝鍐嶅彂鍑轰竴鏉¢《鍗囨寚浠� - commands.add(shuttleThread.getPalletCommand((short) 1)); - - //璁$畻灏忚溅涓偣鍒扮粓鐐规墍闇�鍛戒护 - List<NavigateNode> calc2 = NavigateUtils.calc(middleLocNo, locNo, NavigationMapType.DFX.id);//灏忚溅鏈夎揣锛岃蛋绂佺敤杩嘍FX搴撲綅鐨勫湴鍥鹃�氶亾 - if (calc2 == null) { - return null; - } - - allNode.addAll(calc2); - - //鑾峰彇鍒嗘璺緞 - ArrayList<ArrayList<NavigateNode>> data2 = NavigateUtils.getSectionPath(calc2); - for (ArrayList<NavigateNode> nodes : data2) { - //寮�濮嬭矾寰� - NavigateNode startPath = nodes.get(0); - //涓棿璺緞 - NavigateNode middlePath = nodes.get(nodes.size() - 2); - //鐩爣璺緞 - NavigateNode endPath = nodes.get(nodes.size() - 1); - Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� - - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short startCodeNum = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ()); - //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮� - Short distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ()); - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCodeNum, middleToDistDistance, runSpeed); - commands.add(moveCommand); - } - - //灏忚溅鎸囦护鍒拌揪鐩爣浣嶇疆鍚庯紝鍐嶅彂鍑轰竴鏉℃墭鐩樹笅闄嶆寚浠� - commands.add(shuttleThread.getPalletCommand((short) 2)); - - assignCommand.setNodes(allNode);//褰撳墠浠诲姟鎵�鍗犵敤鐨勮妭鐐筶ist - //鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� - NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(startLocNo)); - navigateMapData.writeNavigateNodeToRedisMap(allNode, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� - - return commands; + return true; } /** * 鍑哄簱 ===>> 鍥涘悜绌挎杞﹀嚭搴撲綔涓氫笅鍙� */ - public synchronized void shuttleIoOutExecute() { + public synchronized void shuttleOutExecute() { for (WrkMast wrkMast : wrkMastMapper.selectBy2125()) { - //鎻愬彇涓�鏉″緟鍑哄簱浠诲姟 - if (wrkMast != null) { - String outStaLocNo = null;//鍑哄簱绔欑偣搴撲綅鍙� - //鑾峰彇鍑哄簱绔欑偣 - for (DevpSlave devpSlave : slaveProperties.getDevp()) { - for (DevpSlave.StaRack staOutRack : devpSlave.getRackOutStn()) { - if (staOutRack.getStaNo().equals(wrkMast.getStaNo())) { - //鍑哄簱绔欑偣鍜屽伐浣滄。鍑哄簱绔欑偣涓�鑷� - outStaLocNo = CommonUtils.getLocNoFromRBL(staOutRack.getRow(), staOutRack.getBay(), staOutRack.getLev()); - } - } - - } - - if (wrkMast.getWrkSts() == 21 - || wrkMast.getWrkSts() == 25 - || wrkMast.getWrkSts() == 31) { - ShuttleThread shuttleThread = null; - HashMap<String, Object> searchIdleShuttle = null; - - LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); - LiftProtocol liftProtocol = liftThread.getLiftProtocol(); - - if (wrkMast.getWrkSts() == 21) { - //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅 - searchIdleShuttle = this.searchIdleShuttle(wrkMast); - shuttleThread = (ShuttleThread) searchIdleShuttle.get("result"); - }else if(wrkMast.getWrkSts() == 25) {//鐘舵��25锛岄渶瑕佸悜灏忚溅涓嬪彂鍛戒护浠庢彁鍗囨満绉诲姩鍑哄幓锛岄渶瑕佸垽鏂彁鍗囨満鐘舵槸鍚︾┖闂层�佹彁鍗囨満鏄惁鍒拌揪鐩爣妤煎眰銆佺洰鏍囨ゼ灞傜珯鐐规槸鍚﹀瓨鍦ㄣ�佺洰鏍囨ゼ灞傜珯鐐规槸鍚︾粰鍑烘彁鍗囨満鍒颁綅淇″彿 - - //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂� - if (!liftProtocol.isIdle()) { - continue;//鎻愬崌鏈哄繖 - } - - //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌浣嶏紝鍒ゆ柇绔欑偣鏄惁缁欏嚭鎻愬崌鏈哄埌浣嶄俊鍙� - String locNo = wrkMast.getSourceLocNo(); - int lev = Utils.getLev(locNo);//鐩爣浜岀淮鐮佹墍鍦ㄦゼ灞� - int liftLev = liftProtocol.getLev().intValue();//鎻愬崌鏈烘墍鍦ㄦゼ灞� - if (liftLev != lev) { - continue;//鎻愬崌鏈轰笉鍦ㄧ洰鏍囨ゼ灞傝烦杩� - } - - Integer staNo = Utils.levToOutInStaNo(lev); - DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1); - //鑾峰彇鐩爣绔欎俊鎭� - StaProtocol staProtocol1 = devpThread.getStation().get(staNo); - if (staProtocol1 == null) { - continue;//绔欑偣淇℃伅涓嶅瓨鍦� - } - if (!staProtocol1.isLiftArrival()) { - continue;//绔欑偣鎻愬崌鏈哄埌浣嶄俊鍙穎alse - } - - //缁х画瀹屾垚涔嬪墠灏忚溅鏈畬鎴愮殑浠诲姟 - shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); - } else if (wrkMast.getWrkSts() == 31) { - //缁х画瀹屾垚涔嬪墠灏忚溅鏈畬鎴愮殑浠诲姟 - shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); - } - - if (shuttleThread == null) { - continue; - } - - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (shuttleProtocol == null) { - continue; - } - - if (!shuttleProtocol.isIdle()) { - continue; - } - - if (outStaLocNo == null) { - continue; - } - - wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿 - //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) - String currentLocNo = shuttleProtocol.getCurrentLocNo(); - - //灏忚溅褰撳墠灞傞珮 - Integer currentLev = Utils.getLev(currentLocNo); - //鑾峰彇鎻愬崌鏈� - LiftSlave liftSlave = slaveProperties.getLift().get(0); - //褰撳墠妤煎眰鎻愬崌鏈鸿緭閫佺珯鐐瑰簱浣嶅彿 - String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev); - - //鍒嗛厤浠诲姟鍙� - shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue()); - //鍒嗛厤婧愬簱浣� - shuttleProtocol.setSourceLocNo(currentLocNo); - - ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); - //鍥涘悜绌挎杞﹀彿 - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); - //浠诲姟鍙� - assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); - //鍏ュ嚭搴撴ā寮� - assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue()); - assignCommand.setSourceLocNo(currentLocNo); - - if (wrkMast.getWrkSts() == 21) { - //鍒ゆ柇灏忚溅鍜屽簱浣嶆槸鍚﹀湪鍚屼竴灞� - if (Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) { - //鍚屼竴灞�(灏嗗皬杞︾Щ鍔ㄥ埌璐х墿浣嶇疆) - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread); - if (commands == null) { - //鏈壘鍒拌矾寰勶紝绛夊緟涓嬩竴娆� - continue; - } - //鍒嗛厤鐩爣搴撲綅 - shuttleProtocol.setLocNo(wrkMast.getSourceLocNo()); - //鐩爣搴撲綅 - assignCommand.setLocNo(wrkMast.getSourceLocNo()); - assignCommand.setCommands(commands); - wrkMast.setWrkSts(26L);//灏忚溅鎼繍涓� - }else { - //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿(灏嗗皬杞︾Щ鍔ㄥ埌鎻愬崌鏈轰綅缃�) - - //灏忚溅鍒版彁鍗囨満鍙f寚浠� - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread); - if (commands == null) { - continue;//鏈壘鍒拌矾寰� - } - shuttleProtocol.setLocNo(liftSiteLocNo); - - //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅 - BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo); - Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮� - - //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, endStartCode, 1400, 500); - commands.add(moveCommand); - - //鐩爣搴撲綅 - assignCommand.setLocNo(liftSiteLocNo); - assignCommand.setCommands(commands); - wrkMast.setWrkSts(22L);//灏忚溅杩佺Щ鐘舵�� - } - } else if (wrkMast.getWrkSts() == 25) { - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread); - if (commands == null) { - continue;//鏈壘鍒拌矾寰� - } - //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝闇�瑕佸涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛 - BasDevp basDevp = basDevpService.selectById(109);//鑾峰彇鎻愬崌鏈轰俊鎭� - short startCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈轰簩缁寸爜 - Short distCode = commands.get(0).getStartCodeNum();//鐩爣浜岀淮鐮� - //鑾峰彇绉诲姩鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1300, commands.get(0).getRunDirection(), (short) 1, 0); - commands.add(0, moveCommand);//灏嗚鎸囦护娣诲姞鍒伴槦澶� - - //鍒嗛厤鐩爣搴撲綅 - shuttleProtocol.setLocNo(wrkMast.getSourceLocNo()); - //鐩爣搴撲綅 - assignCommand.setLocNo(wrkMast.getSourceLocNo()); - assignCommand.setCommands(commands); - wrkMast.setWrkSts(26L);//灏忚溅鎼繍涓� - } - - if (wrkMastMapper.updateById(wrkMast) > 0) { - //涓嬪彂浠诲姟 - MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); - } - } + boolean step1 = this.shuttleOutExecuteStep1(wrkMast);//灏忚溅鎼嚭搴撲腑 + if (!step1) { + continue; } } } /** - * 鎼滅储绌洪棽涓旀渶杩戠殑鍥涘悜绌挎杞�(浠ュ伐浣滄。鐩爣搴撲綅涓哄熀鐐硅绠楁渶杩戜笖绌洪棽鐨勮溅) + * 鍑哄簱-灏忚溅鎼嚭搴撲腑 + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue */ - public HashMap<String,Object> searchIdleShuttle(WrkMast wrkMast) { - HashMap<String, Object> map = new HashMap<>(); - String locNo = wrkMast.getIoType() < 101 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();//搴撲綅鍙� - LocMast locMast = locMastService.queryByLoc(locNo);//鎵惧埌搴撲綅璁板綍 - int lev = Utils.getLev(locNo);//褰撳墠宸ヤ綔妗e簱浣嶅眰楂� - ShuttleThread recentShuttle = null;//褰撳墠璺濈鏈�杩戠殑鍥涘悜绌挎杞︾嚎绋� + public boolean shuttleOutExecuteStep1(WrkMast wrkMast) { + //21.鐢熸垚鍑哄簱浠诲姟 => 22.灏忚溅鎼繍涓� + if (wrkMast.getWrkSts() == 21) { + if (wrkMast.getShuttleNo() == null) {//娌℃湁缁戝畾灏忚溅锛岃繘琛岃皟搴� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//璋冨害灏忚溅鍒拌揣鐗╂墍鍦ㄥ簱浣嶈繘琛屽彇璐� + return false; + } - ArrayList<ShuttleThread> sameLev = new ArrayList<>();//鐩稿悓妤煎眰鐨勭┛姊溅 - ArrayList<ShuttleThread> diffLev = new ArrayList<>();//涓嶅悓妤煎眰鐨勭┛姊溅 - - for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { //鑾峰彇鍥涘悜绌挎杞︾嚎绋� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); if (shuttleProtocol == null) { - continue; + return false; } if (!shuttleProtocol.isIdle()) { - continue; + return false; + } + //鍒ゆ柇灏忚溅浠ょ墝鏄惁鏈鍗犻 + if (shuttleProtocol.getToken() != 0) { + return false;//灏忚溅宸茶鐙崰锛岀姝㈠啀娲惧彂浠诲姟 } - String shuttleLocNo = shuttleProtocol.getCurrentLocNo();//浜岀淮鐮佸搴斿簱浣嶅彿 - int shuttleLocNoLey = Utils.getLev(shuttleLocNo);//搴撲綅鍙峰搴斿眰楂� - if (lev == shuttleLocNoLey) { - //宸ヤ綔妗fゼ灞傜浉鍚岀殑绌挎杞� - sameLev.add(shuttleThread); - }else { - //宸ヤ綔妗d笉鍚屾ゼ灞傜殑绌挎杞� - diffLev.add(shuttleThread); + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), wrkMast.getLiftNo()); + if (targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 } + //鍒ゆ柇灏忚溅鏄惁鍒拌揪璐х墿搴撲綅 + if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { + //灏忚溅涓嶅湪杈撻�佺珯鐐逛綅缃� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//璋冨害灏忚溅鍒拌揣鐗╂墍鍦ㄨ緭閫佺珯鐐硅繘琛屽彇璐� + return false; + } + + //灏忚溅宸叉姷杈捐揣鐗╀綅缃紝杩涜鎼繍璐х墿 + NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), targetBasDevp.getLocNo()); + if (result == null) {//鍑哄簱璺緞璁$畻澶辫触 + return false; + } + + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());//鍑哄簱妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(result.getCommands());//杩愯鍛戒护 + assignCommand.setNodes(result.getNodes());//璺緞鑺傜偣 + + wrkMast.setWrkSts(22L);//21.鐢熸垚鍑哄簱浠诲姟 => 22.灏忚溅鎼繍涓� + wrkMast.setModiTime(new Date()); + shuttleProtocol.setToken(wrkMast.getWrkNo());//鐙崰灏忚溅浠ょ墝 + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + } + return false; } - - if (sameLev.size() > 0) { - //鍚屼竴妤煎眰鏈夌┖闂茬┛姊溅锛屽垯鍙湪宸ヤ綔妗fゼ灞傚鎵� - //瀵绘壘绂讳换鍔℃渶杩戠殑绌挎杞� - for (ShuttleThread shuttleThread : sameLev) { - if (recentShuttle == null) {//鏈�杩戠┛姊溅涓虹┖锛屽垯榛樿璧嬩簣涓烘渶杩戠┛姊溅 - recentShuttle = shuttleThread; - } - - //鍒ゆ柇鍏朵粬绌洪棽绌挎杞︽槸鍚︾浠诲姟鏈�杩� - String distLocNo = null;//鐩爣鍦扮偣锛屽叆搴�=銆嬫彁鍗囨満鍙o紝鍑哄簱=銆嬭揣鐗╁簱浣嶅彿 - if (wrkMast.getIoType() < 101) { - //鍏ュ簱 - distLocNo = Utils.levToOutInStaLocNo(lev); - }else { - //鍑哄簱 - distLocNo = locNo; - } - - //褰撳墠绌挎杞﹀簱浣嶅彿 - String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo(); - //鐩墠鏈�杩戠┛姊溅搴撲綅鍙� - String recentLocNo = recentShuttle.getShuttleProtocol().getCurrentLocNo(); - - //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒扮洰鏍囧湴鐐硅窛绂� - List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentLocNo, distLocNo, NavigationMapType.NORMAL.id);//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘 - //褰撳墠绌挎杞︾嚎绋嬪埌鐩爣鍦扮偣璺濈 - List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, distLocNo, NavigationMapType.NORMAL.id);//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘 - if (recentShuttlePath == null || currentShuttlePath == null) { - continue; - } - Integer recentAllDistance = NavigateUtils.getOriginPathAllDistance(recentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - if (currentAllDistance < recentAllDistance) { - //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅 - recentShuttle = shuttleThread; - } - } - - map.put("sameLay", true);//鍚屽眰 - map.put("result", recentShuttle); - }else { - //鍚屼竴妤煎眰锛屾病鏈夌┖闂茬┛姊溅锛屽彧鑳戒粠鍏朵粬妤煎眰璋冨害 - //瀵绘壘绂讳换鍔℃渶杩戠殑绌挎杞� - for (ShuttleThread shuttleThread : diffLev) { - if (recentShuttle == null) {//鏈�杩戠┛姊溅涓虹┖锛屽垯榛樿璧嬩簣涓烘渶杩戠┛姊溅 - recentShuttle = shuttleThread; - } - - //褰撳墠绌挎杞﹀簱浣嶅彿 - String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo(); - int currentLev = Utils.getLev(currentLocNo); - //鐩墠鏈�杩戠┛姊溅搴撲綅鍙� - String recentLocNo = recentShuttle.getShuttleProtocol().getCurrentLocNo(); - int recentLev = Utils.getLev(recentLocNo); - - //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒板綋鍓嶈溅瀛愭墍鍦ㄦゼ灞傜殑鎻愬崌鏈哄彛璺濈 - List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentLocNo, Utils.levToOutInStaLocNo(recentLev), NavigationMapType.NORMAL.id);//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘 - //褰撳墠绌挎杞︾嚎绋嬪埌褰撳墠杞﹀瓙鎵�鍦ㄦゼ灞傜殑鎻愬崌鏈哄彛璺濈 - List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, Utils.levToOutInStaLocNo(currentLev), NavigationMapType.NORMAL.id);//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘 - if (recentShuttlePath == null || currentShuttlePath == null) { - continue; - } - - Integer recentAllDistance = NavigateUtils.getOriginPathAllDistance(recentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� - if (currentAllDistance < recentAllDistance) { - //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅 - recentShuttle = shuttleThread; - } - } - - map.put("sameLay", false);//涓嶅悓灞� - map.put("result", recentShuttle); - } - return map; + return true; } /** @@ -1240,8 +851,8 @@ public synchronized void shuttleFinished() { for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { //鑾峰彇鍥涘悜绌挎杞︿俊鎭� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); if (shuttleProtocol == null) { continue; } @@ -1249,23 +860,41 @@ //鍥涘悜绌挎杞︾姸鎬佷负绛夊緟纭銆佸皬杞﹀浜庣┖闂茬姸鎬� if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id //浠诲姟瀹屾垚绛夊緟纭 && shuttleProtocol.getTaskNo() != 0 - && shuttleProtocol.getBusyStatus() == 0 + && shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id ) { //灏嗕换鍔℃。鏍囪涓哄畬鎴� - WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue()); + WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo()); if (wrkMast != null) { switch (wrkMast.getWrkSts().intValue()) { - case 9://9.灏忚溅鍏ュ簱鎼繍涓� ==> 14.鍏ュ簱瀹屾垚 - wrkMast.setWrkSts(14L); + case 5://5.灏忚溅鎼繍涓� ==> 9.鍏ュ簱瀹屾垚 + wrkMast.setWrkSts(9L); + if (shuttleProtocol.getToken() == wrkMast.getWrkNo()) { + //閲婃斁灏忚溅浠ょ墝 + shuttleProtocol.setToken(0); + } break; - case 5://5.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙� ==> 6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� - wrkMast.setWrkSts(6L); - break; - case 22://22.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙� ==> 23.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� + case 22://22.灏忚溅鎼繍涓� ==> 23.灏忚溅鎼繍瀹屾垚 wrkMast.setWrkSts(23L); + if (shuttleProtocol.getToken() == wrkMast.getWrkNo()) { + //閲婃斁灏忚溅浠ょ墝 + shuttleProtocol.setToken(0); + } break; - case 26://26.灏忚溅鍑哄簱鎼繍涓� ==> 27.灏忚溅鍑哄簱鎼繍瀹屾垚 - wrkMast.setWrkSts(27L); + case 102://102.灏忚溅绉诲姩鑷崇珯鐐� ==> 103.灏忚溅绉诲姩鑷崇珯鐐瑰畬鎴� + wrkMast.setWrkSts(103L); + break; + case 104://104.灏忚溅杩佸叆鎻愬崌鏈轰腑 ==> 105.灏忚溅杩佸叆鎻愬崌鏈哄畬鎴� + wrkMast.setWrkSts(105L); + break; + case 108://108.灏忚溅杩佸嚭鎻愬崌鏈轰腑 ==> 109.灏忚溅杩佸嚭鎻愬崌鏈哄畬鎴� + wrkMast.setWrkSts(109L); + break; + case 110://110.灏忚溅绉诲姩涓� ==> 111.灏忚溅绉诲姩瀹屾垚 + wrkMast.setWrkSts(111L); + if (shuttleProtocol.getToken() == wrkMast.getWrkNo()) { + //閲婃斁灏忚溅浠ょ墝 + shuttleProtocol.setToken(0); + } break; default: } @@ -1273,14 +902,10 @@ if (wrkMastMapper.updateById(wrkMast) > 0) { //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵�� shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE); - //浠诲姟鍙锋竻闆� - shuttleProtocol.setTaskNo((short) 0); //婧愬簱浣嶆竻闆� shuttleProtocol.setSourceLocNo(null); //鐩爣搴撲綅娓呴浂 shuttleProtocol.setLocNo(null); - //鏍囪澶嶄綅 - shuttleProtocol.setPakMk(true); //浠诲姟鎸囦护娓呴浂 shuttleProtocol.setAssignCommand(null); News.info("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傚洓鍚戠┛姊溅鍙�={}", shuttleProtocol.getShuttleNo()); @@ -1289,47 +914,6 @@ } } - } - - //鍥涘悜绌挎杞︾姸鎬佷负鍏呯數鐘舵�� - if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id //鍏呯數鏍囪瘑 - && shuttleProtocol.getTaskNo() != 0) { - //鏌ヨ鏄惁鏈夊厖鐢典换鍔� - WrkCharge wrkCharge = wrkChargeMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue()); - if (wrkCharge != null) { - switch (wrkCharge.getWrkSts().intValue()) { - case 52://鍥涘悜绌挎杞﹁縼绉诲埌鎻愬崌鏈哄彛 - wrkCharge.setWrkSts(53L);//杩佺Щ瀹屾垚 - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING); - break; - case 56: - if (shuttleProtocol.getBatteryPower() == 1000) { - wrkCharge.setWrkSts(60L);//鍏呯數瀹屾垚 - } - break; - default: - } - - if (wrkChargeMapper.updateById(wrkCharge) > 0) { - if (wrkCharge.getWrkSts() == 60) { - //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵�� - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE); - } - //浠诲姟鍙锋竻闆� - shuttleProtocol.setTaskNo((short) 0); - //婧愬簱浣嶆竻闆� - shuttleProtocol.setSourceLocNo(null); - //鐩爣搴撲綅娓呴浂 - shuttleProtocol.setLocNo(null); - //鏍囪澶嶄綅 - shuttleProtocol.setPakMk(true); - //浠诲姟鎸囦护娓呴浂 - shuttleProtocol.setAssignCommand(null); - News.info("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傚洓鍚戠┛姊溅鍙�={}", shuttleProtocol.getShuttleNo()); - } else { - News.error("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傚洓鍚戠┛姊溅鍙�={}锛屽伐浣滃彿={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo()); - } - } } } @@ -1349,206 +933,169 @@ continue; } - //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬� if (!liftProtocol.isIdle()) { continue; } //鎼滅储鏄惁鏈夊緟澶勭悊鐨勪换鍔� - WrkMast wrkMast = wrkMastMapper.selectLiftStep262327(); - if (wrkMast == null) { + List<WrkMast> wrkMasts = wrkMastMapper.selectLiftStep223103(); + if (wrkMasts.isEmpty()) { continue; } - //缁欐彁鍗囨満鍒嗛厤浠诲姟 - liftProtocol.setLiftLock(true);//閿佸畾鎻愬崌鏈� - liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙� - liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓� + for (WrkMast wrkMast : wrkMasts) { + //鎼滅储鏄惁鏈夊叾浠栦换鍔″崰鐢ㄤ簡鎻愬崌鏈猴紝濡傛灉鍗犵敤鎻愬崌鏈虹殑浠诲姟鍜屽綋鍓嶄换鍔$浉鍚岋紝鍒欒繍琛屾墽琛� + WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue()); + if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) { + continue; + } - //鍛戒护list - ArrayList<LiftCommand> commands = new ArrayList<>(); + boolean stepIn = this.liftIoExecuteStepIn(wrkMast);//鎻愬崌鏈哄叆搴� + if (!stepIn) { + continue; + } - DevpThread devpThread = null; - Integer devpId = null; - for (DevpSlave devp : slaveProperties.getDevp()){ - // 鑾峰彇鍏ュ簱绔欎俊鎭� - devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId()); - devpId = devp.getId(); + boolean stepOut = this.liftIoExecuteStepOut(wrkMast);//鎻愬崌鏈哄嚭搴� + if (!stepOut) { + continue; + } } - if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋 - //宸ヤ綔妗g洰鏍囧簱浣嶅彿 - String wrkMastLocNo = wrkMast.getLocNo(); - //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞� - int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo); + } + } - //鎻愬崌鏈哄綋鍓嶆ゼ灞� - int liftLev = liftProtocol.getLev().intValue(); - if (liftLev == 0) {//鎻愬崌鏈哄綋鍓嶆ゼ灞備负0锛屾彁鍗囨満澶卞幓浣嶇疆淇℃伅锛岃鎻愬崌鏈哄墠寰�涓�妤� - LiftCommand command = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.ONE.lev); - commands.add(command);//灏嗗懡浠ゆ坊鍔犺繘list - } + /** + * 鎻愬崌鏈哄叆搴� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean liftIoExecuteStepIn(WrkMast wrkMast) { + //--------------------------------------鎻愬崌鏈哄叆搴�-----------------------------------------// + Date now = new Date(); - if (liftLev != LiftLevType.TWO.realLev) { - //鎻愬崌鏈轰笉鍦ㄨ緭閫佺嚎妤煎眰锛岃幏鍙栧埌杈撻�佺嚎灞傜殑鎻愬崌鏈哄懡浠� - LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev); - commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list - } - - //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣姝h浆) - LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 3); - command2.setOperaStaNo((short) 102);//鎿嶄綔102绔� - command2.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞� - command2.setDevpId(devpId); - commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list - - Integer levTmp = wrkMastLocNoLey; - if (wrkMastLocNoLey >= 2) { - levTmp += 1; - } - - //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�) - LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), levTmp); - commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list - - //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(姝h浆) - //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓 - LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1); - Integer distStaNo = Utils.levToOutInStaNo(levTmp); - command4.setOperaStaNo(distStaNo.shortValue());//鎿嶄綔鐩爣妤煎眰绔欑偣 - command4.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞� - command4.setDevpId(devpId); - command4.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔� - commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list - - wrkMast.setWrkSts(3L);//3.鎻愬崌鏈烘惉杩愪腑 - } else if (wrkMast.getWrkSts() == 6) {//6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 7.鎻愬崌鏈鸿縼绉诲皬杞︿腑 - liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿 - - //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); - if (shuttleThread == null) { - continue; - } - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (shuttleProtocol == null) { - continue; - } - if (!shuttleProtocol.isIdle()) { - continue;//灏忚溅鐘舵�佸繖 - } - if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) { - continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛� - } - - //宸ヤ綔妗g洰鏍囧簱浣嶅彿 - String wrkMastLocNo = wrkMast.getIoType() == 101 ? wrkMast.getSourceLocNo() : wrkMast.getLocNo(); - //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞� - int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo); - if (wrkMastLocNoLey >= 2) { - wrkMastLocNoLey++; - } - - //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�) - LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey); - commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list - - wrkMast.setWrkSts(7L);//6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 7.鎻愬崌鏈鸿縼绉诲皬杞︿腑 - } else if(wrkMast.getWrkSts() == 23) {//23.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 24.鎻愬崌鏈鸿縼绉诲皬杞︿腑 - liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿 - - //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); - if (shuttleThread == null) { - continue; - } - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (shuttleProtocol == null) { - continue; - } - - if (!shuttleProtocol.isIdle()) { - continue;//灏忚溅鐘舵�佸繖 - } - if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) { - continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛� - } - - //宸ヤ綔妗g洰鏍囧簱浣嶅彿 - String wrkMastLocNo = wrkMast.getIoType() == 101 ? wrkMast.getSourceLocNo() : wrkMast.getLocNo(); - //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞� - int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo); - if (wrkMastLocNoLey >= 2) { - wrkMastLocNoLey++; - } - - //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�) - LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey); - commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list - - wrkMast.setWrkSts(24L);//23.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 24.鎻愬崌鏈鸿縼绉诲皬杞︿腑 - } else if (wrkMast.getWrkSts() == 27) {//27.灏忚溅鍑哄簱鎼繍瀹屾垚 - //宸ヤ綔妗f簮搴撲綅鍙� - String wrkMastLocNo = wrkMast.getSourceLocNo(); - //宸ヤ綔妗f簮搴撲綅妤煎眰 - int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo); - - //鎻愬崌鏈哄綋鍓嶆ゼ灞� - int liftLev = liftProtocol.getLev().intValue(); - if (liftLev == 0) {//鎻愬崌鏈哄綋鍓嶆ゼ灞備负0锛屾彁鍗囨満澶卞幓浣嶇疆淇℃伅锛岃鎻愬崌鏈哄墠寰�涓�妤� - LiftCommand command = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.ONE.lev); - commands.add(command);//灏嗗懡浠ゆ坊鍔犺繘list - } - - //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀埌浣� - StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey));//璧峰绔欑偣 - if (liftLev != wrkMastLocNoLey && wrkMastLocNoLey != 1 || !staProtocol.isLiftArrival()) { - //鎻愬崌鏈轰笉鍦ㄥ伐浣滄。婧愬簱浣嶆ゼ灞傦紝璋冨害鎻愬崌鏈� - LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey); - commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list - } - - //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣鍙嶈浆) - LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 4); - command2.setOperaStaNo(staProtocol.getSiteId().shortValue());//杈撻�佺嚎鎿嶄綔绔欑偣鍙� - command2.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞� - command2.setDevpId(devpId);//杈撻�佺嚎iD - command2.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104 - commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list - - //鎻愬崌鏈哄墠寰�鍑哄簱鍙o紝杈撻�佺嚎妤煎眰 - LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev); - commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list - - //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(鍙嶈浆) - //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓 - LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2); - command4.setOperaStaNo((short) 102);//鎿嶄綔102绔� - command4.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞� - command4.setDevpId(devpId); - commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list - - //鎻愬崌鏈洪摼鏉℃墽琛屽畬姣曞悗锛岀粰102绔欏啓鍏ヨ祫鏂� - LiftCommand command5 = liftThread.getResetCommand(); - command5.setDevpId(devpId);//杈撻�佺嚎iD - command5.setOperaStaNo((short) 102);//鎿嶄綔102绔� - command5.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104 - command5.setRotationDire(0);//閾炬潯杞姩鍋滄 - commands.add(command5); - - wrkMast.setWrkSts(28L);//28.鎻愬崌鏈烘惉杩愪腑 + //2.璁惧涓婅蛋 ==> 3.鎻愬崌鏈烘惉杩愪腑 + if (wrkMast.getWrkSts() == 2) { + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) { + return false; + } + //鍒ゆ柇鎻愬崌鏈轰护鐗屾槸鍚︽湭琚崰棰� + if (liftProtocol.getToken() != 0) { + return false;//鎻愬崌鏈哄凡琚嫭鍗狅紝绂佹鍐嶆淳鍙戜换鍔� + } + //鍒ゆ柇鎻愬崌鏈烘槸鍚︽湁鍏朵粬浠诲姟 + WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId()); + if (liftWrkMast != null) { + return false;//褰撳墠鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛岀瓑寰呬笅涓�娆¤疆璇� } - //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣� + //鑾峰彇婧愮珯瀵瑰簲鐨勮緭閫佺珯鐐� + BasDevp sourceBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo()); + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getStaNo()); + if (sourceBasDevp == null || targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈哄懡浠� + NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo()); + + ArrayList<NyLiftCommand> commands = new ArrayList<>(); + commands.add(liftCommand); + + //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔 LiftAssignCommand assignCommand = new LiftAssignCommand(); assignCommand.setCommands(commands); assignCommand.setLiftNo(liftProtocol.getLiftNo()); - assignCommand.setTaskNo(liftProtocol.getTaskNo()); + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); + assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue()); + + wrkMast.setWrkSts(3L);//2.璁惧涓婅蛋 ==> 3.鎻愬崌鏈烘惉杩愪腑 + wrkMast.setLiftNo(liftThread.getSlave().getId());//浠诲姟妗g粦瀹氭彁鍗囨満鍙� + wrkMast.setModiTime(now); + liftProtocol.setToken(wrkMast.getWrkNo());//鐙崰鎻愬崌鏈轰护鐗� if (wrkMastMapper.updateById(wrkMast) > 0) { //涓嬪彂浠诲姟 MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand)); } + + return false; } + return true; + } + + /** + * 鎻愬崌鏈哄嚭搴� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean liftIoExecuteStepOut(WrkMast wrkMast) { + //--------------------------------------鎻愬崌鏈哄嚭搴�-----------------------------------------// + Date now = new Date(); + + //23.灏忚溅鎼繍瀹屾垚 ==> 24.鎻愬崌鏈烘惉杩愪腑 + if (wrkMast.getWrkSts() == 23) { + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) { + return false; + } + //鍒ゆ柇鎻愬崌鏈轰护鐗屾槸鍚︽湭琚崰棰� + if (liftProtocol.getToken() != 0) { + return false;//鎻愬崌鏈哄凡琚嫭鍗狅紝绂佹鍐嶆淳鍙戜换鍔� + } + //鍒ゆ柇鎻愬崌鏈烘槸鍚︽湁鍏朵粬浠诲姟 + WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId()); + if (liftWrkMast != null) { + return false;//褰撳墠鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛岀瓑寰呬笅涓�娆¤疆璇� + } + + //鑾峰彇婧愮珯瀵瑰簲鐨勮緭閫佺珯鐐� + BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue()); + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo()); + if (sourceBasDevp == null || targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈哄懡浠� + NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo()); + + ArrayList<NyLiftCommand> commands = new ArrayList<>(); + commands.add(liftCommand); + + //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔 + LiftAssignCommand assignCommand = new LiftAssignCommand(); + assignCommand.setCommands(commands); + assignCommand.setLiftNo(liftProtocol.getLiftNo()); + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); + assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue()); + + wrkMast.setWrkSts(24L);//23.灏忚溅鎼繍瀹屾垚 ==> 24.鎻愬崌鏈烘惉杩愪腑 + wrkMast.setLiftNo(liftThread.getSlave().getId());//浠诲姟妗g粦瀹氭彁鍗囨満鍙� + wrkMast.setModiTime(now); + liftProtocol.setToken(wrkMast.getWrkNo());//鐙崰鎻愬崌鏈轰护鐗� + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand)); + } + + return false; + } + return true; } /** @@ -1566,41 +1113,33 @@ //鎻愬崌鏈轰负绛夊緟纭涓旂┖闂� if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id && liftProtocol.getTaskNo() != 0 - && !liftProtocol.getRunning() + && !liftProtocol.getBusy() ) { - DevpThread devpThread = null; - Integer devpId = null; - for (DevpSlave devp : slaveProperties.getDevp()){ - // 鑾峰彇鍏ュ簱绔欎俊鎭� - devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId()); - devpId = devp.getId(); - } - //灏嗕换鍔℃。鏍囪涓哄畬鎴� - WrkMast wrkMast = wrkMastMapper.selectByWorkNo372428(liftProtocol.getTaskNo().intValue()); + WrkMast wrkMast = wrkMastMapper.selectByWorkNo324104(liftProtocol.getTaskNo().intValue()); if (wrkMast != null) { switch (wrkMast.getWrkSts().intValue()) { case 3://3.鎻愬崌鏈烘惉杩愪腑 ==> 4.鎻愬崌鏈烘惉杩愬畬鎴� - //缁欑洰鏍囩珯璁剧疆宸ヤ綔鍙� - StaProtocol staProtocol = devpThread.getStation().get(wrkMast.getStaNo());//鐩爣绔� - staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue()); - staProtocol.setStaNo(wrkMast.getStaNo().shortValue()); - boolean result = MessageQueue.offer(SlaveType.Devp, devpId, new Task(2, staProtocol)); - if (!result) { - throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触"); - } wrkMast.setWrkSts(4L); + wrkMast.setLiftNo(null);//閲婃斁鎻愬崌鏈� + if (liftProtocol.getToken() == wrkMast.getWrkNo()) { + //閲婃斁鎻愬崌鏈轰护鐗� + liftProtocol.setToken(0); + } break; - case 7://7.鎻愬崌鏈鸿縼绉诲皬杞︿腑 ==> 8.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴� - wrkMast.setWrkSts(8L); - break; - case 24://24.鎻愬崌鏈鸿縼绉诲皬杞︿腑 ==> 25.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴� + case 24://24.鎻愬崌鏈烘惉杩愪腑 ==> 25.鎻愬崌鏈烘惉杩愬畬鎴� wrkMast.setWrkSts(25L); + if (wrkMast.getIoType() == 11) {//搴撲綅绉昏浆 + wrkMast.setWrkSts(4L);//4.鎻愬崌鏈烘惉杩愬畬鎴� + } + if (liftProtocol.getToken() == wrkMast.getWrkNo()) { + //閲婃斁鎻愬崌鏈轰护鐗� + liftProtocol.setToken(0); + } break; - case 28://28.鎻愬崌鏈烘惉杩愪腑 ==> 29.鎻愬崌鏈烘惉杩愬畬鎴� - wrkMast.setWrkSts(29L); - wrkMast.setWrkSts(34L);//34.鍑哄簱瀹屾垚锛屾殏鏃跺厛鐩存帴瀹屾垚鍑哄簱宸ヤ綔妗o紝鍚庣画闇�瑕佹牴鎹緭閫佺嚎缁欏嚭鐨勭姸鎬佹潵纭畾34.鍑哄簱瀹屾垚鐘舵�� + case 106://106.鎻愬崌鏈烘惉杩愪腑 ==> 107.鎻愬崌鏈烘惉杩愬畬鎴� + wrkMast.setWrkSts(107L); break; default: } @@ -1608,340 +1147,309 @@ if (wrkMastMapper.updateById(wrkMast) > 0) { //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵�� liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE); - //浠诲姟鍙锋竻闆� - liftProtocol.setTaskNo((short) 0); - //鏍囪澶嶄綅 - liftProtocol.setPakMk(true); //浠诲姟鎸囦护娓呴浂 liftProtocol.setAssignCommand(null); - News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo()); + News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬併�傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo()); } else { News.error("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傛彁鍗囨満鍙�={}锛屽伐浣滃彿={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo()); } } - //鏌ヨ鏄惁鏈夊厖鐢典换鍔� - WrkCharge wrkCharge = wrkChargeMapper.selectByWorkNo(liftProtocol.getTaskNo().intValue()); - if (wrkCharge != null) { - switch (wrkCharge.getWrkSts().intValue()) { - case 54://鎻愬崌鏈烘惉杩愪腑 - wrkCharge.setWrkSts(55L);//鎻愬崌鏈烘惉杩愬畬鎴� - break; - default: - } - - if (wrkChargeMapper.updateById(wrkCharge) > 0) { - //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵�� - liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE); - //浠诲姟鍙锋竻闆� - liftProtocol.setTaskNo((short) 0); - //鏍囪澶嶄綅 - liftProtocol.setPakMk(true); - //浠诲姟鎸囦护娓呴浂 - liftProtocol.setAssignCommand(null); - News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo()); - } else { - News.error("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傛彁鍗囨満鍙�={}锛屽伐浣滃彿={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo()); - } - } - - //涓嶆槸鍏ュ嚭搴撹皟搴︿换鍔°�佸伐浣滄。浠诲姟锛岃繘琛屾彁鍗囨満鐨勫浣� - if (liftProtocol.getAssignCommand() != null) { - //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵�� - liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE); - //浠诲姟鍙锋竻闆� - liftProtocol.setTaskNo((short) 0); - //鏍囪澶嶄綅 - liftProtocol.setPakMk(true); - //浠诲姟鎸囦护娓呴浂 - liftProtocol.setAssignCommand(null); - News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo()); - } - } } } /** - * 褰撳墠搴撲綅缁勬槸鍚﹀瓨鍦ㄧ┖闂插皬杞� + * 搴撲綅绉昏浆 */ - public Integer hasCar(String locNo) { - for (SteSlave ste : slaveProperties.getSte()) { - // 鑾峰彇鍫嗗灈鏈轰俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId()); - SteProtocol steProtocol = steThread.getSteProtocol(); - BasSte basSte = basSteService.selectById(ste.getId()); - if (Cools.isEmpty(steProtocol, basSte)) { continue; } - if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(basSte.getRow(), true)) - && basSte.getBay() == Utils.getBay(locNo) - && basSte.getLev() == Utils.getLev(locNo)) { - return ste.getId(); - } - } - return null; - } - - /** - * 褰撳墠搴撲綅缁勬槸鍚﹀瓨鍦ㄥ叾浠栧皬杞� - */ - public Integer existOtherSte(String locNo, Integer steNo) { - Integer otherSteNo = null; - for (SteSlave ste : slaveProperties.getSte()) { - if (ste.getId().equals(steNo)) { continue; } - // 鑾峰彇鍫嗗灈鏈轰俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId()); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { continue; } - if (steProtocol.isEnable()) { - BasSte basSte = basSteService.selectById(ste.getId()); - if (basSte != null) { - if ((Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(basSte.getRow(), true)) - && basSte.getBay() == Utils.getBay(locNo) - && basSte.getLev() == Utils.getLev(locNo)) - || - (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true)) - && steProtocol.getBay() == Utils.getBay(locNo) - && steProtocol.getLev() == Utils.getLev(locNo)) - ) { - otherSteNo = ste.getId(); - break; - } - } - } - } - return otherSteNo; - } - - /** - * 褰撳墠搴撲綅缁勬槸鍚﹀瓨鍦ㄧ┖闂插皬杞� - */ - public Integer hasCarOfIdle(String locNo) { - for (SteSlave ste : slaveProperties.getSte()) { - // 鑾峰彇鍫嗗灈鏈轰俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId()); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { continue; } - if (steProtocol.isIdle()) { - if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true)) - && steProtocol.getBay() == Utils.getBay(locNo) - && steProtocol.getLev() == Utils.getLev(locNo)) { - return steProtocol.getSteNo().intValue(); - } - } - } - return null; - } - - /** - * 鏌ユ壘褰撳墠搴撲綅鏈�閫傚悎鐨勭┛姊溅鏉ヤ綔涓� - */ - public SteThread queryIdleCar(WrkMast wrkMast) { - List<BasSte> basStes = basSteService.selectList(new EntityWrapper<>()); - int val = 0; - SteThread result = null; - for (BasSte basSte : basStes) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, basSte.getSteNo()); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { continue; } - if (!steProtocol.isIdle()) { continue; } -// if (steProtocol.getRow() == 1) { continue; } - String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo(); - // 濡傛灉鍦ㄥ悓涓�涓簱浣嶇粍 - if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true)) - && steProtocol.getBay().intValue() == Utils.getBay(locNo) - && steProtocol.getLev().intValue() == Utils.getLev(locNo)) { - return steThread; - } - LocMast locMast = locMastService.selectById(locNo); - int lev = locMast.getLev1(); - int bay = locMast.getBay1(); - int levAbs = Math.abs(lev - steProtocol.getLev()); - int bayAbs = Math.abs(bay - steProtocol.getBay()); - if (val == 0) { - val = levAbs + bayAbs; - result = steThread; - } else { - if ((levAbs + bayAbs) < val) { - val = levAbs + bayAbs; - result = steThread; - } - } - } - return result; - } - - public SteThread queryIdleCar(CrnProtocol crnProtocol) { - List<BasSte> basStes = basSteService.selectList(new EntityWrapper<>()); - int val = 0; - SteThread result = null; - for (BasSte basSte : basStes) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, basSte.getSteNo()); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { continue; } - if (!steProtocol.isIdle()) { continue; } - if (steProtocol.getRow() == 1) { continue;} - int lev = crnProtocol.getLevel(); - int bay = crnProtocol.getBay(); - int levAbs = Math.abs(lev - steProtocol.getLev()); - int bayAbs = Math.abs(bay - steProtocol.getBay()); - if (val == 0) { - val = levAbs + bayAbs; - result = steThread; - } else { - if ((levAbs + bayAbs) < val) { - val = levAbs + bayAbs; - result = steThread; - } - } - } - return result; - } - - /** - * 璁╁皬杞﹁璧拌嚦寰呮満浣� - */ - public void letCarBeWaiting(WrkMast wrkMast, Integer steNo, String locNo) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { return; } - if (steProtocol.isIdle()) { - - // 濡傛灉澶勪簬寰呮満浣� - if (steProtocol.locaType.equals(SteLocaType.A_WAITING) || steProtocol.locaType.equals(SteLocaType.B_WAITING)) { - // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� - wrkMast.setWrkSts(3L); - wrkMast.setSteNo(steNo); - wrkMast.setModiTime(new Date()); - if (wrkMastMapper.updateById(wrkMast) == 0) { - News.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo()); - } - } else { - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙� - steCommand.setTaskMode(SteTaskModeType.findWaiting(steProtocol.getRow().intValue())); // 浠诲姟妯″紡: 琛岃蛋鑷冲緟鏈轰綅 - - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); - - if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� - wrkMast.setSteNo(steNo); - wrkMast.setModiTime(new Date()); - if (wrkMastMapper.updateById(wrkMast) == 0) { - News.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo()); - } - } - } - } - } - - public void letCarBeWaiting(WrkCharge wrkCharge, Integer steNo) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { return; } - - if (!basSteService.updatePakMk(steNo, "Y")) { - News.error("淇敼绌挎杞︿綔涓氱姸鎬� 澶辫触锛侊紒锛岀┛姊溅={}", steNo); + public synchronized void locToLocExecute() { + //鑾峰彇鍑哄叆搴撳伐浣滄。 + List<WrkMast> wrkMasts = wrkMastMapper.selectInOutWrkMast(); + if (wrkMasts.size() > 0) { + //鏈夊嚭鍏ュ簱浠诲姟锛屽繀椤荤瓑寰呬换鍔℃墽琛屽畬姣曞啀鎵ц搴撲綅绉昏浆 return; } - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙� - steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol.getRow().intValue())); // 浠诲姟妯″紡: 鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙� + //鏌ヨ搴撲綅绉昏浆宸ヤ綔妗� + List<WrkMast> wrkMasts1 = wrkMastMapper.selectLocToLocWrkMast(); + for (WrkMast wrkMast : wrkMasts1) { + if (wrkMast.getSourceLocNo().equals(wrkMast.getLocNo())) { + boolean step1 = this.locToLocExecuteStep1(wrkMast);//鍚屾ゼ灞傚簱浣嶇Щ杞� + if (!step1) { + continue; + } + }else { + //璺ㄦゼ灞傚簱浣嶇Щ杞� + boolean step2 = this.locToLocExecuteStep2(wrkMast);//璋冨害杞﹁締鍙栬揣骞惰繍閫佸埌鍑哄簱鍙� + if (!step2) { + continue; + } - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); + boolean step3 = this.locToLocExecuteStep3(wrkMast);//鎻愬崌鏈烘惉杩愯揣鐗� + if (!step3) { + continue; + } - if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� - wrkCharge.setSteNo(steNo); - wrkCharge.setModiTime(new Date()); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo()); + boolean step4 = this.locToLocExecuteStep4(wrkMast);//璋冨害杞﹁締鍙栬揣骞惰繍閫佸埌鍑哄簱鍙� + if (!step4) { + continue; + } + } + } } /** - * 璁╁皬杞︿粠 杩滅偣 ====>> 绉诲姩鍒拌繎鐐� - * 绛夊緟鍫嗗灈鏈烘惉杩� + * 鍚屾ゼ灞傚簱浣嶇Щ杞� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue */ - public void letCarBeReady(WrkMast wrkMast, Integer steNo, String locNo) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { return; } - if (steProtocol.isIdle()) { - - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙� - steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol)); // 浠诲姟妯″紡: 鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙� - - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); - - if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� - wrkMast.setSteNo(steNo); - wrkMast.setModiTime(new Date()); - if (wrkMastMapper.updateById(wrkMast) == 0) { - News.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo()); - } + private boolean locToLocExecuteStep1(WrkMast wrkMast) { + if (wrkMast.getWrkSts() == 21) {//21.鐢熸垚鍑哄簱浠诲姟 + if (wrkMast.getShuttleNo() == null) { + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//璋冨害灏忚溅鍒版簮搴撲綅杩涜鍙栬揣 + return false; } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + if (!shuttleProtocol.isIdle()) { + return false; + } + + //鍒ゆ柇灏忚溅鏄惁鍒拌揪婧愬簱浣� + if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { + //灏忚溅涓嶅湪婧愬簱浣嶄綅缃� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//璋冨害灏忚溅鍒版簮搴撲綅杩涜鍙栬揣 + return false; + } + + //灏忚溅宸叉姷杈炬簮搴撲綅锛岃繘琛屾惉杩愯揣鐗� + NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), wrkMast.getLocNo()); + if (result == null) {//璺緞璁$畻澶辫触 + return false; + } + + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//鍏ュ簱妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(result.getCommands());//杩愯鍛戒护 + assignCommand.setNodes(result.getNodes());//璺緞鑺傜偣 + + wrkMast.setWrkSts(5L);//21.鐢熸垚鍑哄簱浠诲姟 => 5.灏忚溅鎼繍涓� + wrkMast.setModiTime(new Date()); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + } + + return false; } + return true; } /** - * 璁╁皬杞︿粠 杩滅偣 ====>> 绉诲姩鍒拌繎鐐� - * 绛夊緟鍫嗗灈鏈烘惉杩� + * 璺ㄦゼ灞傚簱浣嶇Щ杞�-璋冨害杞﹁締鍙栬揣骞惰繍閫佸埌鍑哄簱鍙� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue */ - public void letCarBeReady(WrkCharge wrkCharge, Integer steNo) { - // 鑾峰彇绌挎杞︿俊鎭� - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (steProtocol == null) { return; } - if (steProtocol.isIdle()) { - - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙� - steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol)); // 浠诲姟妯″紡: 鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙� - - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); - - if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� - wrkCharge.setSteNo(steNo); - wrkCharge.setModiTime(new Date()); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo()); - } + private boolean locToLocExecuteStep2(WrkMast wrkMast) { + if (wrkMast.getWrkSts() == 21) {//21.鐢熸垚鍑哄簱浠诲姟 + if (wrkMast.getShuttleNo() == null) { + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//璋冨害灏忚溅鍒版簮搴撲綅杩涜鍙栬揣 + return false; } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + if (!shuttleProtocol.isIdle()) { + return false; + } + + //鍒ゆ柇灏忚溅鏄惁鍒拌揪婧愬簱浣� + if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { + //灏忚溅涓嶅湪婧愬簱浣嶄綅缃� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//璋冨害灏忚溅鍒版簮搴撲綅杩涜鍙栬揣 + return false; + } + + //鑾峰彇绌挎杞︽渶杩戜笖绌洪棽鐨勬彁鍗囨満杈撻�佺珯鐐� + BasDevp liftSta = shuttleDispatchUtils.getRecentLiftSta(shuttleThread.getSlave().getId()); + if (liftSta == null) { + return false;//娌℃湁鍙敤涓旂┖闂茬殑杈撻�佺珯鐐� + } + + //灏忚溅宸叉姷杈炬簮搴撲綅锛屽皢璐х墿鎼繍鍒拌緭閫佺珯鐐� + NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), liftSta.getLocNo()); + if (result == null) {//璺緞璁$畻澶辫触 + return false; + } + + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_LOC_TO_LOC.id.shortValue());//搴撲綅绉昏浆妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(result.getCommands());//杩愯鍛戒护 + assignCommand.setNodes(result.getNodes());//璺緞鑺傜偣 + + wrkMast.setWrkSts(22L);//21.鐢熸垚鍑哄簱浠诲姟 => 22.灏忚溅鎼繍涓� + wrkMast.setLiftNo(liftSta.getLiftNo());//璁剧疆鎻愬崌鏈哄彿 + wrkMast.setModiTime(new Date()); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + } + + return false; } + return true; + } + + /** + * 璺ㄦゼ灞傚簱浣嶇Щ杞�-鎻愬崌鏈烘惉杩愯揣鐗� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean locToLocExecuteStep3(WrkMast wrkMast) { + Date now = new Date(); + if (wrkMast.getWrkSts() == 23) {//23.灏忚溅鎼繍瀹屾垚 + //鑾峰彇鎻愬崌鏈虹嚎绋� + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + + if (!liftProtocol.isIdle()) { + return false; + } + + //鎼滅储鏄惁鏈夊叾浠栦换鍔″崰鐢ㄤ簡鎻愬崌鏈猴紝濡傛灉鍗犵敤鎻愬崌鏈虹殑浠诲姟鍜屽綋鍓嶄换鍔$浉鍚岋紝鍒欒繍琛屾墽琛� + WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue()); + if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) { + return false; + } + + //鑾峰彇婧愮珯瀵瑰簲鐨勮緭閫佺珯鐐� + BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue()); + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue()); + if (sourceBasDevp == null || targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈哄懡浠� + NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo()); + + ArrayList<NyLiftCommand> commands = new ArrayList<>(); + commands.add(liftCommand); + + //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔 + LiftAssignCommand assignCommand = new LiftAssignCommand(); + assignCommand.setCommands(commands); + assignCommand.setLiftNo(liftProtocol.getLiftNo()); + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); + assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue()); + + wrkMast.setWrkSts(24L);//23.灏忚溅鎼繍瀹屾垚 ==> 24.鎻愬崌鏈烘惉杩愪腑 + wrkMast.setLiftNo(liftThread.getSlave().getId());//浠诲姟妗g粦瀹氭彁鍗囨満鍙� + wrkMast.setShuttleNo(null);//娓呯┖灏忚溅鍙凤紝绛夎揣鐗╂惉杩愬畬鎴愬悗锛屽埌鐩爣妤煎眰閲嶆柊鎼滅储灏忚溅 + wrkMast.setModiTime(now); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand)); + } + return false; + } + return true; + } + + /** + * 璺ㄦゼ灞傚簱浣嶇Щ杞�-璋冨害杞﹁締鍙栬揣骞惰繍閫佸埌鐩爣鏋悗 + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean locToLocExecuteStep4(WrkMast wrkMast) { + if (wrkMast.getWrkSts() == 4) {//4.鎻愬崌鏈烘惉杩愬畬鎴� + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), wrkMast.getLiftNo()); + if (targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + if (wrkMast.getShuttleNo() == null) { + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), targetBasDevp.getLocNo());//璋冨害灏忚溅鍒扮洰鏍囪緭閫佺珯鐐硅繘琛屽彇璐� + return false; + } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + if (!shuttleProtocol.isIdle()) { + return false; + } + + //鍒ゆ柇灏忚溅鏄惁鍒拌揪鐩爣杈撻�佺珯鐐� + if (!shuttleProtocol.getCurrentLocNo().equals(targetBasDevp.getLocNo())) { + //灏忚溅涓嶅湪鐩爣杈撻�佺珯鐐� + shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), targetBasDevp.getLocNo(), wrkMast.getShuttleNo());//璋冨害灏忚溅鍒扮洰鏍囪緭閫佺珯鐐硅繘琛屽彇璐� + return false; + } + + //灏忚溅宸叉姷杈剧洰鏍囪緭閫佺珯鐐癸紝灏嗚揣鐗╂惉杩愬埌鐩爣搴撲綅 + NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), targetBasDevp.getLocNo(), wrkMast.getLocNo()); + if (result == null) {//璺緞璁$畻澶辫触 + return false; + } + + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_LOC_TO_LOC.id.shortValue());//搴撲綅绉昏浆妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(result.getCommands());//杩愯鍛戒护 + assignCommand.setNodes(result.getNodes());//璺緞鑺傜偣 + + wrkMast.setWrkSts(5L);//4.鎻愬崌鏈烘惉杩愬畬鎴� => 5.灏忚溅鎼繍涓� + wrkMast.setModiTime(new Date()); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + } + + return false; + } + return true; } /** @@ -1950,6 +1458,7 @@ public void recErr() { try { this.recShuttleErr(); + this.recLiftErr(); } catch (Exception e) { News.error("recErr fail", e); } @@ -1961,27 +1470,27 @@ private void recShuttleErr() { Date now = new Date(); for (ShuttleSlave shuttleSlave : slaveProperties.getShuttle()) { - // 鑾峰彇鍫嗗灈鏈轰俊鎭� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleSlave.getId()); + // 鑾峰彇鍥涘悜绌挎杞︿俊鎭� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleSlave.getId()); if (shuttleThread == null) { continue; } - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); if (shuttleProtocol == null) { continue; } if (shuttleProtocol.getTaskNo() != 0) { //鏈変换鍔� - BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(shuttleSlave.getId(), shuttleProtocol.getTaskNo().intValue()); + BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(shuttleSlave.getId(), shuttleProtocol.getTaskNo()); // 鏈夊紓甯� if (latest == null) { - if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) { + if (shuttleProtocol.getErrState() != null && shuttleProtocol.getErrState() == 1) { WrkMast wrkMast = wrkMastMapper.selectById(shuttleProtocol.getTaskNo()); if (wrkMast == null) { continue; } - BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue()); + BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getErrCode()); String errName = basShuttleErr==null? "鏈煡寮傚父":basShuttleErr.getErrName(); BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog( null, // 缂栧彿 @@ -1997,14 +1506,15 @@ wrkMast.getSourceStaNo(), // 婧愮珯 wrkMast.getSourceLocNo(), // 婧愬簱浣� wrkMast.getBarcode(), // 鏉$爜 - (int) shuttleProtocol.getStatusErrorCode(), // 寮傚父鐮� + shuttleProtocol.getErrCode(), // 寮傚父鐮� errName, // 寮傚父 1, // 寮傚父鎯呭喌 now, // 娣诲姞鏃堕棿 null, // 娣诲姞浜哄憳 now, // 淇敼鏃堕棿 null, // 淇敼浜哄憳 - "浠诲姟涓紓甯�" // 澶囨敞 + "浠诲姟涓紓甯�", // 澶囨敞 + JSON.toJSONString(shuttleProtocol) // 绯荤粺鐘舵�佹暟鎹� ); if (!basShuttleErrLogService.insert(basShuttleErrLog)) { News.error("鍥涘悜绌挎杞lc寮傚父璁板綍澶辫触 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName); @@ -2012,7 +1522,7 @@ } } else { // 寮傚父淇 - if (shuttleProtocol.getStatusErrorCode() == null || shuttleProtocol.getStatusErrorCode() == 0) { + if (shuttleProtocol.getErrState() == null || shuttleProtocol.getErrState() == 0) { latest.setEndTime(now); latest.setUpdateTime(now); latest.setStatus(2); @@ -2022,50 +1532,135 @@ } } }else { - //鏃犱换鍔� - BasShuttleErrLog latest = basShuttleErrLogService.findLatest(shuttleSlave.getId()); +// //鏃犱换鍔� +// BasShuttleErrLog latest = basShuttleErrLogService.findLatest(shuttleSlave.getId()); +// // 鏈夊紓甯� +// if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) { +// // 璁板綍鏂板紓甯� +// if (latest == null || (latest.getErrCode() != shuttleProtocol.getStatusErrorCode().intValue())) { +// BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue()); +// String errName = basShuttleErr==null? "鏈煡寮傚父":basShuttleErr.getErrName(); +// BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog( +// null, // 缂栧彿 +// null, // 宸ヤ綔鍙� +// now, // 鍙戠敓鏃堕棿 +// null, // 缁撴潫鏃堕棿 +// null, // 宸ヤ綔鐘舵�� +// null, // 鍏ュ嚭搴撶被鍨� +// shuttleSlave.getId(), // 鍥涘悜绌挎杞� +// null, // plc +// null, // 鐩爣搴撲綅 +// null, // 鐩爣绔� +// null, // 婧愮珯 +// null, // 婧愬簱浣� +// null, // 鏉$爜 +// (int)shuttleProtocol.getStatusErrorCode(), // 寮傚父鐮� +// errName, // 寮傚父 +// 1, // 寮傚父鎯呭喌 +// now, // 娣诲姞鏃堕棿 +// null, // 娣诲姞浜哄憳 +// now, // 淇敼鏃堕棿 +// null, // 淇敼浜哄憳 +// "鏃犱换鍔″紓甯�" // 澶囨敞 +// ); +// if (!basShuttleErrLogService.insert(basShuttleErrLog)) { +// News.error("鍥涘悜绌挎杞lc寮傚父璁板綍澶辫触 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName); +// } +// } +// // 鏃犲紓甯� +// } else { +// // 寮傚父淇 +// if (latest != null && latest.getStatus() == 1) { +// latest.setEndTime(now); +// latest.setUpdateTime(now); +// latest.setStatus(2); +// if (!basShuttleErrLogService.updateById(latest)) { +// News.error("鍥涘悜绌挎杞lc寮傚父璁板綍淇澶辫触 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId()); +// } +// } +// } + } + } + } + + /** + * 鎻愬崌鏈哄紓甯镐俊鎭褰� + */ + private void recLiftErr() { + Date now = new Date(); + for (LiftSlave liftSlave : slaveProperties.getLift()) { + // 鑾峰彇鎻愬崌鏈轰俊鎭� + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId()); + if (liftThread == null) { + continue; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + continue; + } + + if (liftProtocol.getTaskNo() != 0) { + //鏈変换鍔� + BasLiftErrLog latest = basLiftErrLogService.findLatestByTaskNo(liftSlave.getId(), liftProtocol.getTaskNo().intValue()); // 鏈夊紓甯� - if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) { - // 璁板綍鏂板紓甯� - if (latest == null || (latest.getErrCode() != shuttleProtocol.getStatusErrorCode().intValue())) { - BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue()); - String errName = basShuttleErr==null? "鏈煡寮傚父":basShuttleErr.getErrName(); - BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog( + if (latest == null) { + if (liftProtocol.getDeviceError() != null && liftProtocol.getDeviceError()) { + WrkMast wrkMast = wrkMastMapper.selectById(liftProtocol.getTaskNo()); + if (wrkMast == null) { + continue; + } + + String errName = ""; + if (liftProtocol.getFrontOverrun()) { + errName = "鍓嶈秴闄�"; + } else if (liftProtocol.getBackOverrun()) { + errName = "鍚庤秴闄�"; + } else if (liftProtocol.getLeftOverrun()) { + errName = "宸﹁秴闄�"; + } else if (liftProtocol.getRightOverrun()) { + errName = "鍙宠秴闄�"; + } else if (liftProtocol.getOverHeight()) { + errName = "瓒呴珮"; + } else if (liftProtocol.getOverWeight()) { + errName = "瓒呴噸"; + } + + BasLiftErrLog basLiftErrLog = new BasLiftErrLog( null, // 缂栧彿 - null, // 宸ヤ綔鍙� + wrkMast.getWrkNo(), // 宸ヤ綔鍙� now, // 鍙戠敓鏃堕棿 null, // 缁撴潫鏃堕棿 - null, // 宸ヤ綔鐘舵�� - null, // 鍏ュ嚭搴撶被鍨� - shuttleSlave.getId(), // 鍥涘悜绌挎杞� + wrkMast.getWrkSts(), // 宸ヤ綔鐘舵�� + wrkMast.getIoType(), // 鍏ュ嚭搴撶被鍨� + liftSlave.getId(), // 鎻愬崌鏈� null, // plc - null, // 鐩爣搴撲綅 - null, // 鐩爣绔� - null, // 婧愮珯 - null, // 婧愬簱浣� - null, // 鏉$爜 - (int)shuttleProtocol.getStatusErrorCode(), // 寮傚父鐮� + wrkMast.getLocNo(), // 鐩爣搴撲綅 + wrkMast.getStaNo(), // 鐩爣绔� + wrkMast.getSourceStaNo(), // 婧愮珯 + wrkMast.getSourceLocNo(), // 婧愬簱浣� + wrkMast.getBarcode(), // 鏉$爜 + null, // 寮傚父鐮� errName, // 寮傚父 1, // 寮傚父鎯呭喌 now, // 娣诲姞鏃堕棿 null, // 娣诲姞浜哄憳 now, // 淇敼鏃堕棿 null, // 淇敼浜哄憳 - "鏃犱换鍔″紓甯�" // 澶囨敞 + "浠诲姟涓紓甯�", // 澶囨敞 + JSON.toJSONString(liftProtocol) // 绯荤粺鐘舵�佹暟鎹� ); - if (!basShuttleErrLogService.insert(basShuttleErrLog)) { - News.error("鍥涘悜绌挎杞lc寮傚父璁板綍澶辫触 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName); + if (!basLiftErrLogService.insert(basLiftErrLog)) { + News.error("鎻愬崌鏈簆lc寮傚父璁板綍澶辫触 ===>> [id:{}] [error:{}]", liftSlave.getId(), errName); } } - // 鏃犲紓甯� } else { // 寮傚父淇 - if (latest != null && latest.getStatus() == 1) { + if (liftProtocol.getDeviceError() == null || !liftProtocol.getDeviceError()) { latest.setEndTime(now); latest.setUpdateTime(now); latest.setStatus(2); - if (!basShuttleErrLogService.updateById(latest)) { - News.error("鍥涘悜绌挎杞lc寮傚父璁板綍淇澶辫触 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId()); + if (!basLiftErrLogService.updateById(latest)) { + News.error("鎻愬崌鏈簆lc寮傚父璁板綍淇澶辫触 ===>> [id:{}] [errLogId:{}]", liftSlave.getId(), latest.getId()); } } } @@ -2331,688 +1926,640 @@ * 鍥涘悜绌挎杞︾數閲忔娴� ===>> 鍙戣捣鍏呯數 */ public synchronized void loopShuttleCharge() { - for (DevpSlave devpSlave : slaveProperties.getDevp()) { - SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devpSlave.getId()); - for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { - //鑾峰彇鍥涘悜绌挎杞︾嚎绋� - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (shuttleProtocol == null) { - continue; - } - - //鍒ゆ柇褰撳墠灏忚溅鏄惁婊¤冻闇�瑕佸厖鐢佃姹� - if (!shuttleProtocol.isRequireCharge()) { - continue; - } - - WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge); - if (wrkCharge != null) {//宸叉湁鍏呯數浠诲姟 - continue; - } - - ShuttleChargeType shuttleCharge = null; - for (ShuttleChargeType chargeType : ShuttleChargeType.values()) { - if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) { - shuttleCharge = chargeType; - break; - } - } - - if (shuttleCharge == null) { - continue; - } - - String chargeLocNo = shuttleCharge.locNo; - wrkCharge = new WrkCharge(); - wrkCharge.setShuttleNo(shuttle.getId()); - wrkCharge.setCharge(shuttleCharge.id); - wrkCharge.setWrkNo(commonService.getChargeWorkNo(4)); - wrkCharge.setWrkSts(51L); // 21.鍑嗗鍏呯數 - wrkCharge.setIoPri((double) 10); - wrkCharge.setLocNo(chargeLocNo); - wrkCharge.setMemo("charge"); - wrkCharge.setAppeTime(new Date()); - if (!wrkChargeService.insert(wrkCharge)) { - News.error("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟澶辫触!!!", shuttle.getId()); - continue; - } - - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//鍏呯數涓� - News.info("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟鎴愬姛!!!", shuttle.getId()); + for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + continue; } + + //鍒ゆ柇褰撳墠灏忚溅鏄惁婊¤冻闇�瑕佸厖鐢佃姹� + if (!shuttleProtocol.isRequireCharge()) { + continue; + } + + WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttleProtocol.getShuttleNo().intValue()); + if (wrkCharge != null) {//宸叉湁鍏呯數浠诲姟 + continue; + } + + ShuttleChargeType shuttleCharge = null; + for (ShuttleChargeType chargeType : ShuttleChargeType.values()) { + if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) { + shuttleCharge = chargeType; + break; + } + } + + if (shuttleCharge == null) { + continue; + } + + String chargeLocNo = shuttleCharge.locNo; + wrkCharge = new WrkCharge(); + wrkCharge.setShuttleNo(shuttle.getId()); + wrkCharge.setCharge(shuttleCharge.id); + wrkCharge.setWrkNo(commonService.getChargeWorkNo(4)); + wrkCharge.setWrkSts(51L); // 21.鍑嗗鍏呯數 + wrkCharge.setIoPri((double) 10); + wrkCharge.setLocNo(chargeLocNo); + wrkCharge.setMemo("charge"); + wrkCharge.setAppeTime(new Date()); + if (!wrkChargeService.insert(wrkCharge)) { + News.error("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟澶辫触!!!", shuttle.getId()); + continue; + } + + shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//鍏呯數涓� + News.info("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟鎴愬姛!!!", shuttle.getId()); } - - } /** * 鎵ц鍥涘悜绌挎杞﹀厖鐢典换鍔� */ public synchronized void executeShuttleCharge() { - WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge); - if (wrkCharge == null) { - return; - } + for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { + WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttle.getId()); + if (wrkCharge == null) { + continue; + } - ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo()); - if (shuttleThread == null) { - return; - } - ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); - if (shuttleProtocol == null) { - return; - } + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo()); + if (shuttleThread == null) { + continue; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + continue; + } - //褰撳墠绌挎杞﹀簱浣嶅彿 - String currentLocNo = shuttleProtocol.getCurrentLocNo(); - //灏忚溅褰撳墠灞傞珮 - Integer currentLev = currentLocNo == null ? 0 : Utils.getLev(currentLocNo); - //鑾峰彇鎻愬崌鏈� - LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); - if (liftThread == null) { - return; - } - LiftProtocol liftProtocol = liftThread.getLiftProtocol(); - if (liftProtocol == null) { - return; - } - //鍏呯數搴撲綅鍙� - String chargeLocNo = wrkCharge.getLocNo(); - //鍏呯數搴撲綅灞傞珮 - Integer chargeLocNoLev = Utils.getLev(chargeLocNo); - - if (wrkCharge.getWrkSts() == 51) { - if (currentLev == chargeLocNoLev) { - //鍚屼竴灞傛棤闇�缁忚繃鎻愬崌鏈� - //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅 - - ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); - - //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠� - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread); - if (commands == null) { - return;//鏈壘鍒拌矾寰� + if (wrkCharge.getWrkSts() == 51) { + if (!shuttleProtocol.getCurrentLocNo().equals(wrkCharge.getLocNo())) { + //灏忚溅涓嶅湪鍏呯數妗╀綅缃� + shuttleDispatchUtils.dispatchShuttle(wrkCharge.getWrkNo(), wrkCharge.getLocNo(), shuttle.getId());//璋冨害灏忚溅鍘诲厖鐢垫々 + continue; } - //杩涜鍏呯數涓� - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING); - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); - assignCommand.setTaskMode((short) 9);//鍏呯數 - assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); - assignCommand.setCharge(true);//鍏呯數浠诲姟 + //灏忚溅宸茬粡鍦ㄥ厖鐢垫々浣嶇疆锛屼笅鍙戝厖鐢靛懡浠� + NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), true); + ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>(); + commands.add(chargeCommand); + //鍒涘缓鍒嗛厤鍛戒护 + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//鍑哄簱妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(commands);//杩愯鍛戒护 - //鍒涘缓鍏呯數鎸囦护 - ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 1);//寮�濮嬪厖鐢� - commands.add(command); - - //鎸囦护闆嗗垎閰� - assignCommand.setCommands(commands); - - wrkCharge.setWrkSts(56L);//鍏呯數涓姸鎬� + wrkCharge.setWrkSts(52L);//51.鐢熸垚鍏呯數浠诲姟 => 52.灏忚溅鍘诲厖鐢典腑 + wrkCharge.setModiTime(new Date()); if (wrkChargeMapper.updateById(wrkCharge) > 0) { //涓嬪彂浠诲姟 MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); } - }else { - //涓嶅悓灞傦紝璋冨害灏忚溅鍒板厖鐢垫々鐩爣灞� + } else if (wrkCharge.getWrkSts() == 52) { + //妫�娴嬪皬杞︽槸鍚︽弧鐢� + if (shuttleProtocol.getPowerPercent() < 100) { + continue; + } + //灏忚溅婊$數锛岀粨鏉熷厖鐢典换鍔� + NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), false); + ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>(); + commands.add(chargeCommand); + //鍒涘缓鍒嗛厤鍛戒护 ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//鍑哄簱妯″紡 + assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//婧愬簱浣�(灏忚溅褰撳墠浣嶇疆) + assignCommand.setCommands(commands);//杩愯鍛戒护 - //鑾峰彇灏忚溅褰撳墠妤煎眰鐨勭珯鐐瑰彿 - String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev); - - //灏忚溅绉诲姩鍒版彁鍗囨満鍙g珯鐐癸紝璁$畻璺緞 - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread); - if (commands == null) { - return;//鏈壘鍒拌矾寰� - } - - //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅 - BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo); - if (basDevp == null) { - return;//鎵句笉鍒扮珯鐐逛俊鎭� - } - Short basDevpQrCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮� - - //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(basDevpQrCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, basDevpQrCode, 1400, 500); - commands.add(moveCommand); - - //鍒嗛厤鐩爣搴撲綅 - shuttleProtocol.setLocNo(chargeLocNo); - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); - assignCommand.setTaskMode((short) 9);//鍏呯數 - assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); - assignCommand.setCharge(true);//鍏呯數浠诲姟 - //鐩爣搴撲綅 - assignCommand.setLocNo(chargeLocNo); - //婧愬簱浣� - assignCommand.setSourceLocNo(currentLocNo); - assignCommand.setCommands(commands); - wrkCharge.setWrkSts(52L);//灏忚溅杩佺Щ鐘舵�� + wrkCharge.setWrkSts(53L);//52.灏忚溅鍘诲厖鐢典腑 => 53.灏忚溅鍏呯數瀹屾垚 + wrkCharge.setModiTime(new Date()); if (wrkChargeMapper.updateById(wrkCharge) > 0) { //涓嬪彂浠诲姟 MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); } + } else if (wrkCharge.getWrkSts() == 53) { + boolean result = Utils.searchEmptyGroupToMoveShuttle(Utils.getLev(wrkCharge.getLocNo()), shuttleThread.getSlave().getId(), shuttleThread); + if (!result) { + continue; + } + + wrkCharge.setWrkSts(60L);//53.灏忚溅鍏呯數瀹屾垚 => 60.鍏呯數浠诲姟瀹屾垚 + wrkCharge.setModiTime(new Date()); + wrkChargeMapper.updateById(wrkCharge); } - }else if(wrkCharge.getWrkSts() == 53){ - //灏忚溅宸茬粡杈惧埌鎻愬崌鏈哄唴 + } - //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬� - if (!liftProtocol.isIdle()) { - return; + } + + /** + * 鎵ц灏忚溅绉诲簱浠诲姟 + */ + public synchronized void shuttleMoveExecute() { + //鏌ヨ灏忚溅绉诲簱浠诲姟 + List<WrkMast> wrkMasts = wrkMastMapper.selectShuttleMoveWrk(); + for (WrkMast wrkMast : wrkMasts) { + boolean stepMoveSta = this.shuttleMoveExecuteStepMoveSta(wrkMast);//灏忚溅绉诲姩鍒扮珯鐐� + if (!stepMoveSta) { + continue; } - //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐� - if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) { - //灏忚溅涓嶅湪鎻愬崌鏈哄唴 - return; + boolean stepIntoLift = this.shuttleMoveExecuteStepIntoLift(wrkMast);//灏忚溅杩佸叆鎻愬崌鏈� + if (!stepIntoLift) { + continue; } - //缁欐彁鍗囨満鍒嗛厤浠诲姟 - liftProtocol.setTaskNo(wrkCharge.getWrkNo().shortValue());//璁剧疆浠诲姟鍙� - liftProtocol.setShuttleNo(wrkCharge.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿 - liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓� + boolean stepLiftMove = this.shuttleMoveExecuteStepLiftMove(wrkMast);//鎻愬崌鏈烘惉杩愪腑 + if (!stepLiftMove) { + continue; + } - //鍛戒护list - ArrayList<LiftCommand> commands = new ArrayList<>(); + boolean stepOutLift = this.shuttleMoveExecuteStepOutLift(wrkMast);//灏忚溅杩佸嚭鎻愬崌鏈� + if (!stepOutLift) { + continue; + } - //鎻愬崌鏈哄墠寰�鐩爣妤煎眰 - //鑾峰彇鍏呯數搴撲綅鐩爣妤煎眰鍛戒护 - LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), chargeLocNoLev >= 2 ? chargeLocNoLev + 1 : chargeLocNoLev); - commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list + boolean stepMoveLoc = this.shuttleMoveExecuteStepMoveLoc(wrkMast);//灏忚溅绉诲姩鍒扮洰鏍囧簱浣嶄腑 + if (!stepMoveLoc) { + continue; + } - wrkCharge.setWrkSts(54L);//鎻愬崌鏈烘惉杩愪腑 - //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣� + } + } + + /** + * 灏忚溅杩佺Щ-灏忚溅绉诲姩鍒扮珯鐐� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean shuttleMoveExecuteStepMoveSta(WrkMast wrkMast) { + //--------------------------------------灏忚溅绉诲姩鑷崇珯鐐�-----------------------------------------// + Date now = new Date(); + + //灏忚溅绉诲姩鑷崇珯鐐� 101.鐢熸垚灏忚溅绉诲簱浠诲姟 ==> 102.灏忚溅绉诲姩鑷崇珯鐐逛腑 + if (wrkMast.getWrkSts() == 101) { + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + //灏忚溅澶勪簬绌洪棽鐘舵�� + if (!shuttleProtocol.isIdleNoCharge()) { + return false; + } + + //鍒ゆ柇灏忚溅浠ょ墝鏄惁鏈鍗犻 + if (shuttleProtocol.getToken() != 0) { + return false;//灏忚溅宸茶鐙崰锛岀姝㈠啀娲惧彂浠诲姟 + } + + if (Utils.getLev(wrkMast.getLocNo()) == shuttleProtocol.getPoint().getZ()) { + //鐩爣搴撲綅鍜屽皬杞﹀簱浣嶅浜庡悓涓�妤煎眰锛屼笉闇�瑕侀�氳繃鎻愬崌鏈鸿皟搴� + wrkMast.setWrkSts(109L);// 109.灏忚溅杩佸嚭鎻愬崌鏈哄畬鎴� ==> 110.灏忚溅绉诲姩涓� + wrkMast.setModiTime(now); + shuttleProtocol.setToken(wrkMast.getWrkNo());//鐙崰璇ュ皬杞︿护鐗� + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + return true;//鐩存帴杩涘叆109.灏忚溅杩佸嚭鎻愬崌鏈哄畬鎴� ==> 110.灏忚溅绉诲姩涓� + } + return false; + } + + //鑾峰彇鐩爣杈撻�佺珯 + BasDevp basDevp = basDevpService.selectById(wrkMast.getStaNo()); + if (basDevp == null) { + return false;//鎵句笉鍒拌緭閫佺珯鐐� + } + + //鑾峰彇灏忚溅鍒拌緭閫佺珯鐐硅璧板懡浠� + NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo()); + List<NyShuttleHttpCommand> commands = result.getCommands(); + + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 鍥涘悜绌挎杞︾紪鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//灏忚溅绉诲簱浠诲姟 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setAuto(true);//鑷姩妯″紡 + assignCommand.setCommands(commands); + assignCommand.setNodes(result.getNodes()); + + wrkMast.setWrkSts(102L);//灏忚溅绉诲姩鍒版彁鍗囨満涓� 101.鐢熸垚灏忚溅绉诲簱浠诲姟 ==> 102.灏忚溅绉诲姩鑷崇珯鐐� + wrkMast.setModiTime(now); + shuttleProtocol.setToken(wrkMast.getWrkNo());//鐙崰璇ュ皬杞︿护鐗� + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + return false; + } + return false; + } + return true; + } + + /** + * 灏忚溅杩佺Щ-灏忚溅杩佸叆鎻愬崌鏈� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean shuttleMoveExecuteStepIntoLift(WrkMast wrkMast) { + //--------------------------------------灏忚溅杩佸叆鎻愬崌鏈�-----------------------------------------// + Date now = new Date(); + + //灏忚溅绉诲姩鍒版彁鍗囨満涓� 103.灏忚溅绉诲姩鑷崇珯鐐瑰畬鎴� ==> 104.灏忚溅杩佸叆鎻愬崌鏈轰腑 + if (wrkMast.getWrkSts() == 103) { + //鑾峰彇鐩爣杈撻�佺珯 + BasDevp basDevp = basDevpService.selectById(wrkMast.getStaNo()); + if (basDevp == null) { + return false;//鎵句笉鍒拌緭閫佺珯鐐� + } + + //鑾峰彇鎻愬崌鏈烘暟鎹� + BasLift basLift = basLiftService.selectById(basDevp.getLiftNo()); + if (basLift == null) { + return false;//娌℃湁鎻愬崌鏈烘暟鎹� + } + + if (basLift.getPoint() == null) { + return false;//娌℃湁璁剧疆鎻愬崌鏈虹偣浣嶅潗鏍� + } + + //鍒ゆ柇鎻愬崌鏈烘槸鍚︽湁鍏朵粬浠诲姟 + WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(basLift.getLiftNo()); + if (liftWrkMast != null) { + return false;//褰撳墠鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛岀瓑寰呬笅涓�娆¤疆璇� + } + + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, basDevp.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) { + return false; + } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + //灏忚溅澶勪簬绌洪棽鐘舵�� + if (!shuttleProtocol.isIdleNoCharge()) { + return false; + } + + //鍒ゆ柇鎻愬崌鏈烘ゼ灞� + if (liftProtocol.getLev().intValue() != shuttleProtocol.getPoint().getZ()) { + //鎻愬崌鏈轰笉鍦ㄥ皬杞︽ゼ灞� + //璋冨害鎻愬崌鏈� + + //鑾峰彇婧愮珯瀵瑰簲鐨勮緭閫佺珯鐐� + BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(liftProtocol.getLev().intValue(), liftProtocol.getLiftNo().intValue()); + //鑾峰彇鎻愬崌鏈哄懡浠� + NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceBasDevp.getDevNo(), basDevp.getDevNo(), wrkMast.getWrkNo()); + + ArrayList<NyLiftCommand> commands = new ArrayList<>(); + commands.add(liftCommand); + + //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔 + LiftAssignCommand assignCommand = new LiftAssignCommand(); + assignCommand.setCommands(commands); + assignCommand.setLiftNo(liftProtocol.getLiftNo()); + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); + assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_CAR.id.shortValue()); + + wrkMast.setLiftNo(liftThread.getSlave().getId());//閿佸畾鎻愬崌鏈洪槻姝㈣鍗犵敤 + wrkMast.setModiTime(now); + liftProtocol.setToken(wrkMast.getShuttleNo());//鎻愬崌鏈轰护鐗岀粦瀹氬綋鍓嶅皬杞� + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand)); + } + return false;//绛夊緟鎻愬崌鏈哄埌灏忚溅妤煎眰 + } + + //鍒ゆ柇鎻愬崌鏈轰护鐗屾槸鍚︿负褰撳墠灏忚溅 + if (liftProtocol.getToken() != wrkMast.getShuttleNo()) { + return false;//鎻愬崌鏈哄凡琚嫭鍗狅紝绂佹鍐嶆淳鍙戜换鍔� + } + + //鍒ゆ柇灏忚溅鏄惁涓哄綋鍓嶄换鍔$嫭鍗� + if (shuttleProtocol.getToken() != wrkMast.getWrkNo()) { + return false; + } + + //绔欑偣鑺傜偣 + NavigateNode staNode = NavigatePositionConvert.locNoToNode(basDevp.getLocNo()); + + //鎻愬崌鏈鸿妭鐐� + NavigateNode liftNode = new NavigateNode(basLift.getPoint$().getX(), basLift.getPoint$().getY()); + liftNode.setZ(basLift.getPoint$().getZ()); + + //鑾峰彇灏忚溅杩涙彁鍗囨満琛岃蛋鍛戒护 + NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), staNode, liftNode, true); + List<NyShuttleHttpCommand> commands = new ArrayList<>(); + commands.add(moveCommand); + List<NavigateNode> nodes = new ArrayList<>();//琛岃蛋鑺傜偣璺緞 + nodes.add(staNode); + nodes.add(liftNode); + + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 鍥涘悜绌挎杞︾紪鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//灏忚溅绉诲簱浠诲姟 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setAuto(true);//鑷姩妯″紡 + assignCommand.setCommands(commands); + assignCommand.setNodes(nodes); + + wrkMast.setWrkSts(104L);//灏忚溅绉诲姩鍒版彁鍗囨満涓� 103.灏忚溅绉诲姩鑷崇珯鐐瑰畬鎴� ==> 104.灏忚溅杩佸叆鎻愬崌鏈轰腑 + wrkMast.setModiTime(now); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + return false; + } + return false; + } + + return true; + } + + /** + * 灏忚溅杩佺Щ-鎻愬崌鏈烘惉杩愪腑 + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean shuttleMoveExecuteStepLiftMove(WrkMast wrkMast) { + //--------------------------------------鎻愬崌鏈烘惉杩愪腑-----------------------------------------// + Date now = new Date(); + + //鎻愬崌鏈烘惉杩愪腑 105.灏忚溅杩佸叆鎻愬崌鏈哄畬鎴� ==> 106.鎻愬崌鏈烘惉杩愪腑 + if (wrkMast.getWrkSts() == 105) { + + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) { + return false; + } + //鍒ゆ柇鎻愬崌鏈轰护鐗屾槸鍚︿负褰撳墠灏忚溅 + if (liftProtocol.getToken() != wrkMast.getShuttleNo()) { + return false;//鎻愬崌鏈轰护鐗屽拰褰撳墠灏忚溅涓嶄竴鑷达紝绂佹娲惧彂 + } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + //灏忚溅澶勪簬绌洪棽鐘舵�� + if (!shuttleProtocol.isIdleNoCharge()) { + return false; + } + + //鍒ゆ柇灏忚溅鏄惁涓哄綋鍓嶄换鍔$嫭鍗� + if (shuttleProtocol.getToken() != wrkMast.getWrkNo()) { + return false; + } + + //鑾峰彇婧愮珯瀵瑰簲鐨勮緭閫佺珯鐐� + BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue()); + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue()); + if (sourceBasDevp == null || targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈哄懡浠� + NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo()); + + ArrayList<NyLiftCommand> commands = new ArrayList<>(); + commands.add(liftCommand); + + //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔 LiftAssignCommand assignCommand = new LiftAssignCommand(); assignCommand.setCommands(commands); assignCommand.setLiftNo(liftProtocol.getLiftNo()); - assignCommand.setTaskNo(liftProtocol.getTaskNo()); - if (wrkChargeMapper.updateById(wrkCharge) > 0) { + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); + assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_CAR.id.shortValue()); + + wrkMast.setWrkSts(106L);//鎻愬崌鏈烘惉杩愪腑 105.灏忚溅杩佸叆鎻愬崌鏈哄畬鎴� ==> 106.鎻愬崌鏈烘惉杩愪腑 + wrkMast.setLiftNo(liftThread.getSlave().getId());//閿佸畾鎻愬崌鏈洪槻姝㈣鍗犵敤 + wrkMast.setModiTime(now); + if (wrkMastMapper.updateById(wrkMast) > 0) { //涓嬪彂浠诲姟 MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand)); } - }else if(wrkCharge.getWrkSts() == 55){//55.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴� - //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅 + } + return true; + } + + /** + * 灏忚溅杩佺Щ-灏忚溅杩佸嚭鎻愬崌鏈� + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean shuttleMoveExecuteStepOutLift(WrkMast wrkMast) { + //--------------------------------------灏忚溅杩佸嚭鎻愬崌鏈�-----------------------------------------// + Date now = new Date(); + //灏忚溅绉诲姩鍒版彁鍗囨満涓� 107.鎻愬崌鏈烘惉杩愬畬鎴� ==> 108.灏忚溅杩佸嚭鎻愬崌鏈轰腑 + if (wrkMast.getWrkSts() == 107) { + + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) { + return false; + } + + //鍒ゆ柇鎻愬崌鏈轰护鐗屾槸鍚︿负褰撳墠灏忚溅 + if (liftProtocol.getToken() != wrkMast.getShuttleNo()) { + return false;//鎻愬崌鏈轰护鐗屽拰褰撳墠灏忚溅涓嶄竴鑷达紝绂佹娲惧彂 + } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + //灏忚溅澶勪簬绌洪棽鐘舵�� + if (!shuttleProtocol.isIdleNoCharge()) { + return false; + } + + //鍒ゆ柇灏忚溅鏄惁涓哄綋鍓嶄换鍔$嫭鍗� + if (shuttleProtocol.getToken() != wrkMast.getWrkNo()) { + return false; + } + + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue()); + if (targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈烘暟鎹� + BasLift basLift = basLiftService.selectById(liftProtocol.getLiftNo().intValue()); + if (basLift == null) { + return false;//娌℃湁鎻愬崌鏈烘暟鎹� + } + if (basLift.getPoint() == null) { + return false;//娌℃湁璁剧疆鎻愬崌鏈虹偣浣嶅潗鏍� + } + NavigateNode liftNode = new NavigateNode(basLift.getPoint$().getX(), basLift.getPoint$().getY()); + liftNode.setZ(basLift.getPoint$().getZ()); + + List<NyShuttleHttpCommand> commands = new ArrayList<>(); + //鑾峰彇灏忚溅鍑烘彁鍗囨満琛岃蛋鍛戒护 + NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), liftNode, NavigatePositionConvert.locNoToNode(targetBasDevp.getLocNo()), false); + commands.add(moveCommand);//娣诲姞灏忚溅杩佸嚭鎻愬崌鏈哄懡浠� ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); - - Short liftLev = liftProtocol.getLev(); - if (liftLev == null) { - return; - } - //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌杈剧洰鏍囨ゼ灞� - if (liftLev.intValue() != chargeLocNoLev) { - return;//娌℃湁鍒拌揪鐩爣妤煎眰 - } - - //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛 - Integer staNo = Utils.levToOutInStaNo(liftLev >= 2 ? liftLev + 1 : liftLev);//绔欑偣鍙� - BasDevp basDevp = basDevpService.selectById(staNo); - if (basDevp == null) { - return;//绔欑偣涓嶅瓨鍦� - } - - //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠� - List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread); - if (commands == null) { - return;//鏈壘鍒拌矾寰� - } - - short startCode = liftProtocol.getBarcode();//鎻愬崌鏈哄唴閮ㄤ簩缁寸爜 - Short distCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈哄彛绔欑偣浜岀淮鐮� - Short runDirection = ShuttleRunDirection.BOTTOM.id;//杩愯鏂瑰悜 - //鑾峰彇鍛戒护 - ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1400, runDirection, startCode, 1400, 500); - commands.add(0, moveCommand);//灏嗚鎸囦护娣诲姞鍒伴槦澶� - - //杩涜鍏呯數涓� - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING); - - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); - assignCommand.setTaskMode((short) 9);//鍏呯數 - assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); - assignCommand.setCharge(true);//鍏呯數浠诲姟 - - //鍒涘缓鍏呯數鎸囦护 - ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 1);//寮�濮嬪厖鐢� - commands.add(command); - - //鎸囦护闆嗗垎閰� + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 鍥涘悜绌挎杞︾紪鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//灏忚溅绉诲簱浠诲姟 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setAuto(true);//鑷姩妯″紡 assignCommand.setCommands(commands); + assignCommand.setNodes(null); - wrkCharge.setWrkSts(56L);//鍏呯數涓姸鎬� - if (wrkChargeMapper.updateById(wrkCharge) > 0) { + wrkMast.setWrkSts(108L);//灏忚溅杩佸嚭鎻愬崌鏈轰腑 107.鎻愬崌鏈烘惉杩愬畬鎴� ==> 108.灏忚溅杩佸嚭鎻愬崌鏈轰腑 + wrkMast.setModiTime(now); + if (wrkMastMapper.updateById(wrkMast) > 0) { + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); + return false; + } + return false; + } + return true; + } + + /** + * 灏忚溅杩佺Щ-灏忚溅绉诲姩鍒扮洰鏍囧簱浣嶄腑 + * 濡傞渶涓绘柟娉曟墽琛宑ontinue锛岃杩斿洖false + * ps:杩斿洖鍊紅rue骞朵笉浠h〃璇ユ柟娉曟墽琛屾垚鍔燂紝杩斿洖鍊间粎鍋氭爣璁扮敤浜庝富鏂规硶鏄惁鎵цcontinue + */ + private boolean shuttleMoveExecuteStepMoveLoc(WrkMast wrkMast) { + //--------------------------------------灏忚溅绉诲姩鍒扮洰鏍囧簱浣嶄腑-----------------------------------------// + Date now = new Date(); + + //灏忚溅绉诲姩鍒扮洰鏍囧簱浣嶄腑 109.灏忚溅杩佸嚭鎻愬崌鏈哄畬鎴� ==> 110.灏忚溅绉诲姩涓� + if (wrkMast.getWrkSts() == 109) { + + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo()); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + //灏忚溅澶勪簬绌洪棽鐘舵�� + if (!shuttleProtocol.isIdleNoCharge()) { + return false; + } + + //鍒ゆ柇灏忚溅浠ょ墝鏄惁涓哄綋鍓嶄换鍔� + if (shuttleProtocol.getToken() != wrkMast.getWrkNo()) { + return false; + } + + //鑾峰彇鐩爣绔欏搴旂殑杈撻�佺珯鐐� + BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), wrkMast.getLiftNo()); + if (targetBasDevp == null) { + return false;//缂哄皯绔欑偣淇℃伅 + } + + //鑾峰彇鎻愬崌鏈烘暟鎹� + BasLift basLift = basLiftService.selectById(targetBasDevp.getLiftNo()); + if (basLift == null) { + return false;//娌℃湁鎻愬崌鏈烘暟鎹� + } + if (basLift.getPoint() == null) { + return false;//娌℃湁璁剧疆鎻愬崌鏈虹偣浣嶅潗鏍� + } + NavigateNode liftNode = new NavigateNode(basLift.getPoint$().getX(), basLift.getPoint$().getY()); + liftNode.setZ(basLift.getPoint$().getZ()); + + //鑾峰彇灏忚溅浠庤緭閫佺珯鍒扮洰鏍囧簱浣嶅懡浠� + NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), targetBasDevp.getLocNo(), wrkMast.getLocNo()); + if (result == null) { + return false;//璺緞璁$畻澶辫触 + } + List<NyShuttleHttpCommand> commands = result.getCommands(); + + ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); + assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 鍥涘悜绌挎杞︾紪鍙� + assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//灏忚溅绉诲簱浠诲姟 + assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//浠诲姟鍙� + assignCommand.setAuto(true);//鑷姩妯″紡 + assignCommand.setCommands(commands); + assignCommand.setNodes(result.getNodes()); + + wrkMast.setWrkSts(110L);//灏忚溅绉诲姩鍒扮洰鏍囧簱浣嶄腑 109.灏忚溅杩佸嚭鎻愬崌鏈哄畬鎴� ==> 110.灏忚溅绉诲姩涓� + wrkMast.setLiftNo(null);//閲婃斁鎻愬崌鏈� + wrkMast.setModiTime(now); + liftProtocol.setToken(0);//閲婃斁鎻愬崌鏈轰护鐗� + if (wrkMastMapper.updateById(wrkMast) > 0) { //涓嬪彂浠诲姟 MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); } - }else if (wrkCharge.getWrkSts() == 56) { - //鍏呯數涓� - //鍒ゆ柇灏忚溅鏄惁鍏呮弧鐢甸噺锛屾弧鐢�1000鎴栫數鍘�54V浠ヤ笂 - if (shuttleProtocol.getBatteryPower() >= 1000 || shuttleProtocol.getCurrentVoltage() >= 54000) { - //鍏呮弧锛屾柇寮�鍏呯數 - List<ShuttleCommand> commands = new ArrayList<>(); - ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); - assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); - assignCommand.setTaskMode((short) 0); - assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); - assignCommand.setCharge(true); - - //鍒涘缓鍏呯數鎸囦护 - ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 2);//鏂紑鍏呯數 - commands.add(command); - - //鎸囦护闆嗗垎閰� - assignCommand.setCommands(commands); - - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING); - //涓嬪彂浠诲姟 - MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand)); - } - - if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id) { - shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING); - } } - + return true; } - /** - * 杞鍏呯數妗╂槸鍚︽湁绌洪棽灏忚溅 - */ - @Deprecated - public synchronized void queryChargeLocOfComplete() { - // 涓庡厖鐢典换鍔′笉鍚屾杩涜 - if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge)) { return; } - if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset)) { return; } - SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1); - // 妫�绱㈠厖鐢垫々 - for (SteChargeType value : SteChargeType.values()) { - Integer steNo = basSteService.hasCarOfLocNo(value.locNo); - if (steNo != null) { - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo); - SteProtocol steProtocol = steThread.getSteProtocol(); - BasSte basSte = basSteService.selectById(steNo); - if (Cools.isEmpty(steProtocol, basSte)) { - continue; - } - if (steProtocol.getCharge() < 99) { - continue; - } - if (steProtocol.getMode() == 0) { - continue; - } - if (!steProtocol.getStatusType().equals(SteStatusType.IDLE)) { - continue; - } -// // 1鍙峰厖鐢垫々 -// if (value.equals(SteChargeType.FIRST) && devpThread.charge0) { -// continue; -// } -// // 2鍙峰厖鐢垫々 -// if (value.equals(SteChargeType.SECOND) && devpThread.charge1) { -// continue; -// } -// // 3鍙峰厖鐢垫々 -// if (value.equals(SteChargeType.THIRD) && devpThread.charge2) { -// continue; -// } -// // 灏忚溅鏄惁澶勪簬鍏呯數鐘舵�� -// if (steProtocol.getChargeStatus() == 1) { -// continue; -// } - // case 1 : 鑷姩鍏呯數寮� 棣堢數 脳 - // case 2 : 鑷姩鍏呯數寮� 婊$數 鉁� - // case 3 : 鑷姩鍏呯數鍏� 棣堢數 鉁� - // case 4 : 鑷姩鍏呯數鍏� 婊$數 鉁� - if (basSte.getAutoCharge().equals("Y") - && steProtocol.getCharge() < Float.parseFloat(basSte.getChargeLine())) { - continue; - } - - WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset); - - if (wrkCharge == null) { - // 寮�濮嬬┛姊溅澶嶄綅浠诲姟 - wrkCharge = new WrkCharge(); - wrkCharge.setSteNo(steNo); - wrkCharge.setWrkNo(commonService.getChargeWorkNo(6)); - wrkCharge.setWrkSts(41L); // 41.灏忚溅鍑嗗澶嶄綅 - wrkCharge.setCrnNo(2); // 鍥哄畾2鍙峰爢鍨涙満 - wrkCharge.setIoPri((double) 10); - wrkCharge.setSourceLocNo(value.locNo); - wrkCharge.setLocNo(basSte.getIdleLoc()); - wrkCharge.setMemo("reset"); - wrkCharge.setAppeTime(new Date()); - if (!wrkChargeService.insert(wrkCharge)) { - News.error("淇濆瓨{}鍙风┛姊溅澶嶄綅浠诲姟澶辫触!!!", steNo); - } else { - break; - } - } - } - } - } - - /** - * 灏忚溅浠庡厖鐢垫々 鑷� 寰呮満搴撲綅 - */ - @Deprecated - public synchronized void steFromChargeToIdleLoc() { - WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.reset); - if (wrkCharge == null) { return; } - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo()); - SteProtocol steProtocol = steThread.getSteProtocol(); - BasSte basSte = basSteService.selectById(wrkCharge.getSteNo()); - if (Cools.isEmpty(steProtocol, basSte)) { - return; - } - // 鎼繍鑷冲浐瀹氶�氶亾 - if (wrkCharge.getWrkSts() == 41L) { - // 鎼皬杞﹁嚦灏忚溅璧板悜閫氶亾 - List<String> channel = slaveProperties.getChannel(); - for (String channelLocNo : channel) { - Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo()); - if (null != otherSte) { - News.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), channelLocNo, otherSte); - } else { - // 鍥哄畾鍫嗗灈鏈� - int crnNo = 1; - if (null != wrkMastMapper.selectWorkingByCrn(crnNo)) { - return; - } - - LocMast channelLoc = locMastService.selectById(channelLocNo); - - CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo); - CrnProtocol crnProtocol = crnThread.getCrnProtocol(); - if (crnProtocol == null) { continue; } - // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛� - if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) { - // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 -------------------------------------------------------------------------- - CrnCommand crnCommand = new CrnCommand(); - crnCommand.setCrnNo(crnNo); // 鍫嗗灈鏈虹紪鍙� - crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙� - crnCommand.setAckFinish((short) 0); // 浠诲姟瀹屾垚纭浣� - crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡: 搴撲綅绉昏浆 - crnCommand.setSourcePosX(steProtocol.getRow()); // 婧愬簱浣嶆帓 - crnCommand.setSourcePosY(steProtocol.getBay()); // 婧愬簱浣嶅垪 - crnCommand.setSourcePosZ(steProtocol.getLev()); // 婧愬簱浣嶅眰 - crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), false).shortValue()); // 鐩爣搴撲綅鎺� - crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue()); // 鐩爣搴撲綅鍒� - crnCommand.setDestinationPosZ(channelLoc.getLev1().shortValue()); // 鐩爣搴撲綅灞� - if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) { - News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand)); - } else { - // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞� - steThread.modifyPos(Utils.getGroupRow(channelLoc.getLocNo(), false), channelLoc.getBay1(), channelLoc.getLev1()); - // 淇敼宸ヤ綔妗g姸鎬� 41.灏忚溅鍑嗗澶嶄綅 => 42.鍚婅溅鎼繍 - Date now = new Date(); - wrkCharge.setWrkSts(42L); - wrkCharge.setCrnStrTime(now); - wrkCharge.setModiTime(now); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼澶嶄綅浠诲姟鐘舵�� 41.灏忚溅鍑嗗澶嶄綅 => 42.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo()); - } - } - break; - } - - } - } - } else if (wrkCharge.getWrkSts() == 43L) { - // 灏忚溅琛岄┒閫氶亾 - if (steProtocol.statusType.equals(SteStatusType.IDLE) && steProtocol.getPakMk().equals("N")) { - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙� - steCommand.setTaskMode(SteTaskModeType.BACK_ORIGIN); // 鍘诲乏绔� - - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); - if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 43.灏忚溅鍒拌揪 ===> 44.灏忚溅璧拌 - wrkCharge.setWrkSts(44L); - Date now = new Date(); - wrkCharge.setCrnEndTime(now); - wrkCharge.setModiTime(now); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼澶嶄綅浠诲姟鐘舵�� 43.灏忚溅鍒拌揪 ===> 44.灏忚溅璧拌 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo()); - } - } - } - } else if (wrkCharge.getWrkSts() == 45L) { - if (null != wrkMastMapper.selectWorkingByCrn(wrkCharge.getCrnNo())) { - return; - } - - LocMast idleLoc = locMastService.selectById(basSte.getIdleLoc()); - - Integer otherSte = existOtherSte(idleLoc.getLocNo(), wrkCharge.getSteNo()); - if (null != otherSte) { - News.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), idleLoc.getLocNo(), otherSte); - } else { - CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo()); - CrnProtocol crnProtocol = crnThread.getCrnProtocol(); - if (crnProtocol == null) { return; } - // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛� - if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) { - // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 -------------------------------------------------------------------------- - CrnCommand crnCommand = new CrnCommand(); - crnCommand.setCrnNo(wrkCharge.getCrnNo()); // 鍫嗗灈鏈虹紪鍙� - crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙� - crnCommand.setAckFinish((short) 0); // 浠诲姟瀹屾垚纭浣� - crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡: 搴撲綅绉昏浆 - crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); // 婧愬簱浣嶆帓 - crnCommand.setSourcePosY(steProtocol.getBay()); // 婧愬簱浣嶅垪 - crnCommand.setSourcePosZ(steProtocol.getLev()); // 婧愬簱浣嶅眰 - crnCommand.setDestinationPosX(Utils.getGroupRow(idleLoc.getLocNo(), true).shortValue()); // 鐩爣搴撲綅鎺� - crnCommand.setDestinationPosY(idleLoc.getBay1().shortValue()); // 鐩爣搴撲綅鍒� - crnCommand.setDestinationPosZ(idleLoc.getLev1().shortValue()); // 鐩爣搴撲綅灞� - if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) { - News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand)); - } else { - // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞� - steThread.modifyPos(Utils.getGroupRow(idleLoc.getLocNo(), true), idleLoc.getBay1(), idleLoc.getLev1()); - // 淇敼宸ヤ綔妗g姸鎬� 45.灏忚溅寰呮惉 => 46.鏀捐嚦寰呮満浣� - Date now = new Date(); - wrkCharge.setWrkSts(46L); - wrkCharge.setCrnStrTime(now); - wrkCharge.setModiTime(now); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼宸ヤ綔妗g姸鎬� 45.灏忚溅寰呮惉 => 46.鏀捐嚦寰呮満浣� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo()); - } - } - } - - } - } - } - - public List<String> crn2DemoLocs = new ArrayList<String>(); public String crn2LastLoc = ""; - public synchronized void demo() { - if (Cools.isEmpty(crn2DemoLocs)) { - crn2DemoLocs = locMastService.getDemoNextLoc(2); - } - for (CrnSlave crn : slaveProperties.getCrn()) { - if (!crn.getDemo()) { - continue; - } - // 蹇呴』涓烘紨绀虹姸鎬� - CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId()); - CrnProtocol crnProtocol = crnThread.getCrnProtocol(); - if (crnProtocol == null) { - continue; - } - - // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛� - if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) { - - // filter - if (wrkChargeService.selectCount(new EntityWrapper<WrkCharge>() - .eq("crn_no", crn.getId()).between("wrk_sts", 31, 36)) > 0) { - continue; - } - - SteThread steThread = queryIdleCar(crnProtocol); - if (Cools.isEmpty(steThread)) { - News.warn("娌℃湁绌洪棽鐨勫皬杞﹁繘琛屾紨绀哄姛鑳�"); - continue; - } - int steNo = steThread.getSlave().getId(); - SteProtocol steProtocol = steThread.getSteProtocol(); - BasSte basSte = basSteService.selectById(steNo); - if (Cools.isEmpty(steProtocol, basSte)) { continue; } - - // 鍙湁褰撶┛姊溅绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛� - if (steProtocol.isIdle()) { - - String locNo = null; - Iterator<String> iterator = crn2DemoLocs.iterator(); - while (iterator.hasNext()) { - String next = iterator.next(); - if (!Cools.isEmpty(this.hasCar(next))) { continue; } - String lastLoc = crn2LastLoc; - if (!Cools.isEmpty(lastLoc)) { - if (!lastLoc.substring(2, 7).equals(next.substring(2, 7)) - || !Utils.getGroupRow(lastLoc, true).equals(Utils.getGroupRow(next, true))) { - locNo = next; - iterator.remove(); - break; - } else { - iterator.remove(); - } - } else { - locNo = next; - iterator.remove(); - break; - } - - } - if (!Cools.isEmpty(locNo)) { - crn2LastLoc = locNo; - } - - News.info("{}鍙峰爢鍨涙満瀵箋}搴撲綅杩涜婕旂ず", crn.getId(), locNo); - - String sourceLocNo = Utils.getLocNo(steProtocol.getRow(), steProtocol.getBay(), steProtocol.getLev()); - - WrkCharge wrkCharge = new WrkCharge(); - wrkCharge.setCrnNo(crn.getId()); - wrkCharge.setSteNo(steNo); - wrkCharge.setWrkNo(commonService.getChargeWorkNo(5)); - wrkCharge.setWrkSts(31L); // 31.鐢熸垚婕旂ずID - wrkCharge.setIoPri((double) 10); - wrkCharge.setSourceLocNo(sourceLocNo); - wrkCharge.setLocNo(locNo); - wrkCharge.setMemo("demo"); - if (!wrkChargeService.insert(wrkCharge)) { - News.error("鐢熸垚婕旂ず浠诲姟澶辫触锛屽爢鍨涙満鍙凤細{}锛屽皬杞︼細{}锛屾簮搴撲綅锛歿}锛岀洰鏍囧簱浣嶏細{}", crn.getId(), steNo, sourceLocNo, locNo); - } - } - } - } - } - - /** - * 婕旂ず鍙栬揣 - */ - private void steMoveDemo(CrnSlave slave, CrnProtocol crnProtocol) { - // 鑾峰彇宸ヤ綔妗d俊鎭� - WrkCharge wrkCharge = wrkChargeService.selectOne(new EntityWrapper<WrkCharge>().eq("crn_no", slave.getId()) - .in("wrk_sts", 31, 33, 35)); - if (null == wrkCharge) { - return; - } - SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo()); - SteProtocol steProtocol = steThread.getSteProtocol(); - if (null == steProtocol) { return; } - if (steProtocol.isIdle()) { - // 31.鐢熸垚婕旂ずID - if (wrkCharge.getWrkSts() == 31L) { - this.letCarBeReady(wrkCharge, steProtocol.getSteNo().intValue()); - wrkCharge.setWrkSts(32L); - wrkCharge.setModiTime(new Date()); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼婕旂ず浠诲姟{}宸ヤ綔妗� 31.鐢熸垚婕旂ずID ==>> 32.灏忚溅璧拌 澶辫触!", wrkCharge.getWrkNo()); - } - // 33.灏忚溅寰呮惉 - } else if (wrkCharge.getWrkSts() == 33L) { - LocMast locMast = locMastService.selectById(wrkCharge.getLocNo()); - // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 -------------------------------------------------------------------------- - CrnCommand crnCommand = new CrnCommand(); - crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 鍫嗗灈鏈虹紪鍙� - crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙� - crnCommand.setAckFinish((short) 0); // 浠诲姟瀹屾垚纭浣� - crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡: 搴撲綅绉昏浆 - crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue()); // 婧愬簱浣嶆帓 - crnCommand.setSourcePosY(steProtocol.getBay()); // 婧愬簱浣嶅垪 - crnCommand.setSourcePosZ(steProtocol.getLev()); // 婧愬簱浣嶅眰 - crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo(), true).shortValue()); // 鐩爣搴撲綅鎺� - crnCommand.setDestinationPosY(locMast.getBay1().shortValue()); // 鐩爣搴撲綅鍒� - crnCommand.setDestinationPosZ(locMast.getLev1().shortValue()); // 鐩爣搴撲綅灞� - if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) { - News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand)); - } else { - // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞� - steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo(), true), locMast.getBay1(), locMast.getLev1()); - // 淇敼宸ヤ綔妗g姸鎬� 33.灏忚溅寰呮惉 => 34.鍚婅溅鎼繍 - Date now = new Date(); - wrkCharge.setWrkSts(34L); - wrkCharge.setCrnStrTime(now); - wrkCharge.setModiTime(now); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼婕旂ず浠诲姟{}宸ヤ綔妗� 33.灏忚溅寰呮惉 => 34.鍚婅溅鎼繍 澶辫触!", wrkCharge.getWrkNo()); - } - } - // 35.灏忚溅灏辩华 - } else if (wrkCharge.getWrkSts() == 35L) { - - int steNo = steProtocol.getSteNo().intValue(); - if (!basSteService.updatePakMk(steNo, "Y")) { - News.error("淇敼绌挎杞︿綔涓氱姸鎬� 澶辫触锛侊紒锛岀┛姊溅={}", steNo); - return; - } - - // 鍛戒护涓嬪彂鍖� -------------------------------------------------------------------------- - SteCommand steCommand = new SteCommand(); - steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙� - steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙� - SteTaskModeType originByLoc = SteTaskModeType.findOriginByLoc(steProtocol.getRow().intValue()); - if (originByLoc.equals(SteTaskModeType.GO_ORIGIN)) { - originByLoc = SteTaskModeType.BACK_ORIGIN; - } else if (originByLoc.equals(SteTaskModeType.BACK_ORIGIN)) { - originByLoc = SteTaskModeType.GO_ORIGIN; - } else { - return; - } - steCommand.setTaskMode(originByLoc); - - steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue()); - steCommand.setBay(steProtocol.getBay()); - steCommand.setLev(steProtocol.getLev()); - - if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) { - News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand)); - } else { - // 淇敼宸ヤ綔妗g姸鎬� 35.灏忚溅灏辩华 => 36.灏忚溅璧拌 - wrkCharge.setWrkSts(36L); - wrkCharge.setModiTime(new Date()); - if (!wrkChargeService.updateById(wrkCharge)) { - News.error("淇敼婕旂ず浠诲姟{}宸ヤ綔妗� 35.灏忚溅灏辩华 => 36.灏忚溅璧拌 澶辫触!", wrkCharge.getWrkNo()); - } - } - } - } - - } /** * 鍑哄叆搴撴ā寮忓垏鎹� */ -- Gitblit v1.9.1