Working on implementing Cormen et al version of LUP decomposition