| | |
| | | segCmd.setCommandType(original.getCommandType()); |
| | | segCmd.setPalletSize(original.getPalletSize()); |
| | | segCmd.setNavigatePath(new ArrayList<>(path.subList(0, currentEndIdx + 1))); |
| | | sendCommand(segCmd); |
| | | if (!sendSegmentWithRetry(segCmd, original.getTaskNo())) { |
| | | return; |
| | | } |
| | | |
| | | long runTime = System.currentTimeMillis(); |
| | | boolean firstRun = true; |
| | |
| | | nextCmd.setPalletSize(original.getPalletSize()); |
| | | nextCmd.setNavigatePath(new ArrayList<>(path.subList(currentStartIdx, currentEndIdx + 1))); |
| | | nextCmd.setOriginalNavigatePath(path); |
| | | while (true) { |
| | | CommandResponse commandResponse = sendCommand(nextCmd); |
| | | if (commandResponse == null) { |
| | | Thread.sleep(200); |
| | | continue; |
| | | } |
| | | |
| | | if (commandResponse.getResult()) { |
| | | break; |
| | | } |
| | | |
| | | Thread.sleep(200); |
| | | if (!sendSegmentWithRetry(nextCmd, original.getTaskNo())) { |
| | | break; |
| | | } |
| | | } |
| | | Thread.sleep(500); |
| | |
| | | } |
| | | return null; |
| | | } |
| | | |
| | | private boolean sendSegmentWithRetry(StationCommand command, Integer taskNo) { |
| | | while (true) { |
| | | if (isTaskMoveReset(taskNo)) { |
| | | return false; |
| | | } |
| | | CommandResponse commandResponse = sendCommand(command); |
| | | if (commandResponse == null) { |
| | | sleepQuietly(200L); |
| | | continue; |
| | | } |
| | | if (commandResponse.getResult()) { |
| | | return true; |
| | | } |
| | | sleepQuietly(200L); |
| | | } |
| | | } |
| | | |
| | | private boolean isTaskMoveReset(Integer taskNo) { |
| | | if (taskNo == null || redisUtil == null) { |
| | | return false; |
| | | } |
| | | Object cancel = redisUtil.get(RedisKeyType.DEVICE_STATION_MOVE_RESET.key + taskNo); |
| | | return cancel != null; |
| | | } |
| | | |
| | | private void sleepQuietly(long millis) { |
| | | try { |
| | | Thread.sleep(millis); |
| | | } catch (Exception ignore) { |
| | | } |
| | | } |
| | | } |