Add a common function called transformPointWithNormal

This is a simple but common function and has passed the unit test.