New class rgbImage for visualization. Minor extensions for obstacle grids.