Fixed pathfinders by using the entity width and height in the calculations. Also moved some classes, cleaned some imports.
Now also using height in the pathfinder calculations.
Removed debug statement.
Merge branch 'sander'