Almost done - some problem with rotation
Finally done!
Optimize Rotation
Optimize Rotation Done
Optimize Translation
Optimize bool variable last_point_ok
Optimze Scale
Merge pull request #1 from wang-ps/Optimize-Transformation

Optimize transformation