Fixed crash. We weren't clearing the open and close list in case
of path not found.
Simplified code in _GeneratePath().
In cost calculation, take into account that a step isn't one pixel.