todense() for constraint Jacobian moved to final matrix