Fix buildsystem and tests

I have several fixes here to both the build system and unit tests.

Also I have fixes for pcl-1.7 related changes and pcl_ros changes.