clear all;
close all;
global M A B C eq k
ts=0.001;
T=2;
TimeSet=[0:ts:T];

c=15;
C=[c,1];
para=[c];

[t,x]=ode45('chap2_4eq',TimeSet,[0.50 0.50],[],para);
x1=x(:,1);
x2=x(:,2);

s=c*x(:,1)+x(:,2);

if M==2
   for kk=1:1:T/ts+1
		xk=[x1(kk);x2(kk)];
		sk(kk)=c*x1(kk)+x2(kk);
	   slaw(kk)=-eq*sign(sk(kk))-k*sk(kk);     %Exponential trending law
	   u(kk)=inv(C*B)*(-C*A*xk+slaw(kk));
   end
end

figure(1);
plot(x(:,1),x(:,2),'r',x(:,1),-c*x(:,1),'b');
xlabel('x1');ylabel('x2');
figure(2);
plot(t,x(:,1),'r');
xlabel('time(s)');ylabel('x1');
figure(3);
plot(t,x(:,2),'r');
xlabel('time(s)');ylabel('x2');
figure(4);
plot(t,s,'r');
xlabel('time(s)');ylabel('s');
if M==2
	figure(5);
	plot(t,u,'r');
	xlabel('time(s)');ylabel('u');
end