基于最短路径的深度遍历算法以及有站序控制的路径规划算法

 由于产品的需求,现要对一批又起始站的站点规划一条最短路径出来。需求大概就是下图的意思:

再查询了最短路径算法后,Dijkstra算法和Floyd算法 后,感觉不符合我的需求,然后就自己琢磨写一个算法出来。

package com.data1.map;

import java.util.ArrayList;
import java.util.HashMap;
import java.util.List;
import java.util.Map;

/**
 * @author :zoboy
 * @Description:
 * @ Date: Created in 2019-07-26 14:54
 */
public class ZJStationPath {
    private List<Node> tmpArr = new ArrayList<>();
    private List<Node[]> resultList = new ArrayList<>();
    private Map<String, Double> distanceMap = new HashMap<>();
    private List<Node> nodeList;
    private Node firstNode;

    static class Node {
        private String id;
        private List<String> flag;

        public List<String> getFlag() {
            return flag;
        }

        public void setFlag(List<String> flag) {
            this.flag = flag;
        }

        public String getId() {
            return id;
        }

        public void setId(String id) {
            this.id = id;
        }
    }

    ZJStationPath(List<Node> nodeList, Map<String, Double> distanceMap, Node firstNode) {
        this.nodeList = nodeList;
        this.distanceMap = distanceMap;
        this.firstNode = firstNode;
    }

    public Node[] getPath() {
        arrangement(nodeList.size(), nodeList);
        double min = 0.00;
        Node[] nodes = new Node[nodeList.size()];
        for (int i = 0; i < resultList.size(); i++) {
            double distance = print(i);
            if (min <= distance) {
                min = distance;
                nodes = resultList.get(i);
            }
        }
        return nodes;
    }

    public double print(int i) {
        double distance = 0.00;
        StringBuilder stringBuilder = new StringBuilder();
        for (int j = 0; j < resultList.get(i).length; j++) {
            if (j >= 1) {
                String key = resultList.get(i)[j - 1].getId() + "-" + resultList.get(i)[j].getId();
                distance += distanceMap.get(key);
            }
            stringBuilder.append(resultList.get(i)[j].getId() + ",");
        }
        stringBuilder.append("distance:" + distance);
        System.out.println(stringBuilder.toString());
        return distance;
    }

    public void covertData(List<Node> nodeList) {
        Node[] nodes = new Node[nodeList.size()];
        for (int i=0;i<nodeList.size();i++){
            nodes[i]=nodeList.get(i);
        }
        resultList.add(nodes);
    }

    public void arrangement(int k, List<Node> nodeList) {
        if (k == 1) {
            for (int i = 0; i < nodeList.size(); i++) {
                tmpArr.add(nodeList.get(i));
                System.out.println();
                for (Node node:tmpArr){
                    System.out.print(node.getId()+"->");
                }
                covertData(tmpArr);
                tmpArr.remove(nodeList.get(i));
            }
        } else if (k > 1) {
            for (int i = 0; i < nodeList.size(); i++) { //按顺序挑选一个元素
                Node node = nodeList.get(i);
                if(judeFirstStation() && !judeStationSeq(node,nodeList) ){
                    tmpArr.add(node); //添加选到的元素
                    List<Node> remainList = removeArrayElements(nodeList, tmpArr);
                    arrangement(k - 1, remainList); //没有取过的元素,继续挑选
                    tmpArr.remove(nodeList.get(i));
                }
            }
        } else {
            return;
        }
    }

    public Boolean judeFirstStation(){
        Boolean isFirstNode=true;
        if (firstNode != null && tmpArr!=null && tmpArr.size()>0) {
            if (!firstNode.getId().equals(tmpArr.get(0).getId())) {
                isFirstNode= false;
            }
        }
        return isFirstNode;
    }

    public Boolean judeStationSeq(Node currentNode, List<Node> nodeList) {
        List<String> flags = currentNode.getFlag();
        List<Node> nodeList1 = new ArrayList<>();
        nodeList1.add(currentNode);
        for (String flag : flags) {
            //从剩下的node中找是否当前node在剩下的所有node之前
            List<Node> remainList = removeArrayElements(nodeList, nodeList1);
            String outKey = flag.split("-")[0];
            int outSort = Integer.parseInt(flag.split("-")[1]);
            for (int i=0;i<remainList.size();i++) {
                Node nextNode=remainList.get(i);
                List<String> nextFlags = nextNode.getFlag();
                for (String nextflag : nextFlags) {
                    String innerKey = nextflag.split("-")[0];
                    if (outKey.equals(innerKey)) {
                        int innerSort = Integer.parseInt(nextflag.split("-")[1]);
                        if (outSort > innerSort) {
                            return true;
                        }
                        nodeList1.add(nextNode);
                    }
                }
            }
        }
        return false;
    }


    public List<Node> removeArrayElements(List<Node> nodeList, List<Node> tmpArr) {
        List<Node> remainList = new ArrayList<>(nodeList.size());
        for (int i = 0; i < nodeList.size(); i++) {
            boolean find = false;
            for (int j = 0; j < tmpArr.size(); j++) {
                if (nodeList.get(i).getId().equals(tmpArr.get(j).getId())) {
                    find = true;
                    break;
                }
            }
            if (!find) { //没有找到的元素保留下来
                remainList.add(nodeList.get(i));
            }
        }
        return remainList;
    }
}

这就算法的实现过程,下面附一个测试类:

package com.data1.map;

import java.util.ArrayList;
import java.util.HashMap;
import java.util.List;
import java.util.Map;

/**
 * @author :zoboy
 * @Description:
 * @ Date: Created in 2019-07-26 14:56
 */
public class Test1 {

    public static void main(String[] args) {
        long startTime=System.currentTimeMillis();
        List<ZJStationPath.Node> nodeList = init();
        Map<String,Double> distanceList = new HashMap<>();
        for(ZJStationPath.Node node1 :nodeList ){
            for(ZJStationPath.Node node2 :nodeList ){
                if(!node1.getId().equals(node2.getId())){
                    distanceList.put(node1.getId()+"-"+node2.getId(),Math.random()*10+1000);
                }
            }
        }
        ZJStationPath.Node firstNode = nodeList.get(0);
        ZJStationPath zjStationPath = new ZJStationPath(nodeList,distanceList,firstNode);
        ZJStationPath.Node [] nodes= zjStationPath.getPath();
        System.out.println(nodes.length+"个点的最短路径结果:");
        for (ZJStationPath.Node node:nodes){
            System.out.print(node.getId()+"->");
        }
        long endTime=System.currentTimeMillis();
        System.out.println("程序运行时间: "+(endTime - startTime)/1000+"s");
    }

    public static List<ZJStationPath.Node> init(){
        ZJStationPath.Node A = new ZJStationPath.Node();
        A.setId("A");
        List<String> flag = new ArrayList<>();
        flag.add("AB-1");
        flag.add("AC-1");
        flag.add("AD-1");
        A.setFlag(flag);
        ZJStationPath.Node B = new ZJStationPath.Node();
        B.setId("B");
        flag = new ArrayList<>();
        flag.add("AB-2");
        B.setFlag(flag);
        ZJStationPath.Node C = new ZJStationPath.Node();
        C.setId("C");
        flag = new ArrayList<>();
        flag.add("AC-2");
        C.setFlag(flag);
        ZJStationPath.Node D = new ZJStationPath.Node();
        D.setId("D");
        flag = new ArrayList<>();
        flag.add("AD-2");
        D.setFlag(flag);
        ZJStationPath.Node E = new ZJStationPath.Node();
        E.setId("E");
        flag = new ArrayList<>();
        flag.add("EF-1");
        E.setFlag(flag);
        ZJStationPath.Node F = new ZJStationPath.Node();
        F.setId("F");
        flag = new ArrayList<>();
        flag.add("EF-2");
        F.setFlag(flag);
        List<ZJStationPath.Node> nodeList = new ArrayList<>();
        nodeList.add(A);
        nodeList.add(B);
        nodeList.add(C);
        nodeList.add(E);
        nodeList.add(D);
        nodeList.add(F);
        return nodeList;
    }


}

下面是运行结果:

具体的实现过程或者想法请qq(418546333)或者微信(hi-zoboy)我

 

 

 

 

 

 

  • 3
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
移动机器人的路径规划可以分为两种,一种是传统的点到点的路径规划,另一种是完全遍历路径规划。点到点的路径规划是一种从起始点到终点的运动策略,它要求寻找一条从起点到终点的最优路径,通常通过使用算法(如A*算法)来确定最短路径或最优路径。而完全遍历路径规划则是指机器人尝试覆盖区域内的所有点,以达到完全遍历的目的。这种路径规划方法适用于需要机器人遍历整个区域的场景,比如清扫机器人或巡逻机器人等。<span class="em">1</span><span class="em">2</span> #### 引用[.reference_title] - *1* [扫地机器人路径规划算法.pdf](https://download.csdn.net/download/qq_43934844/87529205)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 50%"] - *2* [通过机器人情感展示向人类学习语言(计算机硕士论文英文参考资料).pdf](https://download.csdn.net/download/weixin_44609920/88240779)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 50%"] [ .reference_list ]

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值