add c++ measure align

and have it called from python
angle axis transform rotate is now done in c++