Cleaned up comments a bit.
Added merge routine. Needs Eigen.