Bidirectional Works

Returns the shortest path.
Added the Sequential A* path to the display as well. It shows up as a
blue line. the Bidirectional A* is red