Implemneted A-star algorithm. Added an heuristic
function, modified comparator to check for f-value
instead of g-value. Modified Tuple to have f-value
where f = g + heuristic