BFS - 查找并打印最短路径

我正在尝试实现 BFS 算法，该算法可找到所有路径均未加权的最短路径。我还希望打印出导出最短路径的节点 ([x,y])。但是，我对这个算法很陌生，想知道这里是否有人可以帮助我完成代码。

代码如下：

def findpath(matrix,src,dest):
    """
    input: 
        src = Point(0,0)
        dest = Point(9,4)
    """

Point(0,0) 包含源节点的 x 和 y 值（行和列），而 Point(9,4) 包含目标节点的 x 和 y 值（行和列）。