#

vincentlu

2025-12-18 830d326b37c4a5d13ae55678d5729993908f9c90

 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/PatrolService.java

@@ -5,7 +5,12 @@
import com.zy.acs.framework.common.Cools;
import com.zy.acs.framework.common.R;
import com.zy.acs.manager.core.cache.CoreCache;
import com.zy.acs.manager.manager.entity.*;
import com.zy.acs.manager.core.domain.CodeStepDto;
import com.zy.acs.manager.core.domain.type.JobType;
import com.zy.acs.manager.manager.entity.Agv;
import com.zy.acs.manager.manager.entity.AgvDetail;
import com.zy.acs.manager.manager.entity.Code;
import com.zy.acs.manager.manager.entity.Travel;
import com.zy.acs.manager.manager.enums.StatusType;
import com.zy.acs.manager.manager.enums.TaskTypeType;
import com.zy.acs.manager.manager.enums.TravelStateType;
@@ -45,17 +50,8 @@
    }};

    private List<String> CONVEYOR_PICK_CODE_DATA_CACHE = new ArrayList<String>(){{
        add("00000246");
        add("00000146");
    }};

    private Map<String, JobType> agvJobMap = new ConcurrentHashMap<>();
    public enum JobType {
        CONVEYOR_PICK,
        CONVEYOR_DROP,
        LOC_PICK,
        LOCK_DROP,
        ;
    }

    @Autowired
    private AgvService agvService;
@@ -77,6 +73,24 @@
    private ConfigService configService;
    @Autowired
    private AgvModelService agvModelService;
    @Autowired
    private AgvAreaDispatcher agvAreaDispatcher;

    @PostConstruct
    public void init() {
        int count = agvService.count(new LambdaQueryWrapper<Agv>().eq(Agv::getStatus, StatusType.ENABLE.val));
        if (count > 0) {
            this.scheduler = Executors.newScheduledThreadPool(count);
        }
        // init all code data
        List<Code> codeList = codeService.list(new LambdaQueryWrapper<Code>().eq(Code::getStatus, StatusType.ENABLE.val));
        this.CODE_DATA_CACHE = codeList.stream().map(Code::getData).distinct().collect(Collectors.toList());

        // int all loc code data
        List<Code> locCodeList = codeService.getAllLocCode();
        this.LOC_CODE_DATA_CACHE = locCodeList.stream().map(Code::getData).distinct().collect(Collectors.toList());

    }

    // pick & drop logic --------------------------------------------------

@@ -91,26 +105,17 @@
            return;
        }

//        // 已使用背篓数量
//        Integer usedSlots = CoreCache.AGV_BACKPACK_USED_CACHE.get(agvId);
//        if (null == usedSlots) {
//            return;
//        }
//        AgvModel agvModel = agvModelService.getByAgvId(agvId);
//        // 背篓空闲数
//        int remainingBackpack = Math.max(agvModel.getBackpack() - usedSlots, 0);


        String destinationCodeData = null;

        JobType jobType = this.agvJobMap.get(agvNo);
        JobType jobType = CoreCache.AGV_MOCK_JOB_CACHE.get(agvNo);
        if (null == jobType) {
            this.agvJobMap.put(agvNo, JobType.LOC_PICK);
            CoreCache.AGV_MOCK_JOB_CACHE.put(agvNo, JobType.LOC_PICK);
            CoreCache.AGV_BACKPACK_USED_CACHE.put(agvId, 0);
            jobType = JobType.LOC_PICK;
        }

        String destinationCodeData = null;
        switch (jobType) {
            case LOC_PICK:
                // 5, 4, 3, 2, 1
                int locPickRemaining = agvService.getBackpackRemainingCapacity(agvId);
                if (0 < locPickRemaining) {
                    destinationCodeData = this.getLocCode(agvNo, null);
@@ -123,8 +128,9 @@
                destinationCodeData = this.getConveyorPickCode(agvNo);
                break;
            case LOCK_DROP:
                // 0, 1, 2, 3, 4
                int locDropRemaining = agvService.getBackpackRemainingCapacity(agvId);
                if (0 < locDropRemaining) {
                if (locDropRemaining < agvModelService.getByAgvId(agvId).getBackpack()) {
                    destinationCodeData = this.getLocCode(agvNo, null);
                }
                break;
@@ -132,7 +138,6 @@
                log.warn("AGV {}: 未知阶段: {}", agvNo, jobType);
                break;
        }

        if (Cools.isEmpty(destinationCodeData)) {
            return;
        }
@@ -140,42 +145,8 @@
        if (mainLockWrapService.buildMinorTask(agvId, TaskTypeType.MOVE, destinationCodeData, null)) {
            log.info( "{}开始作业演示...", agvNo);

            switch (jobType) {
                case LOC_PICK:
                    Integer usedSlotsByLocPick = CoreCache.AGV_BACKPACK_USED_CACHE.get(agvId);
                    usedSlotsByLocPick++;

                    if (Objects.equals(agvModelService.getByAgvId(agvId).getBackpack(), usedSlotsByLocPick)) {
                        this.agvJobMap.put(agvNo, JobType.CONVEYOR_DROP);
                    } else {
                        CoreCache.AGV_BACKPACK_USED_CACHE.put(agvId, usedSlotsByLocPick);
                    }
                    break;
                case CONVEYOR_DROP:
                    CoreCache.AGV_BACKPACK_USED_CACHE.put(agvId, 0);

                    this.agvJobMap.put(agvNo, JobType.CONVEYOR_PICK);
                    break;
                case CONVEYOR_PICK:
                    CoreCache.AGV_BACKPACK_USED_CACHE.put(agvId, agvModelService.getByAgvId(agvId).getBackpack());

                    this.agvJobMap.put(agvNo, JobType.LOCK_DROP);
                    break;
                case LOCK_DROP:
                    Integer usedSlotsByLocDrop = CoreCache.AGV_BACKPACK_USED_CACHE.get(agvId);
                    usedSlotsByLocDrop--;

                    if (usedSlotsByLocDrop == 0) {
                        this.agvJobMap.put(agvNo, JobType.LOC_PICK);
                    } else {
                        CoreCache.AGV_BACKPACK_USED_CACHE.put(agvId, usedSlotsByLocDrop);
                    }
                    break;
                default:
                    break;
            }
            CoreCache.AGV_MOCK_STEP_CACHE.put(agvId, CodeStepDto.build(destinationCodeData, jobType));
        }

    }

    public String getLocCode(String agvNo, AgvDetail agvDetail) {
@@ -247,28 +218,12 @@
        Code startCode = codeService.getCacheById(agvDetail.getRecentCode());

        Set<String> notInCodeSet = new HashSet<>();
        notInCodeSet.add("00000301");
        notInCodeSet.add("00000302");
        notInCodeSet.add("00000303");
        notInCodeSet.add("00000351");
        notInCodeSet.add("00000353");
        notInCodeSet.add("00000401");
        notInCodeSet.add("00000402");

        notInCodeSet.add("00000311");
        notInCodeSet.add("00000312");
        notInCodeSet.add("00000313");
        notInCodeSet.add("00000361");
        notInCodeSet.add("00000363");
        notInCodeSet.add("00000411");
        notInCodeSet.add("00000412");
//        Collections.shuffle(CODE_DATA_CACHE);
        List<String> codeList = agvAreaDispatcher.getCodesByAgvId(agvDetail.getAgvId());
        Collections.shuffle(codeList);

        notInCodeSet.add("00000046");
        notInCodeSet.add("00000047");

        Collections.shuffle(CODE_DATA_CACHE);

        for (String endCodeData : CODE_DATA_CACHE) {
        for (String endCodeData : codeList) {
            if (notInCodeSet.contains(endCodeData)) { continue; }
            Code endCode = codeService.getCacheByData(endCodeData);

@@ -284,7 +239,7 @@
            }
        }

        return CODE_DATA_CACHE.stream().findFirst().orElse(null);
        return codeList.stream().findFirst().orElse(null);
    }

    // ---------------------------------------------------------------------------
@@ -304,10 +259,10 @@

        Runnable patrolTask = () -> {
            try {
//                executePatrolLogic(agvNo);
                executeUShapeConveyor(agvNo);
                executePatrolLogic(agvNo);
//                executeUShapeConveyor(agvNo);
            } catch (Exception e) {
                log.error("执行AGV{}跑库任务时发生异常: {}", agvNo, e.getMessage());
                log.error("执行AGV{}跑库任务时发生异常", agvNo, e);
            }
        };

@@ -330,29 +285,14 @@
        if (cancelled) {
            AGV_PATROL_MAP.remove(agvNo);
            CoreCache.AGV_BACKPACK_USED_CACHE.remove(agvId);
            this.agvJobMap.remove(agvNo);
            log.info("已停止AGV " + agvNo + " 的跑库任务。");
            CoreCache.AGV_MOCK_STEP_CACHE.remove(agvId);
            CoreCache.AGV_MOCK_JOB_CACHE.remove(agvNo);
            log.info("已停止AGV {} 的跑库任务。", agvNo);
            return R.ok("已停止AGV " + agvNo + " 的跑库任务。");
        } else {
            log.error("未能成功停止AGV " + agvNo + " 的跑库任务。");
            return R.error("未能成功停止AGV " + agvNo + " 的跑库任务。");
        }
    }

    @PostConstruct
    public void init() {
        int count = agvService.count(new LambdaQueryWrapper<Agv>().eq(Agv::getStatus, StatusType.ENABLE.val));
        if (count > 0) {
            this.scheduler = Executors.newScheduledThreadPool(count);
        }
        // init all code data
        List<Code> codeList = codeService.list(new LambdaQueryWrapper<Code>().eq(Code::getStatus, StatusType.ENABLE.val));
        this.CODE_DATA_CACHE = codeList.stream().map(Code::getData).distinct().collect(Collectors.toList());

        // int all loc code data
        List<Code> locCodeList = codeService.getAllLocCode();
        this.LOC_CODE_DATA_CACHE = locCodeList.stream().map(Code::getData).distinct().collect(Collectors.toList());

    }

    @PreDestroy