Matrix is a project mainly written in C++, it's free.

modified version of dijkstra's algorithm, provides a 'reasonable' path from the start to the end