NF: added function for rigid registration of bundles
TEST: testing rigid registration and matrix composition