Simplified swap_rows_mut method
Added function to create identity matrix. Added inverse method for matrix.