#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,12 +134,7 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.NORMAL.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.SHUTTLE_MOVE;

                movePath = motion.getMovePath();
                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;
                }

@@ -166,12 +149,7 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.TRANSPORT;

                movePath = motion.getMovePath();
                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;
                }

@@ -216,12 +194,7 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.TRANSPORT_TO_CONVEYOR;

                movePath = motion.getMovePath();
                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;
                }

@@ -230,12 +203,7 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.MOVE_PALLET_LIFT;

                movePath = motion.getMovePath();
                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;
                }

@@ -245,12 +213,7 @@
                shuttleCommands = this.shuttleAssignCommand(motion.getOrigin(), motion.getTarget(), NavigationMapType.DFX.id, assignCommand, shuttleThread);
                shuttleTaskModeType = ShuttleTaskModeType.MOVE_PALLET_DOWN;

                movePath = motion.getMovePath();
                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;
                }

@@ -363,12 +326,7 @@
                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();
                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;
                }

@@ -689,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;
    }


}