for t=1:k
constraints=[constraints, heelstrike(t)==(2*q(2*t-1)-q(2*t)<=0)]; %When current 2*teta <= phi
constraints=[constraints, swingforward(t)==(q(2*t)<=0.075)]; %AND phi <=0.075
constraints=[constraints, iff(heelstrike(t) && swingforward(t),ddq(2*t-1:2*t)==Hinv*(u(2*t-1:2*t)+ext(2*t-1:2*t)-Gm-C))];
constraints=[constraints, dq(2*(t+1)-1:2*(t+1))==dq(2*t-1:2*t)+ddq(2*t-1:2*t)*dt*t];
constraints=[constraints, q(2*(t+1)-1:2*(t+1))==q(2*t-1:2*t)+dq(2*(t+1)-1:2*(t+1))*dt*t];
end
The following error occurred converting from sdpvar to logical:Conversion to logical from sdpvar is not possible.
Error in linearized (line 50) constraints=[constraints, implies(binary(heelstrike(t) && swingforward(t)),ddq(2*t-1:2*t)==Hinv*(u(2*t-1:2*t)+ext(2*t-1:2*t)-Gm-C))];
iff(x<=0,something) +iff(x>=0,something else)
binvar case1 case2
implies(case1,[x<=0, something])+implies(case2,[x>=0, somethingelse])+sum(case1+case2==1)