Add initial astar implementation.
Fix syntax errors.
A star works for maze 1.