powered by
Function to compute adjusted penalty when orthogonalizing
orthog_P(P, Z)
adjusted penalty matrix
matrix; original penalty matrix
matrix; constraint matrix