Online simultaneous localization and mapping with detection and tracking of moving objects: theory and results from a ground veh