Add Dijkstra's algorithm on matrix

Author: baatochan

DirectedGraph.cpp

@@ -149,7 +149,81 @@ void DirectedGraph::loadRawDataToList(std::vector<int> rawData) {
 // private
 
 std::string DirectedGraph::dijkstrasAlgorithmOnMatrix(int beginVertex, int endVertex) {
-	throw "Algorytm jeszcze nie zaimplementowany!";
+	if (incidenceMatrix.size() == 0)
+		throw "Graf pusty!";
+
+	int numberOfVertices = incidenceMatrix[0].size();
+
+
+	if (beginVertex >= numberOfVertices || endVertex >= numberOfVertices)
+		throw "Poczatkowy lub koncowy wierzcholek nie istnieje!";
+
+	// create needed arrays and assign default values
+	vector<bool> visitedVertices;
+	vector<unsigned long> pathLength;
+	vector<int> previousVertex;
+	visitedVertices.assign(numberOfVertices, false);
+	pathLength.assign(numberOfVertices, ULONG_MAX);
+	previousVertex.assign(numberOfVertices, -1);
+
+	// assaing starting value
+	pathLength[beginVertex] = 0;
+	int currentVertex = beginVertex;
+	unsigned long shortestPath;
+	int shortestPathVertex;
+
+	// run main loop for numberOfVertices times (every vertex will be visisted)
+	for (int i = 0; i < numberOfVertices; i++) {
+		unsigned long currentLength = pathLength[currentVertex];
+
+		for (auto& row : incidenceMatrix) {
+			if (row[beginVertex] > 0) {
+				for (int j = 0; j < numberOfVertices; j++) {
+					if (row[j] < 0) {
+						if (pathLength[j] > currentLength + row[beginVertex]) {
+							pathLength[j] = currentLength + row[beginVertex];
+							previousVertex[j] = currentVertex;
+						}
+					}
+				}
+			}
+		}
+
+		visitedVertices[currentVertex] = true;
+
+		shortestPath = ULONG_MAX;
+		shortestPathVertex = -1;
+
+		for (int j = 0; j < numberOfVertices; j++) {
+			if (!visitedVertices[j]) {
+				if (pathLength[j] < shortestPath) {
+					shortestPath = pathLength[j];
+					shortestPathVertex = j;
+				}
+			}
+		}
+
+		if ((i != numberOfVertices - 1) && (shortestPathVertex == -1))
+			throw "Graf niespojny!";
+
+		currentVertex = shortestPathVertex;
+
+	}
+
+	string output;
+	output = "Najkrotsza droga z wierzch.: " + to_string(beginVertex) + " do wierzch.: " + to_string(endVertex) + " wynosi: " + to_string(pathLength[endVertex]) + ".\n";
+	output += "Prowadzi nastepujaca droga: ";
+
+	currentVertex = endVertex;
+
+	output += to_string(currentVertex);
+
+	while (currentVertex != beginVertex) {
+		currentVertex = previousVertex[currentVertex];
+		output +=  " <- " + to_string(currentVertex);
+	}
+
+	return output;
 }
 
 std::string DirectedGraph::dijkstrasAlgorithmOnList(int beginVertex, int endVertex) {