speedup the projection and even more when there is no distortion

twice faster in my benchmarks, enjoy. If you like it, we should add it to the RGBD module (and make it work with several types of inputs (float, double,uint16_t) ).