Real-Time Localization and Obstacle Avoidance with Grid Maps