Imin function

Helper function to substract matrix from identity matrix and take inverse.