Finished the LU decomposition code