PolygonalNavMap: Clamp target when target is inside obstacle