Adapted to the new nalgebra api + removed all copy/Copy.