Fixes #46 on indigo-devel

Tested with velodyne data on indigo on Ubuntu 14.04