#path similarity

Junjie

2024-12-11 81188cbe3d51e951ce4c853edb886272a4eb51a3

 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java

@@ -109,14 +109,6 @@
            return false;
        }

        Double similarityRef = 0.9D;
        Dict similarityRefDict = dictService.getOne(new LambdaQueryWrapper<Dict>()
                .eq(Dict::getFlag, "similarityRef")
                .eq(Dict::getStatus, 1));
        if (similarityRefDict != null) {
            similarityRef = Double.parseDouble(similarityRefDict.getValue());
        }

        ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
        assignCommand.setShuttleNo(deviceNo);
        assignCommand.setTaskNo(motion.getTaskNo());
@@ -130,10 +122,6 @@

        LiftThread liftThread = null;
        LiftProtocol liftProtocol = null;
        String movePath = null;
        List<NavigateNode> originPath = null;
        List<NavigateNode> finalPath = null;
        Double similarity = null;

        switch (Objects.requireNonNull(MotionCtgType.get(motion.getMotionCtgEl()))){
            case SHUTTLE_MOVE:
@@ -146,15 +134,8 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.NORMAL.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.SHUTTLE_MOVE;

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                break;
@@ -168,15 +149,8 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.TRANSPORT;

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                if (motion.getReleaseLift() == 2) {//执行中释放提升机
@@ -220,15 +194,8 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.TRANSPORT_TO_CONVEYOR;

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                break;
@@ -236,15 +203,8 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.MOVE_PALLET_LIFT;

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                shuttleCommands.add(0, shuttleThread.getLiftCommand(motion.getTaskNo(), true));
@@ -253,15 +213,8 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.MOVE_PALLET_DOWN;

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                shuttleCommands.add(shuttleCommands.size(), shuttleThread.getLiftCommand(motion.getTaskNo(), false));
@@ -373,15 +326,8 @@
                String shuttleFromLiftStandbyLoc = shuttleDispatcher.searchAvailableLocNo(Integer.valueOf(shuttleDevice.getDeviceNo()), shuttleDevice.getHostId(), shuttleThread.getStatus().getCurrentLocNo(), standbyLocs);
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), shuttleFromLiftStandbyLoc, NavigationMapType.NORMAL.id, assignCommand, shuttleThread);

                movePath = motion.getMovePath();
                if (!Cools.isEmpty(movePath)) {
                    originPath = JSON.parseArray(movePath, NavigateNode.class);
                    finalPath = assignCommand.getNodes();
                    similarity = navigateUtils.similarityPath(originPath, finalPath);
                    if(similarity <= similarityRef) {
                        News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
                if (!checkSimilarityPath(motion, assignCommand)) {
                        return false;
                    }
                }

                //更新动作可用待机位
@@ -701,5 +647,35 @@
        return commands;
    }

    private boolean checkSimilarityPath(Motion motion, ShuttleAssignCommand assignCommand) {
        String movePath = motion.getMovePath();
        if (Cools.isEmpty(movePath)) {
            return false;
        }

        Double similarityRef = 0.9D;
        Dict similarityRefDict = dictService.getOne(new LambdaQueryWrapper<Dict>()
                .eq(Dict::getFlag, "similarityRef")
                .eq(Dict::getStatus, 1));
        if (similarityRefDict != null) {
            similarityRef = Double.parseDouble(similarityRefDict.getValue());
        }

        List<NavigateNode> originPath = JSON.parseArray(movePath, NavigateNode.class);
        List<NavigateNode> finalPath = assignCommand.getNodes();

        if (finalPath == null) {
            return false;
        }

        Double similarity = navigateUtils.similarityPath(originPath, finalPath);
        if (similarity <= similarityRef) {
            News.error("{} dash {} path similarity mismatch!", motion.getOrigin(), motion.getTarget());
            return false;
        }

        return true;
    }


}