move rigid body construction and geometric alignment to eigen

relates #695