#

Junjie

2025-04-15 d56b8093dc9e3e75f8efe1a0f1aa6d821c9c3dfb

 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java

@@ -1,7 +1,6 @@
package com.zy.asrs.wcs.core.utils;

import com.alibaba.fastjson.JSON;
import com.alibaba.fastjson.JSONArray;
import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
import com.zy.asrs.framework.common.Cools;
import com.zy.asrs.framework.common.SnowflakeIdWorker;
@@ -24,6 +23,7 @@
import com.zy.asrs.wcs.system.service.DictService;
import org.springframework.beans.factory.annotation.Autowired;
import org.springframework.stereotype.Service;
import org.springframework.transaction.annotation.Transactional;

import java.util.*;

@@ -59,6 +59,73 @@
    @Autowired
    private NavigateUtils navigateUtils;

    /**
     * 调度车辆
     */
    public Device dispatchShuttle(Task task, String locNo) {
        ArrayList<ShuttleThread> sameLev = new ArrayList<>();//相同楼层的穿梭车
        ArrayList<ShuttleThread> diffLev = new ArrayList<>();//不同楼层的穿梭车

        ShuttleThread resThread = null;
        int lev = Utils.getLev(locNo);
        List<Device> list = deviceService.list(new LambdaQueryWrapper<Device>()
                .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
                .eq(Device::getHostId, task.getHostId())
                .eq(Device::getStatus, 1));
        //获取同层小车
        List<Device> currentLevDevices = new ArrayList<>();
        //获取跨层小车
        HashMap<Integer, List<Device>> diffLevDeviceMap = new HashMap<>();
        for (Device device : list) {
            //获取四向穿梭车线程
            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
            ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
            if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
                continue;
            }

            if (shuttleProtocol.getCurrentLocNo() == null) {
                continue;
            }

            int shuttleLev = Utils.getLev(shuttleProtocol.getCurrentLocNo());
            if (shuttleLev == lev) {
                currentLevDevices.add(device);
            } else {
                List<Device> devices = null;
                if (diffLevDeviceMap.containsKey(shuttleLev)) {
                    devices = diffLevDeviceMap.get(shuttleLev);
                } else {
                    devices = new ArrayList<>();
                }
                devices.add(device);
                diffLevDeviceMap.put(shuttleLev, devices);
            }
        }

        //搜索同层
        resThread = this.searchCurrentLevShuttle(currentLevDevices, locNo);

        //同层没有搜索到合适小车，跨楼层搜索
        if (resThread == null) {
            resThread = this.searchDiffLevShuttle(diffLevDeviceMap, locNo, task);
        }

        if (resThread != null) {
            if (resThread.getStatus().getCurrentLocNo().equals(locNo)) {
                return resThread.getDevice();
            }

            Task result = generateMoveTask(resThread.getDevice(), locNo);
            if (result != null) {
                return resThread.getDevice();
            }
        }

        News.info("{}目标库位没有搜索到可用穿梭车", locNo);
        return null;
    }

    public synchronized ShuttleThread searchIdleShuttle(Task task) {
        String locNo = taskService.judgeInbound(task) ? task.getDestLoc() : task.getOriginLoc();
        ShuttleThread resThread = null;
@@ -70,7 +137,7 @@
        //获取同层小车
        List<Device> currentLevDevices = new ArrayList<>();
        //获取跨层小车
        List<Device> diffLevDevices = new ArrayList<>();
        HashMap<Integer,List<Device>> diffLevDeviceMap = new HashMap<>();
        for (Device device : list) {
            //获取四向穿梭车线程
            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
@@ -79,10 +146,22 @@
                continue;
            }

            if (Utils.getLev(shuttleProtocol.getCurrentLocNo()) == lev) {
            if (shuttleProtocol.getCurrentLocNo() == null) {
                continue;
            }

            int shuttleLev = Utils.getLev(shuttleProtocol.getCurrentLocNo());
            if (shuttleLev == lev) {
                currentLevDevices.add(device);
            }else {
                diffLevDevices.add(device);
                List<Device> devices = null;
                if(diffLevDeviceMap.containsKey(shuttleLev)) {
                    devices = diffLevDeviceMap.get(shuttleLev);
                }else {
                    devices = new ArrayList<>();
                }
                devices.add(device);
                diffLevDeviceMap.put(shuttleLev, devices);
            }
        }
        //搜索同层
@@ -90,7 +169,7 @@

        //同层没有搜索到合适小车，跨楼层搜索
        if(resThread == null) {
            resThread = this.searchDiffLevShuttle(diffLevDevices, locNo, task);
            resThread = this.searchDiffLevShuttle(diffLevDeviceMap, locNo, task);
        }

        return resThread;
@@ -136,6 +215,12 @@
            }

            // 有没有被其他任务调度
            List<Task> taskList = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()), null);
            if (!taskList.isEmpty()) {
                continue;
            }


            int currentLev = Utils.getLev(shuttleProtocol.getCurrentLocNo());//小车当前层高
            String currentLocNo = shuttleProtocol.getCurrentLocNo();//小车当前库位号

@@ -146,10 +231,10 @@

            // 同楼层直接计算到目标库位
            //当前穿梭车线程到当前车子所在楼层的目标库位距离
            List<NavigateNode> currentShuttlePath = navigateUtils.calc(
            List<NavigateNode> currentShuttlePath = navigateUtils.calcWhiteList(
                    currentLocNo
                    , locNo
                    , NavigationMapType.NORMAL.id
                    , NavigationMapType.DFX.id
                    , Utils.getShuttlePoints(Integer.parseInt(shuttleThread.getDevice().getDeviceNo()), currentLev)
            );//搜索空闲穿梭车，使用正常通道地图
            if (currentShuttlePath == null) {
@@ -173,102 +258,114 @@
        return resThread;
    }

    private synchronized ShuttleThread searchDiffLevShuttle(List<Device> devices, String locNo, Task task) {
    private synchronized ShuttleThread searchDiffLevShuttle(HashMap<Integer,List<Device>> devicesMap, String locNo, Task task) {
        ShuttleThread resThread = null;
        Integer finalDistance = ShuttleDispatcher.INF;

        //检测目标楼层车数量是否小于允许的最大数量
        boolean checkDispatchMaxNum = checkDispatchMaxNum(Utils.getLev(locNo), task.getHostId());

        for (Device device : devices) {
            if (taskService.hasBusyOutboundByShuttle(Integer.parseInt(device.getDeviceNo()))) {
                continue;
            }
            //获取四向穿梭车线程
            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
            ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
            if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
                continue;
            }
        for (Map.Entry<Integer, List<Device>> entry : devicesMap.entrySet()) {
            Integer lev = entry.getKey();
            List<Device> devices = entry.getValue();
            for (Device device : devices) {
                if (taskService.hasBusyOutboundByShuttle(Integer.parseInt(device.getDeviceNo()))) {
                    continue;
                }
                //获取四向穿梭车线程
                ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
                ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
                if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
                    continue;
                }

            if (!shuttleThread.isIdle()) {
                continue;
            }
                if (!shuttleThread.isIdle()) {
                    continue;
                }

            BasShuttle basShuttle = basShuttleService.getOne(new LambdaQueryWrapper<BasShuttle>()
                    .eq(BasShuttle::getShuttleNo, device.getDeviceNo())
                    .eq(BasShuttle::getHostId, device.getHostId()));
            if (basShuttle == null) {
                continue;//小车基础数据不存在
            }
                BasShuttle basShuttle = basShuttleService.getOne(new LambdaQueryWrapper<BasShuttle>()
                        .eq(BasShuttle::getShuttleNo, device.getDeviceNo())
                        .eq(BasShuttle::getHostId, device.getHostId()));
                if (basShuttle == null) {
                    continue;//小车基础数据不存在
                }

            if (!Cools.isEmpty(basShuttle.getDisableLev())) {
                List<Integer> disableLev = JSON.parseArray(basShuttle.getDisableLev(), Integer.class);
                //检查小车是否禁用该楼层
                if (disableLev.contains(Utils.getLev(locNo))) {
                    continue;//小车禁用该楼层跳过该车
                if (!Cools.isEmpty(basShuttle.getDisableLev())) {
                    List<Integer> disableLev = JSON.parseArray(basShuttle.getDisableLev(), Integer.class);
                    //检查小车是否禁用该楼层
                    if (disableLev.contains(Utils.getLev(locNo))) {
                        continue;//小车禁用该楼层跳过该车
                    }
                }

                //检测是否存在充电任务
                Task taskCharge = taskService.selectChargeWorking(Integer.valueOf(device.getDeviceNo()));
                if (taskCharge != null) {
                    continue;
                }

                // 有没有被其他任务调度
                List<Task> taskList = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()), null);
                if (!taskList.isEmpty()) {
                    continue;
                }

                int currentLev = Utils.getLev(shuttleProtocol.getCurrentLocNo());//小车当前层高
                String currentLocNo = shuttleProtocol.getCurrentLocNo();//小车当前库位号

                if (!checkDispatchMaxNum) {
                    News.info("{}任务，{}层，已经达到当前楼层调度车辆最大值", task.getTaskNo(), Utils.getLev(locNo));
                    continue;
                }

                //获取距离小车位置最近的空闲可换层提升机
                LiftThread liftThread = liftDispatcher.searchIdleLift(currentLocNo, task.getHostId(), true);
                if (liftThread == null) {
                    continue;
                }
                Device recentTransferLift = liftThread.getDevice();

                //获取小车楼层提升机待机位
                ShuttleStandby shuttleStandby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
                        .eq(ShuttleStandby::getDeviceId, recentTransferLift.getId())
                        .eq(ShuttleStandby::getDeviceLev, currentLev)
                        .eq(ShuttleStandby::getStatus, 1));
                String targetLocNo = shuttleStandby.getDeviceLoc();

                //当前穿梭车线程到当前车子所在楼层的提升机待机位距离
                List<NavigateNode> currentShuttlePath = navigateUtils.calc(
                        currentLocNo
                        , targetLocNo
                        , NavigationMapType.DFX.id
                        , Utils.getShuttlePoints(Integer.parseInt(shuttleThread.getDevice().getDeviceNo()), currentLev)
                );//搜索空闲穿梭车，使用正常通道地图
                if (currentShuttlePath == null) {
                    continue;
                }

                Integer currDistance = navigateUtils.getOriginPathAllDistance(currentShuttlePath);//计算当前路径行走总距离

                // 不同楼层权重
                if (currentLev != Utils.getLev(locNo)) {
                    currDistance += WEIGHT;
                }

                // 挂载任务权重
                List<Task> tasks = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()), null);
                if (!Cools.isEmpty(tasks)) {
                    currDistance += tasks.size() * WEIGHT;
                }

                if (currDistance < finalDistance) {
                    finalDistance = currDistance;
                    resThread = shuttleThread;
                }
            }

            //检测是否存在充电任务
            Task taskCharge = taskService.selectChargeWorking(Integer.valueOf(device.getDeviceNo()));
            if (taskCharge != null) {
                continue;
            }

            // 有没有被其他任务调度
            int currentLev = Utils.getLev(shuttleProtocol.getCurrentLocNo());//小车当前层高
            String currentLocNo = shuttleProtocol.getCurrentLocNo();//小车当前库位号

            if (!checkDispatchMaxNum) {
                News.info("{}任务，{}层，已经达到当前楼层调度车辆最大值", task.getTaskNo(), Utils.getLev(locNo));
                continue;
            }

            //获取距离小车位置最近的空闲可换层提升机
            LiftThread liftThread = liftDispatcher.searchIdleLift(currentLocNo, task.getHostId(), true);
            if (liftThread == null) {
                continue;
            }
            Device recentTransferLift = liftThread.getDevice();

            //获取小车楼层提升机待机位
            ShuttleStandby shuttleStandby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
                    .eq(ShuttleStandby::getDeviceId, recentTransferLift.getId())
                    .eq(ShuttleStandby::getDeviceLev, currentLev)
                    .eq(ShuttleStandby::getStatus, 1));
            String targetLocNo = shuttleStandby.getDeviceLoc();

            //当前穿梭车线程到当前车子所在楼层的提升机待机位距离
            List<NavigateNode> currentShuttlePath = navigateUtils.calc(
                    currentLocNo
                    , targetLocNo
                    , NavigationMapType.NORMAL.id
                    , Utils.getShuttlePoints(Integer.parseInt(shuttleThread.getDevice().getDeviceNo()), currentLev)
            );//搜索空闲穿梭车，使用正常通道地图
            if (currentShuttlePath == null) {
                continue;
            }

            Integer currDistance = navigateUtils.getOriginPathAllDistance(currentShuttlePath);//计算当前路径行走总距离

            // 不同楼层权重
            if (currentLev != Utils.getLev(locNo)) {
                currDistance += WEIGHT;
            }

            // 挂载任务权重
            List<Task> tasks = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()), null);
            if (!Cools.isEmpty(tasks)) {
                currDistance += tasks.size() * WEIGHT;
            }

            if (currDistance < finalDistance) {
                finalDistance = currDistance;
                resThread = shuttleThread;
            if (resThread != null) {
                break;
            }
        }

        return resThread;
    }

@@ -292,6 +389,11 @@
            return null;
        }

        ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
        if (shuttleProtocol == null) {
            return null;
        }

        Task task = new Task();
        task.setUuid(String.valueOf(snowflakeIdWorker.nextId()));
        task.setTaskNo(String.valueOf(Utils.getTaskNo("MOVE")));
@@ -299,7 +401,7 @@
        task.setTaskCtg(taskCtg.getId());
        task.setPriority(10);
        task.setOriginSite(null);
        task.setOriginLoc(null);
        task.setOriginLoc(shuttleProtocol.getCurrentLocNo());
        task.setDestSite(null);
        task.setDestLoc(locNo); // 迁移位置
        task.setIoTime(new Date());
@@ -541,5 +643,26 @@
        return lastPathStartLoc;
    }

    //获取小车坐标
    public String findShuttleLocNo(Integer shuttleNo, Long hostId) {
        Device device = deviceService.getOne(new LambdaQueryWrapper<Device>()
                .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
                .eq(Device::getDeviceNo, shuttleNo)
                .eq(Device::getHostId, hostId)
                .eq(Device::getStatus, 1));
        if(device == null) {
            return null;
        }

        //获取四向穿梭车线程
        ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
        ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
        if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
            return null;
        }

        return shuttleProtocol.getCurrentLocNo();
    }


}