Messing around with 2D pathfinding.

Looks like I ended up finishing this.

Looking to update it now for possible MUC usage.

Started Mid 2013