A dynamic 3D environmental model with real-time access functions for use in autonomous mobile robots