最短路径Dijkstra算法原理及Matlab实现

图论的基础知识不再阐述。
最短路径算法主要有二

1. Dijkstra算法
2. Floyd算法

Dijkstra算法研究的是从初始点到其他每一结点的最短路径
而Floyd算法研究的是任意两结点之间的最短路径

以下图为例，首先介绍Dijstra的原理

红字为各结点的编号，蓝字为各结点之间的距离

1. 首先定义几个变量

   结点个数n；
   二维矩阵M（nxn），距离矩阵，连通的结点间即为距离，不连通的结点间为正无穷，和自己的距离为0；
   一维矩阵pb（1xn），若第i点已找到最短路径，则fp（i）=1，否则等于0，对于初始结点，fp=1；
   距离矩阵d（1xn），若第i点已找到最短路径，则的d（i）=最短距离，否则为0，初始结点d=0；
   上一结点矩阵path（1xn)，若第i点找到了最短路径，则path存放这一条最短路径的前一个结点，通过对每一点的回溯，可以找到最短路径。

2. 根据距离写出以下距离矩阵

   

3. 确定初始点为v1，则pb(1)=1;

   在图中，结点上，我们将已找到最短路径的点标为它的最短距离，（可以理解为v1点已找到最短路径，距离为0），未找到的其余点表为正无穷（即表示不连通）。
   
   在与v1连通的点中，即在矩阵m的第1行，寻找最小值，最小值所在列即确定的最短路径的结点，如同v2最短，pb（2）=1，d（2）=1，对于已找到最短路径的v2上一结点为v1，path（2）=1；
   
   接