Commented out unused variables.
Added separate constraint matrix for stability terms in hopes that a different condense function would give different results.
Added lots of conditionals for stability terms. Also added in conditionals so that if those contributions are added, it is only when the assemble flag is on.
Added conditional so that the Dirichlet bc for the stability terms is only added for the state. It is zero in other modes.