Fix missing +-1 offset in coordinate return of astar