Obstacle contour polygon approximation and contour expansion