Added support for identity matrices.
Added row-swap function.