Ensured the destination is floored in findPathSync

Fixes bug #16 in my testing.

Caused the aStar to time out instead of finding the path unless
endRadius is increased.