MATLAB and C Programs - Digital Signal Processing: A Practitioner's Approach - page 151

delta_t=0.25;
k=0:N;t=k*delta_t;
x_0=10000;y_0=8000;
v_T=23;theta=120*(pi/180);
x_T=x_0+v_T*cos(theta)*t;
y_T=y_0+v_T*sin(theta)*t;
noise=0.003*randn(size(t));
beta_m=atan2((x_T-xw),(y_T-yw))+noise;
sum1=ones([4 4]); sum1=sum1*0; sum2=[0 0 0 0]';
for i=0:N
u=[cos(beta_m(i+1)) -sin(beta_m(i+1)) t(i+1)*cos(beta_m(i+1))
-t(i+1)*sin(beta)
yk=xw(i+1)*cos(beta_m(i+1))-yw(i+1)*sin(beta_m(i+1));
sum1=sum1 + u'*u;
sum2=sum2 + u'*yk;
end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
T=linspace(t(1), t(N+1),10);
X=inv(sum1)*sum2;
xhat_0=X(1);
yhat_0=X(2);
vhat=sqrt(X(3)*X(3)+X(4)*X(4));
xhat_T=xhat_0+vhat*cos(theta)*T;
yhat_T=yhat_0+vhat*sin(theta)*T;
subplot(221);
plot(xw/1000,yw/1000,x_T/1000,y_T/1000,xhat_T/1000,yhat_T/
1000,'.-');grid;
title('A'); xlabel(' Target & Watcher '); ylabel(' Km ')
subplot(222);plot(t,beta_m*180/pi);grid
title('B');xlabel('seconds');ylabel(' beta-m in deg ');
pause;
A.3.15 Program f 3_6_5
%Digital Signal Processing:A Practitioner's Approach
%Dr.Kaluri Venkata Ranga Rao, [e-mail]
%Generates figure 3.32
% generate a linear reggression graph
clear;close;
t=linspace(0,2*pi,100);
x=cos(t); y=x+0.1*randn(size(t));
subplot(211);
plot(t,x,t,y,'o');grid;