Fixed pathfinders by using the entity width and height in the calculations. Also moved some classes, cleaned some imports.