15 lines
1016 B
Matlab
15 lines
1016 B
Matlab
nbNodes = 8;
|
|
|
|
visibilityGraph = NaN(nbNodes+2, nbNodes+2);
|
|
visibilityGraph(1,1) =0;visibilityGraph(1,2) =11;visibilityGraph(1,3) =10;
|
|
visibilityGraph(2,1) =11;visibilityGraph(2,3) =18;visibilityGraph(2,9) =11;
|
|
visibilityGraph(3,1) =10;visibilityGraph(3,2) =18;visibilityGraph(3,4) =11;visibilityGraph(3,5) =32;
|
|
visibilityGraph(4,3) =11;visibilityGraph(4,5) =22;visibilityGraph(4,8) =15;visibilityGraph(4,9) =18;
|
|
visibilityGraph(5,3) =32;visibilityGraph(5,4) =22;visibilityGraph(5,6) =11;visibilityGraph(5,8) =20;visibilityGraph(5,9) =37;
|
|
visibilityGraph(6,5) =11;visibilityGraph(6,7) =20;visibilityGraph(6,10) =10;
|
|
visibilityGraph(7,6) =20;visibilityGraph(7,8) =11;visibilityGraph(7,9) =31;visibilityGraph(7,10) =11;
|
|
visibilityGraph(8,4) =15;visibilityGraph(8,5) =20;visibilityGraph(8,7) =11;
|
|
visibilityGraph(9,2) =11;visibilityGraph(9,4) =18;visibilityGraph(9,5) =37;visibilityGraph(9,7) =31;
|
|
visibilityGraph(10,6) =10;visibilityGraph(10,7) =11;
|
|
|
|
[distanceToNode, parentOfNode] = dijkstra(nbNodes, visibilityGraph); |