jiefangcheng1.m

计算不等式约束情况下二次规划问题

function [p,te]=JieFangCheng1(A,G,D,X,W)
 %解二次规划子问题方程，求调整步长P和Lagrange乘子，输出步长p和Lagrange乘子te
   gk=G*X+D;
   m=size(A,1);mg=size(G,2);
   nlw=size(W,2);
   k=0;
   for i=1:m
       if ((W(1,i)~=0))
          k=k+1;
          Aa(:,k)=A(i,:)';
       end
   end
   if(k~=0)  %解方程，有约束时的方程。
     Kk=[G,-Aa;-Aa',zeros(k,k)];
     Bb=[-gk;zeros(k,1)];
     Jie=inv(Kk)*Bb;
     p=Jie(1:mg,1);
     te=Jie(mg+1:mg+k,1);
   else  %解方程，无约束时的方程。
       Kk=G;
       Bb=-gk;
       Jie=inv(Kk)*Bb;
       p=Jie;
       te=[];
   end