CalcUstarmatrix function

Calculate the U*matrix for a given Umatrix and Pmatrix.