added lagrangian constraint for Q = qI, fixed output, fixed case when we will only have heterogeneous SNPs + either major or minor, but not both (divide by zero).