Real-time RGB-D based people detection and tracking for mobile robots and head-worn cameras
free space computation using stochastic occupancy grids and dynamic programming .