Started implementing the new method with provable qsd-ness properties.

This commit works up to building the KKT matrix.