Fast and Robust Multi-people Tracking from RGB-D Data for a Mobile Robot