Removed all copy/Copy + adapted to the new nalgebra api.