Inverse rows and cols in eigen matrix, add debug point