迷宫的路径问题

在程序设计中，关于迷宫的问题，有书中提到迷宫的最短路径问题，并给出了相关C代码，思考良久，利用宽度优先算法怎么可以得到最短路径，百思不得解，将C代码改写java代码后经测试发现，的确不能得到最短路径，充其量也只能得到其中的一条路径。现将代码献上。

public class ShortestPath {

    private static char[][] path = new char[][]{

        {'#','S','#','#', '#', '#', '#', '#', '.','#'},
        {'.','.','.','.', '.', '.', '#', '.', '.','#'},
        {'.','#','.','#', '#', '.', '#', '#', '.','#'},
        {'.','#','.','.', '.', '.', '.', '.', '.','.'},
        {'#','#','.','#', '#', '.', '#', '#', '#','#'},
        {'.','.','.','.', '#', '.', '.', '.', '.','#'},
        {'.','#','.','#', '#', '#', '#', '#', '.','#'},
        {'.','.','.','.', '#', '.', '.', '.', '.','.'},
        {'.','#','.','#', '#', '.', '#', '#', '#','.'},
        {'.','.','.','.', '.', '.', '.', '.', 'G','#'}
    };

    private static int sx, sy;
    private static int gx = 9, gy = 8;
    static int dx[] = {1,0,-1,0}; static int dy[] = {0,1,0,-1};
    private static int d[][] = new int[path.length][path[0].length];

    public static void main(String argsp[]) {

        int res = bfs();
        for(int i = 0 ; i< d.length ; i++) {

            System.out.println(Arrays.toString(d[i]));
        }
        System.out.println(res);
    }

    private static int bfs() {

        sx = 0; sy = 1;
        for(int i= 0; i < path.length; i++) {

            for(int j = 0; j < path[0].length; j++) {

                d[i][j] = 0;
            }
        }
        d[sx][sy] = 1;
        Deque<Point> queue = new ArrayDeque<>();
        queue.push(new Point(sx,sy));
        while(!queue.isEmpty()) {

            Point p = queue.pop();
            if(p.getX() == gx && p.getY() == gy) {

                break;
            }

            for(int i = 0; i<4; i++) {

                int nx = p.getX() + dx[i], ny = p.getY() + dy[i];
                if(0 <= nx && nx < path.length && 0 <= ny && ny < path[0].length && path[nx][ny] != '#' && d[nx][ny] == 0) {

                    queue.push(new Point(nx, ny));
                    d[nx][ny] = d[p.getX()][p.getY()] + 1;
                }
            }

        }
        return d[gx][gy];

    }

    static class Point{

        private int x;
        private int y;

        public Point(int x, int y) {
            super();
            this.x = x;
            this.y = y;
        }
        public int getX() {
            return x;
        }
        public void setX(int x) {
            this.x = x;
        }
        public int getY() {
            return y;
        }
        public void setY(int y) {
            this.y = y;
        }
        @Override
        public String toString() {
            return "Point [x=" + x + ", y=" + y + "]";
        }
    }
}