Add a fcl to eigen for matrix

To stay logical; this function should be there for rotation matrices