Initialize matrices with identity matrix.

This closes issue #25.