[ENHANCEMENT] : Algorithm Enhancements and Refactoring: Dijkstra, A* Search, and K-Means Clustering #5880