The codes are too long so I can\'t paste them here. It\'s implementation of A* algorithm (A star algorithm).
The codes are placed in here: https://github.com/STProgra