| | |
| | | int idx = -1; |
| | | for (int i = 0; i < destPosList.size(); i++) { |
| | | if (Objects.equals(destPosList.get(i).getTaskId(), newDto.getTaskId()) |
| | | && Objects.equals(destPosList.get(i).getCodeId(), newDto.getCodeId())) { |
| | | && Objects.equals(destPosList.get(i).getCodeId(), newDto.getCodeId())) { |
| | | idx = i; |
| | | break; |
| | | } |
| | |
| | | task.getBusId(), // 总线 |
| | | task.getId(), // 任务 |
| | | null, // 动作号 |
| | | null, // 优先级 |
| | | null, // 优先级 |
| | | ActionTypeType.ReadyReleaseToShelvesLoc.desc, // 名称 |
| | | (double) actuatorDirectionType.val, // 属性值 |
| | | lastCode.getData(), // 地面码 |
| | |
| | | case ORI_STA: |
| | | // 站点取货 |
| | | Sta oriSta = staService.getById(task.getOriSta()); |
| | | Double angle = oriSta.getAngle() == null ? mapService.getStaAngle(oriSta, workDirection) : Double.valueOf(oriSta.getAngle()); |
| | | Double oriStaWorkDirection = mapService.getStaAngle(oriSta); |
| | | // 检验方向 |
| | | if (!lastDirection.equals(Double.valueOf(angle))) { |
| | | if (!lastDirection.equals(oriStaWorkDirection)) { |
| | | if (!lastCode.getCornerBool()) { |
| | | throw new CoolException(agvNo + "号小车方向错误,请推至转弯点手动调整"); |
| | | } |
| | |
| | | null, // 动作号 |
| | | null, // 优先级 |
| | | ActionTypeType.TurnCorner.desc, // 名称 |
| | | (double) MapService.calcSpinDirection(lastCode, lastDirection, angle).val, // 属性值 |
| | | (double) MapService.calcSpinDirection(lastCode, lastDirection, oriStaWorkDirection).val, // 属性值 |
| | | lastCode.getData(), // 地面码 |
| | | String.valueOf(angle), // 动作参数 |
| | | String.valueOf(oriStaWorkDirection), // 动作参数 |
| | | ActionTypeType.TurnCorner.val(), // 动作类型 |
| | | actionPrepareSts, // 动作进度 |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | lastDirection = angle; |
| | | lastDirection = oriStaWorkDirection; |
| | | } |
| | | // 计算货叉工作方向 |
| | | actuatorDirectionType = ActuatorDirectionType.fromVal(oriSta.getActDir()); |
| | |
| | | case DEST_STA: |
| | | // 站点放货 |
| | | Sta destSta = staService.getById(task.getDestSta()); |
| | | angle = destSta.getAngle() == null ? mapService.getStaAngle(destSta, workDirection) : Double.valueOf(destSta.getAngle()); |
| | | Double destStaWorkDirection = mapService.getStaAngle(destSta); |
| | | // 检验方向 |
| | | if (!lastDirection.equals(angle)) { |
| | | if (!lastDirection.equals(destStaWorkDirection)) { |
| | | if (!lastCode.getCornerBool()) { |
| | | throw new CoolException(agvNo + "号小车方向错误,请推至转弯点手动调整"); |
| | | } |
| | |
| | | null, // 动作号 |
| | | null, // 优先级 |
| | | ActionTypeType.TurnCorner.desc, // 名称 |
| | | (double) MapService.calcSpinDirection(lastCode, lastDirection, angle).val, // 属性值 |
| | | (double) MapService.calcSpinDirection(lastCode, lastDirection, destStaWorkDirection).val, // 属性值 |
| | | lastCode.getData(), // 地面码 |
| | | String.valueOf(angle), // 动作参数 |
| | | String.valueOf(destStaWorkDirection), // 动作参数 |
| | | ActionTypeType.TurnCorner.val(), // 动作类型 |
| | | actionPrepareSts, // 动作进度 |
| | | agvId, // AGV |
| | | now // 工作时间 |
| | | )); |
| | | lastDirection = angle; |
| | | lastDirection = destStaWorkDirection; |
| | | } |
| | | // 背篓取货 |
| | | if (backupAction) { |
| | |
| | | |
| | | // segment list |
| | | List<Segment> segmentList = segmentService.list(new LambdaQueryWrapper<Segment>() |
| | | .eq(Segment::getGroupId, serialNo) |
| | | .eq(Segment::getGroupId, serialNo) |
| | | // .eq(Segment::getState, SegmentStateType.RUNNING.toString()) |
| | | .orderByAsc(Segment::getSerial) |
| | | .orderByAsc(Segment::getSerial) |
| | | ); |
| | | |
| | | // settlement |