benchmark_mock_kinect: refactor to be a little cleaner