| | |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | log.info("1TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}", |
| | | Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())), |
| | | lastCode.getData(), |
| | | lastCode.getCornerBool(), |
| | | nextDirection, |
| | | 180); |
| | | } else { |
| | | // turn |
| | | actionList.add(new Action( |
| | |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | log.info("2TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}", |
| | | Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())), |
| | | lastCode.getData(), |
| | | lastCode.getCornerBool(), |
| | | nextDirection, |
| | | nextDirection); |
| | | } |
| | | lastDirection = nextDirection; |
| | | } |
| | |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | log.info("3TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}", |
| | | Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())), |
| | | lastCode.getData(), |
| | | lastCode.getCornerBool(), |
| | | nextDirection, |
| | | 180); |
| | | } |
| | | } |
| | | } |
| | |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | log.info("4TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}", |
| | | Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())), |
| | | lastCode.getData(), |
| | | lastCode.getCornerBool(), |
| | | nextDirection, |
| | | nextDirection); |
| | | |
| | | lastDirection = nextDirection; |
| | | } |
| | |
| | | if (first) { |
| | | if (Cools.isEmpty(actionList) || !actionList.get(0).getActionType().equals(ActionTypeType.TurnCorner.val())) { |
| | | Double turnDirection = workDirection; |
| | | List<String> list = Arrays.asList("00000051", "00000052", "00000053", "00000054"); |
| | | List<String> list = Arrays.asList("00000050","00000051", "00000052", "00000053", "00000054"); |
| | | if ((Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())).equals(TaskPosDto.PosType.ORI_STA) |
| | | || Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())) |
| | | .equals(TaskPosDto.PosType.DEST_STA)) && list.contains(lastCode.getData())) { |
| | |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | log.info("5TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}", |
| | | Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())), |
| | | lastCode.getData(), |
| | | lastCode.getCornerBool(), |
| | | null, |
| | | turnDirection); |
| | | lastDirection = workDirection; |
| | | } |
| | | } |