Minor fixes.
Added formulation which emulates hierarchical QP.