Added the ability of displaying the computed path visually. Increasing the weight of the heuristic makes the resulting path have less turns in it (which is good for speed)