A bug fix. The visibility in graph-based optimal policy controller was
computed form a position rounded to integer coordinates. The rounded
position sometimes fell into an obstacle.