Pre-allocation fixes

A few pre-allocation fixes. Mainly for node-to-node constraints.
More work is needed for node-to-face and face-to-face constraints.
The on-re-allocation error in PETSc is still off until the above-mentioned work is finished.