Fixed not wanting to swim up in water.
Small changes to the readme.
Finished up pathfinder to be used by entities.