Add a common function called transformPointWithNormal

This is a simple but common function and has passed the unit test.
Unfortunately Travis became almost useless for us in the recent months. Compilation often fails not because of errors in code but because their machines can not fulfill memory/computational demands... So do not be intimidated by these red crosses.