图——寻路

package com.binglian.Graph;

import java.util.Stack;
import java.util.Vector;

//寻路
public class Path {

	private Graph G;	//图的引用
	private int s;		//起始点
	private boolean[] visited;		//记录dfs的过程节点是否被访问
	private int[] from;				//记录路劲，from[i]表示查找的路劲上i的上一个节点
	
	
	
	//图的深度优先遍历
	private void dfs(int v){
		visited[v]=true;
		for(int i:G.adj(v))
			if(!visited[i]){
				from[i]=v;
				dfs(i);
			}
	}
	
	
	//构造函数，寻路算法,寻找图Graph从s点到其他点的路径
	public Path(Graph graph,int s){
		
		//算法初始化
		G=graph;
		assert s >=0 && s<G.V();
		
		visited =new boolean[G.V()];
		from=new int[G.V()];
		for(int i=0;i<G.V();i++){
			visited[i]=false;
			from[i]=-1;
		}
		this.s=s;
		
		//寻路算法
		dfs(s);
	}

	//查询从s点到w点是否有路径
	boolean hasPath(int w){
		assert w>=0 && w<G.V();
		return visited[w];
	}
	
	//查询从s点到w点的路径，存放在vec中
	Vector<Integer> path(int w){
		
		assert hasPath(w);
		
		Stack<Integer> stack=new Stack<Integer>();
		//通过from数组逆向查找到从s到w的路径，存放到栈中
		int p=w;
		while(p !=-1){
			stack.push(p);//往栈顶添加元素
			p=from[p];
		}
		
		//从栈中依次取出元素,获得顺序的从s到w的路径
		Vector<Integer> res=new Vector<Integer>();
		while(!stack.empty())
			res.add(stack.pop());
		
		return res;
	}
	
	// 打印出从s点到w点的路径
    void showPath(int w){

        assert hasPath(w) ;

        Vector<Integer> vec = path(w);
        for( int i = 0 ; i < vec.size() ; i ++ ){
            System.out.print(vec.elementAt(i));
            if( i == vec.size() - 1 )
                System.out.println();
            else
                System.out.print(" -> ");
        }
    }
}