Switched to slower but more robust planning

Switched to slower but more robust planning algorithm, modified the grid
quality calculator to give better incentives