Rigid trans

Tools for 2/3D rigid transformations