Perception, Planning and Control for Mobile Robots