Modified test files to use generic test function
Fixed spelling of geo utils library in CMakelists
Fixed CMakeLists in manipulation_components_pr2 to include geo utils.
Changed the voxelize function we are using, to use the new one (VoxelizeMesh instead of voxelizeMesh)
Improving the test files in the collision checker to be generic. Added launch files to include the params for the different arms.