Optimize A* Algorithm

[CoderAbhinav]

Issue with

1. Some test cases are resulting into SEGMENTATION FAULT
   one of them is below

1 2 3
7 4 0
6 8 5

1 2 3
8 0 4
7 6 5