Fixed blockcat, kron, vecNZ etc., #554
Cleaned up SDPSDQPInternal, #554