added more comprehensive debug output, added dyn reconfigure param to enable/disable map covariance check upon init, added fix parameter to limit FoV to be considered (can be useful for wide FoV fisheye lenses)