extended kalman filter for frequent local and infrequent global sensor data fusion .
Mobile robot localization by tracking geometric beacons