Before changing the openSet to contain node ids
After changing openSet
Added tests for A star algorithm