Add a common function called transformPointWithNormal

This is a simple but common function and has passed the unit test.
Ok, then I could update both functions.
By the way, it's so strange why this pull request cannot pass the Travis,
and I can't find clues in the output information. https://travis-ci.org/PointCloudLibrary/pcl/jobs/35188356