I've written a simple Java implementation of Dijkstra's algorithm and A* search for path planning, along with a Matlab interface to the code. The Java planning code is much faster than the same thing ...