import from http://sourceforge.net/p/tum-ros-pkg/code/HEAD/tree/perception/people_detector_node/