clear;
clc;
filepath='F:\实验记录\20190117\T3-A60-P0.05-02\';%文件夹的路径
for i=1584:1:1910% 可控制读入的文件的个数
fid=load([filepath 'T3-A60-P0.050zhongxin' num2str(i) '.dat']);
%此处为处理过程
k=(i-1583)/1;% 注意修改数字
zhxx(k)=fid(:,1)*1.3889;% 由于在PCC中测量得1.389mm/pix
zhxy(k)=fid(:,2)*1.3889;
nowdeg(k)=fid(:,3);
end
% area1=10*ones(length(zhxx),1);
% scatter(zhxx,-zhxy,area1,'.','red');
% 将入水点设为原点
chux=zhxx(1);
chuy=zhxy(1);
for i=1:length(zhxx)
zhxx(i)=zhxx(i)-chux;
zhxy(i)=zhxy(i)-chuy;
end
figure;
plot(zhxx,-zhxy,'red');
axis equal;
xlabel('x/mm','fontsize',10);
ylabel('y/mm','fontsize',10);
title('模型运动轨迹');
saveas(gcf,[filepath 'T3-A60-P0.050模型运动轨迹' '.png']);
fid = fopen([filepath 'T3-A60-P0.050模型运动轨迹' '.txt'],'wt');
fprintf(fid,' X轴(mm) Y轴(mm) \n');
for n = 1:length(zhxx)
fprintf(fid,'%10.4f %10.4f \n',zhxx(n),zhxy(n));
end
fclose(fid);
% 求模型的速度
for i=1:length(zhxx)-2
a1x=zhxx(i);
a1y=zhxy(i);
a2x=zhxx(i+2);
a2y=zhxy(i+2);
dis=sqrt((a1x-a2x)^2 + (a1y-a2y)^2);
v(i)=dis/0.001;% 速度单位mm/s
mv(i)=v(i)/1000;% 速度单位m/s
end
for i=1:length(mv)
tim(i)=i*0.5;%每帧间隔0.5ms
end
for k=1:length(nowdeg)
tim1(k)=k*0.5;%每帧间隔0.5ms
end
% 速度随时间的变化
figure;
plot(tim,mv,'r.');
xlabel('T(ms)','fontsize',10);
ylabel('V(m/s)','fontsize',10);
title('速度随时间的变化');
fid = fopen([filepath 'T3-A60-P0.050模型速度随时间的变化' '.txt'],'wt');
fprintf(fid,' T(ms) V(m/s) \n');
for n = 1:length(tim)
fprintf(fid,'%10.4f %10.4f \n',tim(n),mv(n));
end
fclose(fid);
hold on
p = polyfit(tim,mv,1);
mv1=polyval(p,tim);
plot(tim,mv1);
saveas(gcf,[filepath 'T3-A60-P0.050模型速度随时间的变化' '.png']);
% 角度随时间的变化
figure;
plot(tim1,nowdeg,'.');
xlabel('T(ms)','fontsize',10);
ylabel('theta(deg)','fontsize',10);
title('角度随时间的变化');
fid = fopen([filepath 'T3-A60-P0.050模型角度随时间的变化' '.txt'],'wt');
fprintf(fid,' T(ms) theta(deg) \n');
for n = 1:length(tim)
fprintf(fid,'%10.4f %10.4f \n',tim1(n),nowdeg(n));
end
fclose(fid);
hold on
p = polyfit(tim1,nowdeg,2);
nowdeg1=polyval(p,tim1);
plot(tim1,nowdeg1,'r');
saveas(gcf,[filepath 'T3-A60-P0.050模型角度随时间的变化' '.png']);
for i=1:length(nowdeg)-2
a1x=nowdeg(i);
a2x=nowdeg(i+2);
dega(i)=(a2x-a1x)/0.001;% 角速度单位deg/s
end
for j=1:length(dega)
tim2(j)=j*0.5;%每帧间隔0.5ms
end
% 角速度随时间的变化
figure;
plot(tim2,dega,'.');
xlabel('T(ms)','fontsize',10);
ylabel('w(deg/s)','fontsize',10);
title('角速度随时间的变化');
fid = fopen([filepath 'T3-A60-P0.050模型角速度随时间的变化' '.txt'],'wt');
fprintf(fid,' T(ms) w(deg/s) \n');
for n = 1:length(tim)
fprintf(fid,'%10.4f %10.4f \n',tim2(n),dega(n));
end
fclose(fid);
hold on
p = polyfit(tim2,dega,1);
dega1=polyval(p,tim2);
plot(tim2,dega1,'r');
saveas(gcf,[filepath 'T3-A60-P0.050模型角速度随时间的变化' '.png']);