Added multiple pathfinding options.  Fixed a lot of bugs.

Signed-off-by: Matt Hoover <the.one.eleven@gmail.com>