Fixed bug in A-star algorithm. Added path scoring visualization