Fix for horrendously slow pathfinding in the driveway

This update replaces the pathfinding algorithm with a more efficient implementation which should have a much more reasonable worst-case runtime. This is most noticeable on the driveway screen in It's Flot. On my system, this takes the time required to compute the path from the bottom right to the top right of that screen from 20-30 seconds down to a few milliseconds.