Feature-Based Multi-Hypothesis Localization and Tracking for Mobile Robots using Geometric Constraints