Add a common function called transformPointWithNormal

This is a simple but common function and has passed the unit test.
Can't we use matrix multiplications here? I.e. obtain xyz values as a vector via `getVector3fMap()` and multiply with the transform matrix? The same for normals.