大唐直轴（三十九个点的）

qq_43519163

已于 2023-09-15 17:28:29 修改

阅读量32

点赞数

文章标签：算法

于 2023-09-15 15:19:09 首次发布

本文链接：https://blog.csdn.net/qq_43519163/article/details/132903508

版权

%%
x1=HN.(2);
y1=HN.(1);

x2=HN.(4);
y2=HN.(3);

x3=HN.(6);
y3=HN.(5);
% %将上面的语句改为循环
% x=zeros(333,3);
% for i=2:3:8
% x()
% %拟合方式的选择
% cftool(x1,y1);
%
%%
% 第1个点
[a_1,~]=createFits(x1,y1,x2,y2);
a_1{5,1}.a0;
FUNCTION_1=a_1{5,1}.a0 + a_1{5,1}.a1*cos(x3*a_1{5,1}.w)+ a_1{5,1}.b1*sin(x3*a_1{5,1}.w) +a_1{5,1}.a2*cos(2*x3*a_1{5,1}.w) + a_1{5,1}.b2*sin(2*x3*a_1{5,1}.w);
[pks_po_1,locs_po_1]=findpeaks(FUNCTION_1);
[pks_pa_1,locs_pa_1]=findpeaks(-FUNCTION_1);
% plot(FUNCTION_18);
% hold on
% plot(locs_po_18,pks_po_18,'o');
% [pks_18,~]=findpeaks(-FUNCTION_18);
% plot(locs_pa_18,-pks_18,'*');
% hold on;
if length(pks_po_1)>1
[pks_po_1,weizhi_max_1]=max(pks_po_1);
locs_po_1=locs_po_1(weizhi_max_1);
end
if length(pks_pa_1)>1
[pks_pa_1,weizhi_min_1]=min(-pks_pa_1);
locs_pa_1=locs_pa_1(weizhi_min_1);
else
pks_pa_1=-pks_pa_1;
end
disp('第1的相角与极大值')
disp(locs_po_1),disp(pks_po_1);
disp('第1点的相角与极小值')
disp(locs_pa_1),disp(pks_pa_1);

%第二个点
%第二组数据很平，这时候就随便取一个当作最小跳动量
[a_2,b_2]=createFits(x2, y2,x3,y3);
a_2{5,1}.a0;
FUNCTION_2=a_2{5,1}.a0 + a_2{5,1}.a1*cos(x2*a_2{5,1}.w)+ a_2{5,1}.b1*sin(x2*a_2{5,1}.w) +a_2{5,1}.a2*cos(2*x2*a_2{5,1}.w) + a_2{5,1}.b2*sin(2*x2*a_2{5,1}.w);
[pks_po_2,locs_po_2]=findpeaks(FUNCTION_2);
[pks_pa_2,locs_pa_2]=findpeaks(-FUNCTION_2);
% plot(FUNCTION_2);
% hold on;
% plot(locs_po_2,pks_po_2,'o');
% [pks_2,locs_2]=findpeaks(-FUNCTION_2);
% plot(locs_pa_2,-pks_2,'*');
% hold on;
if length(pks_po_2)>1
[pks_po_2,weizhi_max_2]=max(pks_po_2);
locs_po_2=locs_po_2(weizhi_max_2);
end
if length(pks_pa_2)>1
[pks_pa_2,weizhi_min_2]=min(-pks_pa_2);
locs_pa_2=locs_pa_2(weizhi_min_2);
else
pks_pa_2=-pks_pa_2;
end
disp('第二点的相角与极大值')
disp(locs_po_2),disp(pks_po_2)
disp('第二点的相角与极小值')
disp(locs_pa_2),disp(pks_pa_2)

%第三个点
[a_3,b_3]=createFits(x3, y3,x1,y1);
a_3{5,1}.a0;
FUNCTION_3=a_3{5,1}.a0 + a_3{5,1}.a1*cos(x3*a_3{5,1}.w)+ a_3{5,1}.b1*sin(x3*a_3{5,1}.w) +a_3{5,1}.a2*cos(2*x3*a_3{5,1}.w) + a_3{5,1}.b2*sin(2*x3*a_3{5,1}.w);
[pks_po_3,locs_po_3]=findpeaks(FUNCTION_3);
[pks_pa_3,locs_pa_3]=findpeaks(-FUNCTION_3);
% plot(FUNCTION_3);
% hold on
% plot(locs_po_3,pks_po_3,'o');
% [pks_2,locs_2]=findpeaks(-FUNCTION_3);
% plot(locs_pa_3,-pks_2,'*');
% hold on;
if length(pks_po_3)>1
[pks_po_3,weizhi_max_3]=max(pks_po_3);
locs_po_3=locs_po_3(weizhi_max_3);
else
pks_po_3=pks_po_3;
end
if length(pks_pa_3)>1
[pks_pa_3,weizhi_min_3]=min(-pks_pa_3);
locs_pa_3=locs_pa_3(weizhi_min_3);
else
pks_pa_3=-pks_pa_3;
end
disp('第三点的相角与极大值')
disp(locs_po_3),disp(pks_po_3);
disp('第三点的相角与极小值')
disp(locs_pa_3),disp(pks_pa_3);
%
% % %第四个点
% % [a_4,b_4]=createFits(x4, y4,x5,y5);
% % a_4{5,1}.a0;
% % FUNCTION_4=a_4{5,1}.a0 + a_4{5,1}.a1*cos(x3*a_4{5,1}.w)+ a_4{5,1}.b1*sin(x3*a_4{5,1}.w) +a_4{5,1}.a2*cos(2*x3*a_4{5,1}.w) + a_4{5,1}.b2*sin(2*x3*a_4{5,1}.w);
% % [pks_po_4,locs_po_4]=findpeaks(FUNCTION_3);
% % [pks_pa_4,locs_pa_4]=findpeaks(-FUNCTION_4);
% % % plot(FUNCTION_4);
% % % hold on
% % % plot(locs_po_4,pks_po_4,'o');
% % % [pks_4,locs_4]=findpeaks(-FUNCTION_4);
% % % plot(locs_pa_4,-pks_4,'*');
% % % hold on;
% % if length(pks_po_4)>1
% % [pks_po_4,weizhi_max_4]=max(pks_po_4);
% % locs_po_4=locs_po_4(weizhi_max_4);
% % else
% % pks_po_4=pks_po_4;
% % end
% % if length(pks_pa_4)>1
% % [pks_pa_4,weizhi_min_4]=min(-pks_pa_4);
% % locs_pa_4=locs_pa_4(weizhi_min_4);
% % else
% % pks_pa_4=-pks_pa_4;
% % end
% % disp('第四点的相角与极大值')
% % disp(locs_po_4),disp(pks_po_4);
% % disp('第四点的相角与极小值')
% % disp(locs_pa_4),disp(pks_pa_4);
% %
% % %第五个点
% % [a_5,b_5]=createFits(x5, y5,x6,y6);
% % a_5{5,1}.a0;
% % FUNCTION_5=a_5{5,1}.a0 + a_5{5,1}.a1*cos(x3*a_5{5,1}.w)+ a_5{5,1}.b1*sin(x3*a_5{5,1}.w) +a_5{5,1}.a2*cos(2*x3*a_5{5,1}.w) + a_5{5,1}.b2*sin(2*x3*a_5{5,1}.w);
% % [pks_po_5,locs_po_5]=findpeaks(FUNCTION_5);
% % [pks_pa_5,locs_pa_5]=findpeaks(-FUNCTION_5);
% % % plot(FUNCTION_5);
% % % hold on
% % % plot(locs_po_5,pks_po_5,'o');
% % % [pks_5,locs_5]=findpeaks(-FUNCTION_5);
% % % plot(locs_pa_5,-pks_5,'*');
% % % hold on;
% % if length(pks_po_5)>1
% % [pks_po_5,weizhi_max_5]=max(pks_po_5);
% % locs_po_5=locs_po_5(weizhi_max_5);
% % else
% % pks_po_5=pks_po_5;
% % end
% % if length(pks_pa_5)>1
% % [pks_pa_5,weizhi_min_5]=min(-pks_pa_5);
% % locs_pa_5=locs_pa_5(weizhi_min_5);
% % else
% % pks_pa_5=-pks_pa_5;
% % end
% % disp('第五点的相角与极大值')
% % disp(locs_po_5),disp(pks_po_5);
% % disp('第五点的相角与极小值')
% % disp(locs_pa_5),disp(pks_pa_5);
% %
% % %第6个点
% % [a_6,b_6]=createFits(x6, y6,x7,y7);
% % a_6{5,1}.a0;
% % FUNCTION_6=a_6{5,1}.a0 + a_6{5,1}.a1*cos(x3*a_6{5,1}.w)+ a_6{5,1}.b1*sin(x3*a_6{5,1}.w) +a_6{5,1}.a2*cos(2*x3*a_6{5,1}.w) + a_6{5,1}.b2*sin(2*x3*a_6{5,1}.w);
% % [pks_po_6,locs_po_6]=findpeaks(FUNCTION_6);
% % [pks_pa_6,locs_pa_6]=findpeaks(-FUNCTION_6);
% % % plot(FUNCTION_6);
% % % hold on
% % % plot(locs_po_6,pks_po_6,'o');
% % % [pks_6,locs_6]=findpeaks(-FUNCTION_6);
% % % plot(locs_pa_6,-pks_6,'*');
% % % hold on;
% % if length(pks_po_6)>1
% % [pks_po_6,weizhi_max_6]=max(pks_po_6);
% % locs_po_6=locs_po_6(weizhi_max_6);
% % else
% % pks_po_6=pks_po_6;
% % end
% % if length(pks_pa_6)>1
% % [pks_pa_6,weizhi_min_6]=min(-pks_pa_6);
% % locs_pa_6=locs_pa_6(weizhi_min_6);
% % else
% % pks_pa_6=-pks_pa_6;
% % end
% % disp('第6点的相角与极大值')
% % disp(locs_po_6),disp(pks_po_6);
% % disp('第6点的相角与极小值')
% % disp(locs_pa_6),disp(pks_pa_6);
% %
% % %第7个点
% % [a_7,b_7]=createFits(x7,y7,x8,y8);
% % a_7{5,1}.a0;
% % FUNCTION_7=a_7{5,1}.a0 + a_7{5,1}.a1*cos(x3*a_7{5,1}.w)+ a_7{5,1}.b1*sin(x3*a_7{5,1}.w) +a_7{5,1}.a2*cos(2*x3*a_7{5,1}.w) + a_7{5,1}.b2*sin(2*x3*a_7{5,1}.w);
% % [pks_po_7,locs_po_7]=findpeaks(FUNCTION_7);
% % [pks_pa_7,locs_pa_7]=findpeaks(-FUNCTION_7);
% % % plot(FUNCTION_7);
% % % hold on
% % % plot(locs_po_7,pks_po_7,'o');
% % % [pks_7,locs_7]=findpeaks(-FUNCTION_7);
% % % plot(locs_pa_7,-pks_7,'*');
% % % hold on;
% % if length(pks_po_7)>1
% % [pks_po_7,weizhi_max_7]=max(pks_po_7);
% % locs_po_7=locs_po_7(weizhi_max_7);
% % else
% % pks_po_7=pks_po_7;
% % end
% % if length(pks_pa_7)>1
% % [pks_pa_7,weizhi_min_7]=min(-pks_pa_7);
% % locs_pa_7=locs_pa_7(weizhi_min_7);
% % else
% % pks_pa_7=-pks_pa_7;
% % end
% % disp('第7点的相角与极大值')
% % disp(locs_po_7),disp(pks_po_7);
% % disp('第7点的相角与极小值')
% % disp(locs_pa_7),disp(pks_pa_7);
% %
% % %第8个点
% % [a_8,b_8]=createFits(x8,y8,x9,y9);
% % a_8{5,1}.a0;
% % FUNCTION_8=a_8{5,1}.a0 + a_8{5,1}.a1*cos(x3*a_8{5,1}.w)+ a_8{5,1}.b1*sin(x3*a_8{5,1}.w) +a_8{5,1}.a2*cos(2*x3*a_8{5,1}.w) + a_8{5,1}.b2*sin(2*x3*a_8{5,1}.w);
% % [pks_po_8,locs_po_8]=findpeaks(FUNCTION_8);
% % [pks_pa_8,locs_pa_8]=findpeaks(-FUNCTION_8);
% % % plot(FUNCTION_8);
% % % hold on
% % % plot(locs_po_8,pks_po_8,'o');
% % % [pks_8,locs_8]=findpeaks(-FUNCTION_8);
% % % plot(locs_pa_8,-pks_8,'*');
% % % hold on;
% % if length(pks_po_8)>1
% % [pks_po_8,weizhi_max_8]=max(pks_po_8);
% % locs_po_8=locs_po_8(weizhi_max_8);
% % else
% % pks_po_8=pks_po_8;
% % end
% % if length(pks_pa_8)>1
% % [pks_pa_8,weizhi_min_8]=min(-pks_pa_8);
% % locs_pa_8=locs_pa_8(weizhi_min_8);
% % else
% % pks_pa_8=-pks_pa_8;
% % end
% % disp('第8点的相角与极大值')
% % disp(locs_po_8),disp(pks_po_8);
% % disp('第8点的相角与极小值')
% % disp(locs_pa_8),disp(pks_pa_8);
% %
% % %第9个点
% % [a_9,b_9]=createFits(x9,y9,x10,y10);
% % a_9{5,1}.a0;
% % FUNCTION_9=a_9{5,1}.a0 + a_9{5,1}.a1*cos(x3*a_9{5,1}.w)+ a_9{5,1}.b1*sin(x3*a_9{5,1}.w) +a_9{5,1}.a2*cos(2*x3*a_9{5,1}.w) + a_9{5,1}.b2*sin(2*x3*a_9{5,1}.w);
% % [pks_po_9,locs_po_9]=findpeaks(FUNCTION_9);
% % [pks_pa_9,locs_pa_9]=findpeaks(-FUNCTION_9);
% % % plot(FUNCTION_9);
% % % hold on
% % % plot(locs_po_9,pks_po_9,'o');
% % % [pks_9,locs_9]=findpeaks(-FUNCTION_9);
% % % plot(locs_pa_9,-pks_9,'*');
% % % hold on;
% % if length(pks_po_9)>1
% % [pks_po_9,weizhi_max_9]=max(pks_po_9);
% % locs_po_9=locs_po_9(weizhi_max_9);
% % else
% % pks_po_9=pks_po_9;
% % end
% % if length(pks_pa_9)>1
% % [pks_pa_9,weizhi_min_9]=min(-pks_pa_9);
% % locs_pa_9=locs_pa_9(weizhi_min_9);
% % else
% % pks_pa_9=-pks_pa_9;
% % end
% % disp('第9点的相角与极大值')
% % disp(locs_po_9),disp(pks_po_9);
% % disp('第9点的相角与极小值')
% % disp(locs_pa_9),disp(pks_pa_9);
% %
% % %第10个点
% % [a_10,b_10]=createFits(x10,y10,x11,y11);
% % a_10{5,1}.a0;
% % FUNCTION_10=a_10{5,1}.a0 + a_10{5,1}.a1*cos(x3*a_10{5,1}.w)+ a_10{5,1}.b1*sin(x3*a_10{5,1}.w) +a_10{5,1}.a2*cos(2*x3*a_10{5,1}.w) + a_10{5,1}.b2*sin(2*x3*a_10{5,1}.w);
% % [pks_po_10,locs_po_10]=findpeaks(FUNCTION_10);
% % [pks_pa_10,locs_pa_10]=findpeaks(-FUNCTION_10);
% % % plot(FUNCTION_10);
% % % hold on
% % % plot(locs_po_10,pks_po_10,'o');
% % % [pks_10,locs_10]=findpeaks(-FUNCTION_10);
% % % plot(locs_pa_10,-pks_10,'*');
% % % hold on;
% % if length(pks_po_10)>1
% % [pks_po_10,weizhi_max_10]=max(pks_po_10);
% % locs_po_10=locs_po_10(weizhi_max_10);
% % end
% % if length(pks_pa_10)>1
% % [pks_pa_10,weizhi_min_10]=min(-pks_pa_10);
% % locs_pa_10=locs_pa_10(weizhi_min_10);
% % else
% % pks_pa_10=-pks_pa_10;
% % end
% % disp('第10点的相角与极大值')
% % disp(locs_po_10),disp(pks_po_10);
% % disp('第10点的相角与极小值')
% % disp(locs_pa_10),disp(pks_pa_10);
% %
% % %第11个点
% % [a_11,b_11]=createFits(x11,y11,x12,y12);
% % a_11{5,1}.a0;
% % FUNCTION_11=a_11{5,1}.a0 + a_11{5,1}.a1*cos(x3*a_11{5,1}.w)+ a_11{5,1}.b1*sin(x3*a_11{5,1}.w) +a_11{5,1}.a2*cos(2*x3*a_11{5,1}.w) + a_11{5,1}.b2*sin(2*x3*a_11{5,1}.w);
% % [pks_po_11,locs_po_11]=findpeaks(FUNCTION_11);
% % [pks_pa_11,locs_pa_11]=findpeaks(-FUNCTION_11);
% % % plot(FUNCTION_11);
% % % hold on
% % % plot(locs_po_11,pks_po_11,'o');
% % % [pks_11,locs_11]=findpeaks(-FUNCTION_11);
% % % plot(locs_pa_11,-pks_11,'*');
% % % hold on;
% % if length(pks_po_11)>1
% % [pks_po_11,weizhi_max_11]=max(pks_po_11);
% % locs_po_11=locs_po_11(weizhi_max_11);
% % end
% % if length(pks_pa_11)>1
% % [pks_pa_11,weizhi_min_11]=min(-pks_pa_11);
% % locs_pa_11=locs_pa_11(weizhi_min_11);
% % else
% % pks_pa_11=-pks_pa_11;
% % end
% % disp('第11点的相角与极大值')
% % disp(locs_po_11),disp(pks_po_11);
% % disp('第11点的相角与极小值')
% % disp(locs_pa_11),disp(pks_pa_11);
% %
% % %第12个点
% % [a_12,~]=createFits(x12,y12,x13,y13);
% % a_12{5,1}.a0;
% % FUNCTION_12=a_12{5,1}.a0 + a_12{5,1}.a1*cos(x3*a_12{5,1}.w)+ a_12{5,1}.b1*sin(x3*a_12{5,1}.w) +a_12{5,1}.a2*cos(2*x3*a_12{5,1}.w) + a_12{5,1}.b2*sin(2*x3*a_12{5,1}.w);
% % [pks_po_12,locs_po_12]=findpeaks(FUNCTION_12);
% % [pks_pa_12,locs_pa_12]=findpeaks(-FUNCTION_12);
% % % plot(FUNCTION_12);
% % % hold on
% % % plot(locs_po_12,pks_po_12,'o');
% % % [pks_12,~]=findpeaks(-FUNCTION_12);
% % % plot(locs_pa_12,-pks_12,'*');
% % % hold on;
% % if length(pks_po_12)>1
% % [pks_po_12,weizhi_max_12]=max(pks_po_12);
% % locs_po_12=locs_po_12(weizhi_max_12);
% % end
% % if length(pks_pa_12)>1
% % [pks_pa_12,weizhi_min_12]=min(-pks_pa_12);
% % locs_pa_12=locs_pa_12(weizhi_min_12);
% % else
% % pks_pa_12=-pks_pa_12;
% % end
% % disp('第12点的相角与极大值')
% % disp(locs_po_12),disp(pks_po_12);
% % disp('第12点的相角与极小值')
% % disp(locs_pa_12),disp(pks_pa_12);
% %
% % %第13个点
% % [a_13,~]=createFits(x13,y13,x14,y14);
% % a_13{5,1}.a0;
% % FUNCTION_13=a_13{5,1}.a0 + a_13{5,1}.a1*cos(x3*a_13{5,1}.w)+ a_13{5,1}.b1*sin(x3*a_13{5,1}.w) +a_13{5,1}.a2*cos(2*x3*a_13{5,1}.w) + a_13{5,1}.b2*sin(2*x3*a_13{5,1}.w);
% % [pks_po_13,locs_po_13]=findpeaks(FUNCTION_13);
% % [pks_pa_13,locs_pa_13]=findpeaks(-FUNCTION_13);
% % % plot(FUNCTION_13);
% % % hold on
% % % plot(locs_po_13,pks_po_13,'o');
% % % [pks_13,~]=findpeaks(-FUNCTION_13);
% % % plot(locs_pa_13,-pks_13,'*');
% % % hold on;
% % if length(pks_po_13)>1
% % [pks_po_13,weizhi_max_13]=max(pks_po_13);
% % locs_po_13=locs_po_13(weizhi_max_13);
% % end
% % if length(pks_pa_13)>1
% % [pks_pa_13,weizhi_min_13]=min(-pks_pa_13);
% % locs_pa_13=locs_pa_13(weizhi_min_13);
% % else
% % pks_pa_13=-pks_pa_13;
% % end
% % disp('第13点的相角与极大值')
% % disp(locs_po_13),disp(pks_po_13);
% % disp('第13点的相角与极小值')
% % disp(locs_pa_13),disp(pks_pa_13);
% %
% % %第14个点
% % [a_14,~]=createFits(x14,y14,x15,y15);
% % a_14{5,1}.a0;
% % FUNCTION_14=a_14{5,1}.a0 + a_14{5,1}.a1*cos(x3*a_14{5,1}.w)+ a_14{5,1}.b1*sin(x3*a_14{5,1}.w) +a_14{5,1}.a2*cos(2*x3*a_14{5,1}.w) + a_14{5,1}.b2*sin(2*x3*a_14{5,1}.w);
% % [pks_po_14,locs_po_14]=findpeaks(FUNCTION_14);
% % [pks_pa_14,locs_pa_14]=findpeaks(-FUNCTION_14);
% % % plot(FUNCTION_14);
% % % hold on
% % % plot(locs_po_14,pks_po_14,'o');
% % % [pks_14,~]=findpeaks(-FUNCTION_14);
% % % plot(locs_pa_14,-pks_14,'*');
% % % hold on;
% % if length(pks_po_14)>1
% % [pks_po_14,weizhi_max_14]=max(pks_po_14);
% % locs_po_14=locs_po_14(weizhi_max_14);
% % end
% % if length(pks_pa_14)>1
% % [pks_pa_14,weizhi_min_14]=min(-pks_pa_14);
% % locs_pa_14=locs_pa_14(weizhi_min_14);
% % else
% % pks_pa_14=-pks_pa_14;
% % end
% % disp('第14点的相角与极大值')
% % disp(locs_po_14),disp(pks_po_14);
% % disp('第14点的相角与极小值')
% % disp(locs_pa_14),disp(pks_pa_14);
% %
% % %第15个点
% % [a_15,~]=createFits(x15,y15,x16,y16);
% % a_15{5,1}.a0;
% % FUNCTION_15=a_15{5,1}.a0 + a_15{5,1}.a1*cos(x3*a_15{5,1}.w)+ a_15{5,1}.b1*sin(x3*a_15{5,1}.w) +a_15{5,1}.a2*cos(2*x3*a_15{5,1}.w) + a_15{5,1}.b2*sin(2*x3*a_15{5,1}.w);
% % [pks_po_15,locs_po_15]=findpeaks(FUNCTION_15);
% % [pks_pa_15,locs_pa_15]=findpeaks(-FUNCTION_15);
% % % plot(FUNCTION_15);
% % % hold on
% % % plot(locs_po_15,pks_po_15,'o');
% % % [pks_15,~]=findpeaks(-FUNCTION_15);
% % % plot(locs_pa_15,-pks_15,'*');
% % % hold on;
% % if length(pks_po_15)>1
% % [pks_po_15,weizhi_max_15]=max(pks_po_15);
% % locs_po_15=locs_po_15(weizhi_max_15);
% % end
% % if length(pks_pa_15)>1
% % [pks_pa_15,weizhi_min_15]=min(-pks_pa_15);
% % locs_pa_15=locs_pa_15(weizhi_min_15);
% % else
% % pks_pa_15=-pks_pa_15;
% % end
% % disp('第15点的相角与极大值')
% % disp(locs_po_15),disp(pks_po_15);
% % disp('第15点的相角与极小值')
% % disp(locs_pa_15),disp(pks_pa_15);
% %
% % %第16个点
% % [a_16,~]=createFits(x16,y16,x17,y17);
% % a_16{5,1}.a0;
% % FUNCTION_16=a_16{5,1}.a0 + a_16{5,1}.a1*cos(x3*a_16{5,1}.w)+ a_16{5,1}.b1*sin(x3*a_16{5,1}.w) +a_16{5,1}.a2*cos(2*x3*a_16{5,1}.w) + a_16{5,1}.b2*sin(2*x3*a_16{5,1}.w);
% % [pks_po_16,locs_po_16]=findpeaks(FUNCTION_16);
% % [pks_pa_16,locs_pa_16]=findpeaks(-FUNCTION_16);
% % % plot(FUNCTION_16);
% % % hold on
% % % plot(locs_po_16,pks_po_16,'o');
% % % [pks_1,~]=findpeaks(-FUNCTION_16);
% % % plot(locs_pa_16,-pks_16,'*');
% % % hold on;
% % if length(pks_po_16)>1
% % [pks_po_16,weizhi_max_16]=max(pks_po_16);
% % locs_po_16=locs_po_16(weizhi_max_16);
% % end
% % if length(pks_pa_16)>1
% % [pks_pa_16,weizhi_min_16]=min(-pks_pa_16);
% % locs_pa_16=locs_pa_16(weizhi_min_16);
% % else
% % pks_pa_16=-pks_pa_16;
% % end
% % disp('第16点的相角与极大值')
% % disp(locs_po_16),disp(pks_po_16);
% % disp('第16点的相角与极小值')
% % disp(locs_pa_16),disp(pks_pa_16);
% %
% % %第17个点
% % [a_17,~]=createFits(x17,y17,x18,y18);
% % a_17{5,1}.a0;
% % FUNCTION_17=a_17{5,1}.a0 + a_17{5,1}.a1*cos(x3*a_17{5,1}.w)+ a_17{5,1}.b1*sin(x3*a_17{5,1}.w) +a_17{5,1}.a2*cos(2*x3*a_17{5,1}.w) + a_17{5,1}.b2*sin(2*x3*a_17{5,1}.w);
% % [pks_po_17,locs_po_17]=findpeaks(FUNCTION_17);
% % [pks_pa_17,locs_pa_17]=findpeaks(-FUNCTION_17);
% % % plot(FUNCTION_17);
% % % hold on
% % % plot(locs_po_17,pks_po_17,'o');
% % % [pks_17,~]=findpeaks(-FUNCTION_17);
% % % plot(locs_pa_17,-pks_17,'*');
% % % hold on;
% % if length(pks_po_17)>1
% % [pks_po_17,weizhi_max_17]=max(pks_po_17);
% % locs_po_17=locs_po_17(weizhi_max_17);
% % end
% % if length(pks_pa_17)>1
% % [pks_pa_17,weizhi_min_17]=min(-pks_pa_17);
% % locs_pa_17=locs_pa_17(weizhi_min_17);
% % else
% % pks_pa_17=-pks_pa_17;
% % end
% % disp('第17点的相角与极大值')
% % disp(locs_po_17),disp(pks_po_17);
% % disp('第17点的相角与极小值')
% % disp(locs_pa_17),disp(pks_pa_17);
% %
% % %第18个点
% % [a_18,~]=createFits(x18,y18,x19,y19);
% % a_18{5,1}.a0;
% % FUNCTION_18=a_18{5,1}.a0 + a_18{5,1}.a1*cos(x3*a_18{5,1}.w)+ a_18{5,1}.b1*sin(x3*a_18{5,1}.w) +a_18{5,1}.a2*cos(2*x3*a_18{5,1}.w) + a_18{5,1}.b2*sin(2*x3*a_18{5,1}.w);
% % [pks_po_18,locs_po_18]=findpeaks(FUNCTION_18);
% % [pks_pa_18,locs_pa_18]=findpeaks(-FUNCTION_18);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_18)>1
% % [pks_po_18,weizhi_max_18]=max(pks_po_18);
% % locs_po_18=locs_po_18(weizhi_max_18);
% % end
% % if length(pks_pa_18)>1
% % [pks_pa_18,weizhi_min_18]=min(-pks_pa_18);
% % locs_pa_18=locs_pa_18(weizhi_min_18);
% % else
% % pks_pa_18=-pks_pa_18;
% % end
% % disp('第18点的相角与极大值')
% % disp(locs_po_18),disp(pks_po_18);
% % disp('第18点的相角与极小值')
% % disp(locs_pa_18),disp(pks_pa_18);
% %
% % %第19个点
% % [a_19,~]=createFits(x19,y19,x20,y20);
% % a_19{5,1}.a0;
% % FUNCTION_19=a_19{5,1}.a0 + a_19{5,1}.a1*cos(x3*a_19{5,1}.w)+ a_19{5,1}.b1*sin(x3*a_19{5,1}.w) +a_19{5,1}.a2*cos(2*x3*a_19{5,1}.w) + a_19{5,1}.b2*sin(2*x3*a_19{5,1}.w);
% % [pks_po_19,locs_po_19]=findpeaks(FUNCTION_19);
% % [pks_pa_19,locs_pa_19]=findpeaks(-FUNCTION_19);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_19)>1
% % [pks_po_19,weizhi_max_19]=max(pks_po_19);
% % locs_po_19=locs_po_19(weizhi_max_19);
% % end
% % if length(pks_pa_19)>1
% % [pks_pa_19,weizhi_min_19]=min(-pks_pa_19);
% % locs_pa_19=locs_pa_19(weizhi_min_19);
% % else
% % pks_pa_19=-pks_pa_19;
% % end
% % disp('第18点的相角与极大值')
% % disp(locs_po_19),disp(pks_po_19);
% % disp('第18点的相角与极小值')
% % disp(locs_pa_19),disp(pks_pa_19);
% %
% % %第20个点
% % [a_20,~]=createFits(x20,y20,x21,y21);
% % a_20{5,1}.a0;
% % FUNCTION_20=a_20{5,1}.a0 + a_20{5,1}.a1*cos(x3*a_20{5,1}.w)+ a_20{5,1}.b1*sin(x3*a_20{5,1}.w) +a_20{5,1}.a2*cos(2*x3*a_20{5,1}.w) + a_20{5,1}.b2*sin(2*x3*a_20{5,1}.w);
% % [pks_po_20,locs_po_20]=findpeaks(FUNCTION_20);
% % [pks_pa_20,locs_pa_20]=findpeaks(-FUNCTION_20);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_20)>1
% % [pks_po_20,weizhi_max_20]=max(pks_po_20);
% % locs_po_20=locs_po_20(weizhi_max_20);
% % end
% % if length(pks_pa_20)>1
% % [pks_pa_20,weizhi_min_20]=min(-pks_pa_20);
% % locs_pa_20=locs_pa_20(weizhi_min_20);
% % else
% % pks_pa_20=-pks_pa_20;
% % end
% % disp('第18点的相角与极大值')
% % disp(locs_po_20),disp(pks_po_20);
% % disp('第18点的相角与极小值')
% % disp(locs_pa_20),disp(pks_pa_20);
% %
% % %第21个点
% % [a_21,~]=createFits(x21,y21,x22,y22);
% % a_21{5,1}.a0;
% % FUNCTION_21=a_21{5,1}.a0 + a_21{5,1}.a1*cos(x3*a_21{5,1}.w)+ a_21{5,1}.b1*sin(x3*a_21{5,1}.w) +a_21{5,1}.a2*cos(2*x3*a_21{5,1}.w) + a_21{5,1}.b2*sin(2*x3*a_21{5,1}.w);
% % [pks_po_21,locs_po_21]=findpeaks(FUNCTION_21);
% % [pks_pa_21,locs_pa_21]=findpeaks(-FUNCTION_21);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_21)>1
% % [pks_po_21,weizhi_max_21]=max(pks_po_21);
% % locs_po_21=locs_po_21(weizhi_max_21);
% % end
% % if length(pks_pa_21)>1
% % [pks_pa_21,weizhi_min_21]=min(-pks_pa_21);
% % locs_pa_21=locs_pa_21(weizhi_min_21);
% % else
% % pks_pa_21=-pks_pa_21;
% % end
% % disp('第21点的相角与极大值')
% % disp(locs_po_21),disp(pks_po_21);
% % disp('第21点的相角与极小值')
% % disp(locs_pa_21),disp(pks_pa_21);
% %
% % %第22个点
% % [a_22,~]=createFits(x22,y22,x23,y23);
% % a_22{5,1}.a0;
% % FUNCTION_22=a_22{5,1}.a0 + a_22{5,1}.a1*cos(x3*a_22{5,1}.w)+ a_22{5,1}.b1*sin(x3*a_22{5,1}.w) +a_22{5,1}.a2*cos(2*x3*a_22{5,1}.w) + a_22{5,1}.b2*sin(2*x3*a_22{5,1}.w);
% % [pks_po_22,locs_po_22]=findpeaks(FUNCTION_22);
% % [pks_pa_22,locs_pa_22]=findpeaks(-FUNCTION_22);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_22)>1
% % [pks_po_22,weizhi_max_22]=max(pks_po_22);
% % locs_po_22=locs_po_22(weizhi_max_22);
% % end
% % if length(pks_pa_22)>1
% % [pks_pa_22,weizhi_min_22]=min(-pks_pa_22);
% % locs_pa_22=locs_pa_22(weizhi_min_22);
% % else
% % pks_pa_22=-pks_pa_22;
% % end
% % disp('第22点的相角与极大值')
% % disp(locs_po_22),disp(pks_po_22);
% % disp('第22点的相角与极小值')
% % disp(locs_pa_22),disp(pks_pa_22);
% %
% % %第23个点
% % [a_23,~]=createFits(x23,y23,x24,y24);
% % a_23{5,1}.a0;
% % FUNCTION_23=a_23{5,1}.a0 + a_23{5,1}.a1*cos(x3*a_23{5,1}.w)+ a_23{5,1}.b1*sin(x3*a_23{5,1}.w) +a_23{5,1}.a2*cos(2*x3*a_23{5,1}.w) + a_23{5,1}.b2*sin(2*x3*a_23{5,1}.w);
% % [pks_po_23,locs_po_23]=findpeaks(FUNCTION_23);
% % [pks_pa_23,locs_pa_23]=findpeaks(-FUNCTION_23);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_23)>1
% % [pks_po_23,weizhi_max_23]=max(pks_po_23);
% % locs_po_23=locs_po_23(weizhi_max_23);
% % end
% % if length(pks_pa_23)>1
% % [pks_pa_23,weizhi_min_23]=min(-pks_pa_23);
% % locs_pa_23=locs_pa_23(weizhi_min_23);
% % else
% % pks_pa_23=-pks_pa_23;
% % end
% % disp('第23点的相角与极大值')
% % disp(locs_po_23),disp(pks_po_23);
% % disp('第23点的相角与极小值')
% % disp(locs_pa_23),disp(pks_pa_23);
% %
% % %第24个点
% % [a_24,~]=createFits(x24,y24,x25,y25);
% % a_24{5,1}.a0;
% % FUNCTION_24=a_24{5,1}.a0 + a_24{5,1}.a1*cos(x3*a_24{5,1}.w)+ a_24{5,1}.b1*sin(x3*a_24{5,1}.w) +a_24{5,1}.a2*cos(2*x3*a_24{5,1}.w) + a_24{5,1}.b2*sin(2*x3*a_24{5,1}.w);
% % [pks_po_24,locs_po_24]=findpeaks(FUNCTION_24);
% % [pks_pa_24,locs_pa_24]=findpeaks(-FUNCTION_24);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_24)>1
% % [pks_po_24,weizhi_max_24]=max(pks_po_24);
% % locs_po_24=locs_po_24(weizhi_max_24);
% % end
% % if length(pks_pa_24)>1
% % [pks_pa_24,weizhi_min_24]=min(-pks_pa_24);
% % locs_pa_24=locs_pa_24(weizhi_min_24);
% % else
% % pks_pa_24=-pks_pa_24;
% % end
% % disp('第24点的相角与极大值')
% % disp(locs_po_24),disp(pks_po_24);
% % disp('第24点的相角与极小值')
% % disp(locs_pa_24),disp(pks_pa_24);
% %
% % %第25个点
% % [a_25,~]=createFits(x25,y25,x26,y26);
% % a_25{5,1}.a0;
% % FUNCTION_25=a_25{5,1}.a0 + a_25{5,1}.a1*cos(x3*a_25{5,1}.w)+ a_25{5,1}.b1*sin(x3*a_25{5,1}.w) +a_25{5,1}.a2*cos(2*x3*a_25{5,1}.w) + a_25{5,1}.b2*sin(2*x3*a_25{5,1}.w);
% % [pks_po_25,locs_po_25]=findpeaks(FUNCTION_25);
% % [pks_pa_25,locs_pa_25]=findpeaks(-FUNCTION_25);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_25)>1
% % [pks_po_25,weizhi_max_25]=max(pks_po_25);
% % locs_po_25=locs_po_25(weizhi_max_25);
% % end
% % if length(pks_pa_25)>1
% % [pks_pa_25,weizhi_min_25]=min(-pks_pa_25);
% % locs_pa_25=locs_pa_25(weizhi_min_25);
% % else
% % pks_pa_25=-pks_pa_25;
% % end
% % disp('第25点的相角与极大值')
% % disp(locs_po_25),disp(pks_po_25);
% % disp('第25点的相角与极小值')
% % disp(locs_pa_25),disp(pks_pa_25);
% %
% % %第26个点
% % [a_26,~]=createFits(x26,y26,x27,y27);
% % a_26{5,1}.a0;
% % FUNCTION_26=a_26{5,1}.a0 + a_26{5,1}.a1*cos(x3*a_26{5,1}.w)+ a_26{5,1}.b1*sin(x3*a_26{5,1}.w) +a_26{5,1}.a2*cos(2*x3*a_26{5,1}.w) + a_26{5,1}.b2*sin(2*x3*a_26{5,1}.w);
% % [pks_po_26,locs_po_26]=findpeaks(FUNCTION_26);
% % [pks_pa_26,locs_pa_26]=findpeaks(-FUNCTION_26);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_26)>1
% % [pks_po_26,weizhi_max_26]=max(pks_po_26);
% % locs_po_26=locs_po_26(weizhi_max_26);
% % end
% % if length(pks_pa_26)>1
% % [pks_pa_26,weizhi_min_26]=min(-pks_pa_26);
% % locs_pa_26=locs_pa_26(weizhi_min_26);
% % else
% % pks_pa_26=-pks_pa_26;
% % end
% % disp('第26点的相角与极大值')
% % disp(locs_po_26),disp(pks_po_26);
% % disp('第26点的相角与极小值')
% % disp(locs_pa_26),disp(pks_pa_26);
% %
% % %第27个点
% % [a_27,~]=createFits(x27,y27,x28,y28);
% % a_27{5,1}.a0;
% % FUNCTION_27=a_27{5,1}.a0 + a_27{5,1}.a1*cos(x3*a_27{5,1}.w)+ a_27{5,1}.b1*sin(x3*a_27{5,1}.w) +a_27{5,1}.a2*cos(2*x3*a_27{5,1}.w) + a_27{5,1}.b2*sin(2*x3*a_27{5,1}.w);
% % [pks_po_27,locs_po_27]=findpeaks(FUNCTION_27);
% % [pks_pa_27,locs_pa_27]=findpeaks(-FUNCTION_27);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_27)>1
% % [pks_po_27,weizhi_max_27]=max(pks_po_27);
% % locs_po_27=locs_po_27(weizhi_max_27);
% % end
% % if length(pks_pa_27)>1
% % [pks_pa_27,weizhi_min_27]=min(-pks_pa_27);
% % locs_pa_27=locs_pa_27(weizhi_min_27);
% % else
% % pks_pa_27=-pks_pa_27;
% % end
% % disp('第27点的相角与极大值')
% % disp(locs_po_27),disp(pks_po_27);
% % disp('第27点的相角与极小值')
% % disp(locs_pa_27),disp(pks_pa_27);
% %
% % %第28个点
% % [a_28,~]=createFits(x28,y28,x29,y29);
% % a_28{5,1}.a0;
% % FUNCTION_28=a_28{5,1}.a0 + a_28{5,1}.a1*cos(x3*a_28{5,1}.w)+ a_28{5,1}.b1*sin(x3*a_28{5,1}.w) +a_28{5,1}.a2*cos(2*x3*a_28{5,1}.w) + a_28{5,1}.b2*sin(2*x3*a_28{5,1}.w);
% % [pks_po_28,locs_po_28]=findpeaks(FUNCTION_28);
% % [pks_pa_28,locs_pa_28]=findpeaks(-FUNCTION_28);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_28)>1
% % [pks_po_28,weizhi_max_28]=max(pks_po_28);
% % locs_po_28=locs_po_28(weizhi_max_28);
% % end
% % if length(pks_pa_28)>1
% % [pks_pa_28,weizhi_min_28]=min(-pks_pa_28);
% % locs_pa_28=locs_pa_28(weizhi_min_28);
% % else
% % pks_pa_28=-pks_pa_28;
% % end
% % disp('第28点的相角与极大值')
% % disp(locs_po_28),disp(pks_po_28);
% % disp('第28点的相角与极小值')
% % disp(locs_pa_28),disp(pks_pa_28);
% %
% % %第29个点
% % [a_29,~]=createFits(x29,y29,x30,y30);
% % a_29{5,1}.a0;
% % FUNCTION_29=a_29{5,1}.a0 + a_29{5,1}.a1*cos(x3*a_29{5,1}.w)+ a_29{5,1}.b1*sin(x3*a_29{5,1}.w) +a_29{5,1}.a2*cos(2*x3*a_29{5,1}.w) + a_29{5,1}.b2*sin(2*x3*a_29{5,1}.w);
% % [pks_po_29,locs_po_29]=findpeaks(FUNCTION_29);
% % [pks_pa_29,locs_pa_29]=findpeaks(-FUNCTION_29);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_29)>1
% % [pks_po_29,weizhi_max_29]=max(pks_po_29);
% % locs_po_29=locs_po_29(weizhi_max_29);
% % end
% % if length(pks_pa_29)>1
% % [pks_pa_29,weizhi_min_29]=min(-pks_pa_29);
% % locs_pa_29=locs_pa_29(weizhi_min_29);
% % else
% % pks_pa_29=-pks_pa_29;
% % end
% % disp('第29点的相角与极大值')
% % disp(locs_po_29),disp(pks_po_29);
% % disp('第29点的相角与极小值')
% % disp(locs_pa_29),disp(pks_pa_29);
% %
% % %第30个点
% % [a_30,~]=createFits(x30,y30,x31,y31);
% % a_30{5,1}.a0;
% % FUNCTION_30=a_30{5,1}.a0 + a_30{5,1}.a1*cos(x3*a_30{5,1}.w)+ a_30{5,1}.b1*sin(x3*a_30{5,1}.w) +a_30{5,1}.a2*cos(2*x3*a_30{5,1}.w) + a_30{5,1}.b2*sin(2*x3*a_30{5,1}.w);
% % [pks_po_30,locs_po_30]=findpeaks(FUNCTION_30);
% % [pks_pa_30,locs_pa_30]=findpeaks(-FUNCTION_30);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_30)>1
% % [pks_po_30,weizhi_max_30]=max(pks_po_30);
% % locs_po_30=locs_po_30(weizhi_max_30);
% % end
% % if length(pks_pa_30)>1
% % [pks_pa_30,weizhi_min_30]=min(-pks_pa_30);
% % locs_pa_30=locs_pa_30(weizhi_min_30);
% % else
% % pks_pa_30=-pks_pa_30;
% % end
% % disp('第30点的相角与极大值')
% % disp(locs_po_30),disp(pks_po_30);
% % disp('第30点的相角与极小值')
% % disp(locs_pa_30),disp(pks_pa_30);
% %
% % %第31个点
% % [a_31,~]=createFits(x31,y31,x32,y32);
% % a_31{5,1}.a0;
% % FUNCTION_31=a_31{5,1}.a0 + a_31{5,1}.a1*cos(x3*a_31{5,1}.w)+ a_31{5,1}.b1*sin(x3*a_31{5,1}.w) +a_31{5,1}.a2*cos(2*x3*a_31{5,1}.w) + a_31{5,1}.b2*sin(2*x3*a_31{5,1}.w);
% % [pks_po_31,locs_po_31]=findpeaks(FUNCTION_31);
% % [pks_pa_31,locs_pa_31]=findpeaks(-FUNCTION_31);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_31)>1
% % [pks_po_31,weizhi_max_31]=max(pks_po_31);
% % locs_po_31=locs_po_31(weizhi_max_31);
% % end
% % if length(pks_pa_31)>1
% % [pks_pa_31,weizhi_min_31]=min(-pks_pa_31);
% % locs_pa_31=locs_pa_31(weizhi_min_31);
% % else
% % pks_pa_31=-pks_pa_31;
% % end
% % disp('第31点的相角与极大值')
% % disp(locs_po_31),disp(pks_po_31);
% % disp('第31点的相角与极小值')
% % disp(locs_pa_31),disp(pks_pa_31);
% %
% %
% % %第32个点
% % [a_32,~]=createFits(x32,y32,x33,y33);
% % a_32{5,1}.a0;
% % FUNCTION_32=a_32{5,1}.a0 + a_32{5,1}.a1*cos(x3*a_32{5,1}.w)+ a_32{5,1}.b1*sin(x3*a_32{5,1}.w) +a_32{5,1}.a2*cos(2*x3*a_32{5,1}.w) + a_32{5,1}.b2*sin(2*x3*a_32{5,1}.w);
% % [pks_po_32,locs_po_32]=findpeaks(FUNCTION_32);
% % [pks_pa_32,locs_pa_32]=findpeaks(-FUNCTION_32);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_32)>1
% % [pks_po_32,weizhi_max_32]=max(pks_po_32);
% % locs_po_32=locs_po_32(weizhi_max_32);
% % end
% % if length(pks_pa_32)>1
% % [pks_pa_32,weizhi_min_32]=min(-pks_pa_32);
% % locs_pa_32=locs_pa_32(weizhi_min_32);
% % else
% % pks_pa_32=-pks_pa_32;
% % end
% % disp('第32点的相角与极大值')
% % disp(locs_po_32),disp(pks_po_32);
% % disp('第32点的相角与极小值')
% % disp(locs_pa_32),disp(pks_pa_32);
% %
% % %第33个点
% % [a_33,~]=createFits(x33,y33,x34,y34);
% % a_33{5,1}.a0;
% % FUNCTION_33=a_33{5,1}.a0 + a_33{5,1}.a1*cos(x3*a_33{5,1}.w)+ a_33{5,1}.b1*sin(x3*a_33{5,1}.w) +a_33{5,1}.a2*cos(2*x3*a_33{5,1}.w) + a_33{5,1}.b2*sin(2*x3*a_33{5,1}.w);
% % [pks_po_33,locs_po_33]=findpeaks(FUNCTION_33);
% % [pks_pa_33,locs_pa_33]=findpeaks(-FUNCTION_33);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_33)>1
% % [pks_po_33,weizhi_max_33]=max(pks_po_33);
% % locs_po_33=locs_po_33(weizhi_max_33);
% % end
% % if length(pks_pa_33)>1
% % [pks_pa_33,weizhi_min_33]=min(-pks_pa_33);
% % locs_pa_33=locs_pa_33(weizhi_min_33);
% % else
% % pks_pa_33=-pks_pa_33;
% % end
% % disp('第33点的相角与极大值')
% % disp(locs_po_33),disp(pks_po_33);
% % disp('第33点的相角与极小值')
% % disp(locs_pa_33),disp(pks_pa_33);
% %
% % %第34个点
% % [a_34,~]=createFits(x34,y34,x35,y35);
% % a_34{5,1}.a0;
% % FUNCTION_34=a_34{5,1}.a0 + a_34{5,1}.a1*cos(x3*a_34{5,1}.w)+ a_34{5,1}.b1*sin(x3*a_34{5,1}.w) +a_34{5,1}.a2*cos(2*x3*a_34{5,1}.w) + a_34{5,1}.b2*sin(2*x3*a_34{5,1}.w);
% % [pks_po_34,locs_po_34]=findpeaks(FUNCTION_34);
% % [pks_pa_34,locs_pa_34]=findpeaks(-FUNCTION_34);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_34)>1
% % [pks_po_34,weizhi_max_34]=max(pks_po_34);
% % locs_po_34=locs_po_34(weizhi_max_34);
% % end
% % if length(pks_pa_34)>1
% % [pks_pa_34,weizhi_min_34]=min(-pks_pa_34);
% % locs_pa_34=locs_pa_34(weizhi_min_34);
% % else
% % pks_pa_34=-pks_pa_34;
% % end
% % disp('第34点的相角与极大值')
% % disp(locs_po_34),disp(pks_po_34);
% % disp('第34点的相角与极小值')
% % disp(locs_pa_34),disp(pks_pa_34);
% %
% % %第35个点
% % [a_35,~]=createFits(x35,y35,x36,y36);
% % a_35{5,1}.a0;
% % FUNCTION_35=a_35{5,1}.a0 + a_35{5,1}.a1*cos(x3*a_35{5,1}.w)+ a_35{5,1}.b1*sin(x3*a_35{5,1}.w) +a_35{5,1}.a2*cos(2*x3*a_35{5,1}.w) + a_35{5,1}.b2*sin(2*x3*a_35{5,1}.w);
% % [pks_po_35,locs_po_35]=findpeaks(FUNCTION_35);
% % [pks_pa_35,locs_pa_35]=findpeaks(-FUNCTION_35);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_35)>1
% % [pks_po_35,weizhi_max_35]=max(pks_po_35);
% % locs_po_35=locs_po_35(weizhi_max_35);
% % end
% % if length(pks_pa_35)>1
% % [pks_pa_35,weizhi_min_35]=min(-pks_pa_35);
% % locs_pa_35=locs_pa_35(weizhi_min_35);
% % else
% % pks_pa_35=-pks_pa_35;
% % end
% % disp('第35点的相角与极大值')
% % disp(locs_po_35),disp(pks_po_35);
% % disp('第35点的相角与极小值')
% % disp(locs_pa_35),disp(pks_pa_35);
% %
% % %第36个点
% % [a_36,~]=createFits(x36,y36,x37,y37);
% % a_36{5,1}.a0;
% % FUNCTION_36=a_36{5,1}.a0 + a_36{5,1}.a1*cos(x3*a_36{5,1}.w)+ a_36{5,1}.b1*sin(x3*a_36{5,1}.w) +a_36{5,1}.a2*cos(2*x3*a_36{5,1}.w) + a_36{5,1}.b2*sin(2*x3*a_36{5,1}.w);
% % [pks_po_36,locs_po_36]=findpeaks(FUNCTION_36);
% % [pks_pa_36,locs_pa_36]=findpeaks(-FUNCTION_36);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_36)>1
% % [pks_po_36,weizhi_max_36]=max(pks_po_36);
% % locs_po_36=locs_po_36(weizhi_max_36);
% % end
% % if length(pks_pa_36)>1
% % [pks_pa_36,weizhi_min_36]=min(-pks_pa_36);
% % locs_pa_36=locs_pa_36(weizhi_min_36);
% % else
% % pks_pa_36=-pks_pa_36;
% % end
% % disp('第36点的相角与极大值')
% % disp(locs_po_36),disp(pks_po_36);
% % disp('第36点的相角与极小值')
% % disp(locs_pa_36),disp(pks_pa_36);
% %
% % %第37个点
% % [a_37,~]=createFits(x37,y37,x38,y38);
% % a_37{5,1}.a0;
% % FUNCTION_37=a_37{5,1}.a0 + a_37{5,1}.a1*cos(x3*a_37{5,1}.w)+ a_37{5,1}.b1*sin(x3*a_37{5,1}.w) +a_37{5,1}.a2*cos(2*x3*a_37{5,1}.w) + a_37{5,1}.b2*sin(2*x3*a_37{5,1}.w);
% % [pks_po_37,locs_po_37]=findpeaks(FUNCTION_37);
% % [pks_pa_37,locs_pa_37]=findpeaks(-FUNCTION_37);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_37)>1
% % [pks_po_37,weizhi_max_37]=max(pks_po_37);
% % locs_po_37=locs_po_37(weizhi_max_37);
% % end
% % if length(pks_pa_37)>1
% % [pks_pa_37,weizhi_min_37]=min(-pks_pa_37);
% % locs_pa_37=locs_pa_37(weizhi_min_37);
% % else
% % pks_pa_37=-pks_pa_37;
% % end
% % disp('第37点的相角与极大值')
% % disp(locs_po_37),disp(pks_po_37);
% % disp('第37点的相角与极小值')
% % disp(locs_pa_37),disp(pks_pa_37);
% %
% % %第38个点
% % [a_38,~]=createFits(x38,y38,x39,y39);
% % a_38{5,1}.a0;
% % FUNCTION_38=a_38{5,1}.a0 + a_38{5,1}.a1*cos(x3*a_38{5,1}.w)+ a_38{5,1}.b1*sin(x3*a_38{5,1}.w) +a_38{5,1}.a2*cos(2*x3*a_38{5,1}.w) + a_38{5,1}.b2*sin(2*x3*a_38{5,1}.w);
% % [pks_po_38,locs_po_38]=findpeaks(FUNCTION_38);
% % [pks_pa_38,locs_pa_38]=findpeaks(-FUNCTION_38);
% % % plot(FUNCTION_18);
% % % hold on
% % % plot(locs_po_18,pks_po_18,'o');
% % % [pks_18,~]=findpeaks(-FUNCTION_18);
% % % plot(locs_pa_18,-pks_18,'*');
% % % hold on;
% % if length(pks_po_38)>1
% % [pks_po_38,weizhi_max_38]=max(pks_po_38);
% % locs_po_38=locs_po_38(weizhi_max_38);
% % end
% % if length(pks_pa_38)>1
% % [pks_pa_38,weizhi_min_38]=min(-pks_pa_38);
% % locs_pa_38=locs_pa_38(weizhi_min_38);
% % else
% % pks_pa_38=-pks_pa_38;
% % end
% % disp('第38点的相角与极大值')
% % disp(locs_po_38),disp(pks_po_38);
% % disp('第38点的相角与极小值')
% % disp(locs_pa_38),disp(pks_pa_38);
% %
% % 第39个点
% % [a_39,~]=createFits(x39,y39,x1,y1);
% % a_39{5,1}.a0;
% % FUNCTION_39=a_39{5,1}.a0 + a_39{5,1}.a1*cos(x3*a_39{5,1}.w)+ a_39{5,1}.b1*sin(x3*a_39{5,1}.w) +a_39{5,1}.a2*cos(2*x3*a_39{5,1}.w) + a_39{5,1}.b2*sin(2*x3*a_39{5,1}.w);
% % [pks_po_39,locs_po_39]=findpeaks(FUNCTION_39);
% % [pks_pa_39,locs_pa_39]=findpeaks(-FUNCTION_39);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% % if length(pks_po_39)>1
% % [pks_po_39,weizhi_max_39]=max(pks_po_39);
% % locs_po_39=locs_po_39(weizhi_max_39);
% % end
% % if length(pks_pa_39)>1
% % [pks_pa_39,weizhi_min_39]=min(-pks_pa_39);
% % locs_pa_39=locs_pa_39(weizhi_min_39);
% % else
% % pks_pa_39=-pks_pa_39;
% % end
% % disp('第38点的相角与极大值')
% % disp(locs_po_39),disp(pks_po_39);
% % disp('第38点的相角与极小值')
% % disp(locs_pa_39),disp(pks_pa_39);

%% %至此，上面第一步已经完成，输出了每个点的极值以及相位；
locs_pa=[locs_pa_1,locs_pa_2,locs_pa_3%,locs_pa_4,locs_pa_5,locs_pa_6,locs_pa_7,locs_pa_8,locs_pa_9,locs_pa_10,
% locs_pa_11,locs_pa_12,locs_pa_13,locs_pa_14,locs_pa_15,locs_pa_16,locs_pa_17,locs_pa_18,locs_pa_19,locs_pa_20,
% locs_pa_21,locs_pa_22,locs_pa_23,locs_pa_24,locs_pa_25,locs_pa_26,locs_pa_27,locs_pa_28,locs_pa_19,locs_pa_30,
% locs_pa_31,locs_pa_32,locs_pa_33,locs_pa_34,locs_pa_35,locs_pa_36,locs_pa_37,locs_pa_38,locs_pa_39
];
pks_pa=[pks_pa_1,pks_pa_2,pks_pa_3];
pks_po=[pks_po_1,pks_po_2,pks_po_3];
for i=2:1:2
if pks_po(i)-pks_pa(i)<0.05
disp(i);
disp('该点不用处理');
else
hight=pks_pa(i)-(pks_pa(i-1)+pks_pa(i+1))/2;
if hight>0
disp('下压点为');
disp(i);
disp('下压点的旋转角度为')
disp(locs_pa(i));
disp('下压量为');
disp(hight);
else
disp('下压点为');
disp(i);
disp('下压点的旋转角度为')
theta=locs_pa(i)+180;
disp(mod(theta,360));
disp('下压量为');
disp(-hight);
end
end
end
%%
% function [fitresult, gof] = createFit(x1, y1)
% [xData, yData] = prepareCurveData( x1, y1 );
% ft = fittype( 'fourier2' );
% opts = fitoptions( 'Method', 'NonlinearLeastSquares' );
% opts.Display = 'Off';
% opts.StartPoint = [0 0 0 0 0 0.017459112224018];
% % Fit model to data.
% [fitresult, gof] = fit( xData, yData, ft, opts );
% % Plot fit with data.
% figure( 'Name', 'untitled fit 1' );
% h = plot( fitresult, xData, yData );
% legend( h, 'y vs. x', 'fit curve', 'Location', 'NorthEast', 'Interpreter', 'none' );
% xlabel( 'x', 'Interpreter', 'none' );
% ylabel( 'y', 'Interpreter', 'none' );
% grid on
% end
%%
function [fitresult, gof] = createFits(x1, y1, x2, y2)
% 初始化.
% 初始化数组以存储拟合度和拟合优度。
fitresult = cell( 5, 1 );
gof = struct( 'sse', cell( 5, 1 ), ...
'rsquare', [], 'dfe', [], 'adjrsquare', [], 'rmse', [] );

[xData, yData] = prepareCurveData( x1, y1 );
%设置拟合类型和精度.
ft = fittype( 'poly1' );
% 使模型符合数据.
[fitresult{1}, gof(1)] = fit( xData, yData, ft );
% 画图.
% figure( 'Name', 'untitled fit 1' );
% h = plot( fitresult{1}, xData, yData );
% legend( h, 'y1 vs. x1', 'untitled fit 1', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x1', 'Interpreter', 'none' );
% ylabel( 'y1', 'Interpreter', 'none' );
% grid on

[xData, yData] = prepareCurveData( x2, y2 );
ft = fittype( 'poly1' );
[fitresult{2}, gof(2)] = fit( xData, yData, ft );
% figure( 'Name', 'untitled fit 2' );
% h = plot( fitresult{2}, xData, yData );
% legend( h, 'y2 vs. x2', 'untitled fit 2', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x2', 'Interpreter', 'none' );
% ylabel( 'y2', 'Interpreter', 'none' );
% grid on

[xData, yData] = prepareCurveData( x2, y2 );
ft = fittype( 'fourier2' );
opts = fitoptions( 'Method', 'NonlinearLeastSquares' );
opts.Display = 'Off';
opts.Robust = 'Bisquare';
opts.StartPoint = [0 0 0 0 0 0.00875317323775607];
[fitresult{3}, gof(3)] = fit( xData, yData, ft, opts );
% figure( 'Name', 'untitled fit 3' );
% h = plot( fitresult{3}, xData, yData );
% legend( h, 'y2 vs. x2', 'untitled fit 3', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x2', 'Interpreter', 'none' );
% ylabel( 'y2', 'Interpreter', 'none' );
% grid on

[xData, yData] = prepareCurveData( x1, y1 );
ft = fittype( 'fourier2' );
opts = fitoptions( 'Method', 'NonlinearLeastSquares' );
opts.Display = 'Off';
opts.Robust = 'Bisquare';
opts.StartPoint = [0 0 0 0 0 0.017459112224018];
[fitresult{4}, gof(4)] = fit( xData, yData, ft, opts );
% figure( 'Name', 'untitled fit 4' );
% h = plot( fitresult{4}, xData, yData );
% legend( h, 'y1 vs. x1', 'untitled fit 4', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x1', 'Interpreter', 'none' );
% ylabel( 'y1', 'Interpreter', 'none' );
% grid on

[xData, yData] = prepareCurveData( x1, y1 );
ft = fittype( 'fourier2' );
opts = fitoptions( 'Method', 'NonlinearLeastSquares' );
opts.Display = 'Off';
opts.Robust = 'Bisquare';
opts.StartPoint = [0 0 0 0 0 0.017459112224018];
[fitresult{5}, gof(5)] = fit( xData, yData, ft, opts );
% figure( 'Name', 'untitled fit 5' );
% h = plot( fitresult{5}, xData, yData );
% legend( h, 'y1 vs. x1', 'untitled fit 5', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x1', 'Interpreter', 'none' );
% ylabel( 'y1', 'Interpreter', 'none' );
% grid on
end

%%
HN1=xlsread('HN');
x1=HN1(:,2);
y1=HN1(:,1);

x2=HN1(:,4);
y2=HN1(:,3);

x3=HN1(:,6);
y3=HN1(:,5);

% x4=HN1(:,8);
% y4=HN1(:,7);
%
% x5=HN1(:,10);
% y5=HN1(:,9);
%
% x6=HN1(:,12);
% y6=HN1(:,11);
%
% x7=HN1(:,14);
% y7=HN1(:,13);
%
% x8=HN1(:,16);
% y8=HN1(:,15);
%
% x9=HN1(:,18);
% y9=HN1(:,17);
%
% x10=HN1(:,20);
% y10=HN1(:,19);
%
% x11=HN1(:,22);
% y11=HN1(:,21);
%
% x12=HN1(:,24);
% y12=HN1(:,23);
%
% x13=HN1(:,26);
% y13=HN1(:,25);
%
% x14=HN1(:,28);
% y14=HN1(:,27);
%
% x15=HN1(:,30);
% y15=HN1(:,29);
%
% x16=HN1(:,32);
% y16=HN1(:,31);
%
% x17=HN1(:,34);
% y17=HN1(:,33);
%
% x18=HN1(:,36);
% y18=HN1(:,35);
%
% x19=HN1(:,38);
% y19=HN1(:,37);
%
% x20=HN1(:,40);
% y20=HN1(:,49);
%
% x21=HN1(:,42);
% y21=HN1(:,41);
%
% x22=HN1(:,44);
% y22=HN1(:,43);
%
% x23=HN1(:,46);
% y23=HN1(:,45);
%
% x24=HN1(:,48);
% y24=HN1(:,47);
%
% x25=HN1(:,50);
% y25=HN1(:,49);
%
% x26=HN1(:,52);
% y26=HN1(:,51);
%
% x27=HN1(:,54);
% y27=HN1(:,53);
%
% x28=HN1(:,56);
% y28=HN1(:,55);
%
% x29=HN1(:,58);
% y29=HN1(:,57);
%
% x30=HN1(:,60);
% y30=HN1(:,59);
%
% x31=HN1(:,62);
% y31=HN1(:,61);
%
% x32=HN1(:,64);
% y32=HN1(:,63);
%
% x33=HN1(:,66);
% y33=HN1(:,65);
%
% x34=HN1(:,68);
% y34=HN1(:,67);
%
% x35=HN1(:,70);
% y35=HN1(:,69);
%
% x36=HN1(:,72);
% y36=HN1(:,71);
%
% x37=HN1(:,74);
% y37=HN1(:,73);
%
% x38=HN1(:,76);
% y38=HN1(:,75);
%
% x39=HN1(:,78);
% y39=HN1(:,77);

%%
% 第1个点
[a_1,~]=createFits(x1,y1,x2,y2);
a_1{5,1}.a0;
FUNCTION_1=a_1{5,1}.a0 + a_1{5,1}.a1*cos(x3*a_1{5,1}.w)+ a_1{5,1}.b1*sin(x3*a_1{5,1}.w) +a_1{5,1}.a2*cos(2*x3*a_1{5,1}.w) + a_1{5,1}.b2*sin(2*x3*a_1{5,1}.w);
[pks_po_1,locs_po_1]=findpeaks(FUNCTION_1);
[pks_pa_1,locs_pa_1]=findpeaks(-FUNCTION_1);
% plot(FUNCTION_18);
% hold on
% plot(locs_po_18,pks_po_18,'o');
% [pks_18,~]=findpeaks(-FUNCTION_18);
% plot(locs_pa_18,-pks_18,'*');
% hold on;
if length(pks_po_1)>1
[pks_po_1,weizhi_max_1]=max(pks_po_1);
locs_po_1=locs_po_1(weizhi_max_1);
end
if length(pks_pa_1)>1
[pks_pa_1,weizhi_min_1]=min(-pks_pa_1);
locs_pa_1=locs_pa_1(weizhi_min_1);
else
pks_pa_1=-pks_pa_1;
end
disp('第1的相角与极大值')
disp(locs_po_1),disp(pks_po_1);
disp('第1点的相角与极小值')
disp(locs_pa_1),disp(pks_pa_1);

% %第四个点
% [a_4,b_4]=createFits(x4, y4,x5,y5);
% a_4{5,1}.a0;
% FUNCTION_4=a_4{5,1}.a0 + a_4{5,1}.a1*cos(x3*a_4{5,1}.w)+ a_4{5,1}.b1*sin(x3*a_4{5,1}.w) +a_4{5,1}.a2*cos(2*x3*a_4{5,1}.w) + a_4{5,1}.b2*sin(2*x3*a_4{5,1}.w);
% [pks_po_4,locs_po_4]=findpeaks(FUNCTION_3);
% [pks_pa_4,locs_pa_4]=findpeaks(-FUNCTION_4);
% % plot(FUNCTION_4);
% % hold on
% % plot(locs_po_4,pks_po_4,'o');
% % [pks_4,locs_4]=findpeaks(-FUNCTION_4);
% % plot(locs_pa_4,-pks_4,'*');
% % hold on;
% if length(pks_po_4)>1
% [pks_po_4,weizhi_max_4]=max(pks_po_4);
% locs_po_4=locs_po_4(weizhi_max_4);
% else
% pks_po_4=pks_po_4;
% end
% if length(pks_pa_4)>1
% [pks_pa_4,weizhi_min_4]=min(-pks_pa_4);
% locs_pa_4=locs_pa_4(weizhi_min_4);
% else
% pks_pa_4=-pks_pa_4;
% end
% disp('第四点的相角与极大值')
% disp(locs_po_4),disp(pks_po_4);
% disp('第四点的相角与极小值')
% disp(locs_pa_4),disp(pks_pa_4);
%
% %第五个点
% [a_5,b_5]=createFits(x5, y5,x6,y6);
% a_5{5,1}.a0;
% FUNCTION_5=a_5{5,1}.a0 + a_5{5,1}.a1*cos(x3*a_5{5,1}.w)+ a_5{5,1}.b1*sin(x3*a_5{5,1}.w) +a_5{5,1}.a2*cos(2*x3*a_5{5,1}.w) + a_5{5,1}.b2*sin(2*x3*a_5{5,1}.w);
% [pks_po_5,locs_po_5]=findpeaks(FUNCTION_5);
% [pks_pa_5,locs_pa_5]=findpeaks(-FUNCTION_5);
% % plot(FUNCTION_5);
% % hold on
% % plot(locs_po_5,pks_po_5,'o');
% % [pks_5,locs_5]=findpeaks(-FUNCTION_5);
% % plot(locs_pa_5,-pks_5,'*');
% % hold on;
% if length(pks_po_5)>1
% [pks_po_5,weizhi_max_5]=max(pks_po_5);
% locs_po_5=locs_po_5(weizhi_max_5);
% else
% pks_po_5=pks_po_5;
% end
% if length(pks_pa_5)>1
% [pks_pa_5,weizhi_min_5]=min(-pks_pa_5);
% locs_pa_5=locs_pa_5(weizhi_min_5);
% else
% pks_pa_5=-pks_pa_5;
% end
% disp('第五点的相角与极大值')
% disp(locs_po_5),disp(pks_po_5);
% disp('第五点的相角与极小值')
% disp(locs_pa_5),disp(pks_pa_5);
%
% %第6个点
% [a_6,b_6]=createFits(x6, y6,x7,y7);
% a_6{5,1}.a0;
% FUNCTION_6=a_6{5,1}.a0 + a_6{5,1}.a1*cos(x3*a_6{5,1}.w)+ a_6{5,1}.b1*sin(x3*a_6{5,1}.w) +a_6{5,1}.a2*cos(2*x3*a_6{5,1}.w) + a_6{5,1}.b2*sin(2*x3*a_6{5,1}.w);
% [pks_po_6,locs_po_6]=findpeaks(FUNCTION_6);
% [pks_pa_6,locs_pa_6]=findpeaks(-FUNCTION_6);
% % plot(FUNCTION_6);
% % hold on
% % plot(locs_po_6,pks_po_6,'o');
% % [pks_6,locs_6]=findpeaks(-FUNCTION_6);
% % plot(locs_pa_6,-pks_6,'*');
% % hold on;
% if length(pks_po_6)>1
% [pks_po_6,weizhi_max_6]=max(pks_po_6);
% locs_po_6=locs_po_6(weizhi_max_6);
% else
% pks_po_6=pks_po_6;
% end
% if length(pks_pa_6)>1
% [pks_pa_6,weizhi_min_6]=min(-pks_pa_6);
% locs_pa_6=locs_pa_6(weizhi_min_6);
% else
% pks_pa_6=-pks_pa_6;
% end
% disp('第6点的相角与极大值')
% disp(locs_po_6),disp(pks_po_6);
% disp('第6点的相角与极小值')
% disp(locs_pa_6),disp(pks_pa_6);
%
% %第7个点
% [a_7,b_7]=createFits(x7,y7,x8,y8);
% a_7{5,1}.a0;
% FUNCTION_7=a_7{5,1}.a0 + a_7{5,1}.a1*cos(x3*a_7{5,1}.w)+ a_7{5,1}.b1*sin(x3*a_7{5,1}.w) +a_7{5,1}.a2*cos(2*x3*a_7{5,1}.w) + a_7{5,1}.b2*sin(2*x3*a_7{5,1}.w);
% [pks_po_7,locs_po_7]=findpeaks(FUNCTION_7);
% [pks_pa_7,locs_pa_7]=findpeaks(-FUNCTION_7);
% % plot(FUNCTION_7);
% % hold on
% % plot(locs_po_7,pks_po_7,'o');
% % [pks_7,locs_7]=findpeaks(-FUNCTION_7);
% % plot(locs_pa_7,-pks_7,'*');
% % hold on;
% if length(pks_po_7)>1
% [pks_po_7,weizhi_max_7]=max(pks_po_7);
% locs_po_7=locs_po_7(weizhi_max_7);
% else
% pks_po_7=pks_po_7;
% end
% if length(pks_pa_7)>1
% [pks_pa_7,weizhi_min_7]=min(-pks_pa_7);
% locs_pa_7=locs_pa_7(weizhi_min_7);
% else
% pks_pa_7=-pks_pa_7;
% end
% disp('第7点的相角与极大值')
% disp(locs_po_7),disp(pks_po_7);
% disp('第7点的相角与极小值')
% disp(locs_pa_7),disp(pks_pa_7);
%
% %第8个点
% [a_8,b_8]=createFits(x8,y8,x9,y9);
% a_8{5,1}.a0;
% FUNCTION_8=a_8{5,1}.a0 + a_8{5,1}.a1*cos(x3*a_8{5,1}.w)+ a_8{5,1}.b1*sin(x3*a_8{5,1}.w) +a_8{5,1}.a2*cos(2*x3*a_8{5,1}.w) + a_8{5,1}.b2*sin(2*x3*a_8{5,1}.w);
% [pks_po_8,locs_po_8]=findpeaks(FUNCTION_8);
% [pks_pa_8,locs_pa_8]=findpeaks(-FUNCTION_8);
% % plot(FUNCTION_8);
% % hold on
% % plot(locs_po_8,pks_po_8,'o');
% % [pks_8,locs_8]=findpeaks(-FUNCTION_8);
% % plot(locs_pa_8,-pks_8,'*');
% % hold on;
% if length(pks_po_8)>1
% [pks_po_8,weizhi_max_8]=max(pks_po_8);
% locs_po_8=locs_po_8(weizhi_max_8);
% else
% pks_po_8=pks_po_8;
% end
% if length(pks_pa_8)>1
% [pks_pa_8,weizhi_min_8]=min(-pks_pa_8);
% locs_pa_8=locs_pa_8(weizhi_min_8);
% else
% pks_pa_8=-pks_pa_8;
% end
% disp('第8点的相角与极大值')
% disp(locs_po_8),disp(pks_po_8);
% disp('第8点的相角与极小值')
% disp(locs_pa_8),disp(pks_pa_8);
%
% %第9个点
% [a_9,b_9]=createFits(x9,y9,x10,y10);
% a_9{5,1}.a0;
% FUNCTION_9=a_9{5,1}.a0 + a_9{5,1}.a1*cos(x3*a_9{5,1}.w)+ a_9{5,1}.b1*sin(x3*a_9{5,1}.w) +a_9{5,1}.a2*cos(2*x3*a_9{5,1}.w) + a_9{5,1}.b2*sin(2*x3*a_9{5,1}.w);
% [pks_po_9,locs_po_9]=findpeaks(FUNCTION_9);
% [pks_pa_9,locs_pa_9]=findpeaks(-FUNCTION_9);
% % plot(FUNCTION_9);
% % hold on
% % plot(locs_po_9,pks_po_9,'o');
% % [pks_9,locs_9]=findpeaks(-FUNCTION_9);
% % plot(locs_pa_9,-pks_9,'*');
% % hold on;
% if length(pks_po_9)>1
% [pks_po_9,weizhi_max_9]=max(pks_po_9);
% locs_po_9=locs_po_9(weizhi_max_9);
% else
% pks_po_9=pks_po_9;
% end
% if length(pks_pa_9)>1
% [pks_pa_9,weizhi_min_9]=min(-pks_pa_9);
% locs_pa_9=locs_pa_9(weizhi_min_9);
% else
% pks_pa_9=-pks_pa_9;
% end
% disp('第9点的相角与极大值')
% disp(locs_po_9),disp(pks_po_9);
% disp('第9点的相角与极小值')
% disp(locs_pa_9),disp(pks_pa_9);
%
% %第10个点
% [a_10,b_10]=createFits(x10,y10,x11,y11);
% a_10{5,1}.a0;
% FUNCTION_10=a_10{5,1}.a0 + a_10{5,1}.a1*cos(x3*a_10{5,1}.w)+ a_10{5,1}.b1*sin(x3*a_10{5,1}.w) +a_10{5,1}.a2*cos(2*x3*a_10{5,1}.w) + a_10{5,1}.b2*sin(2*x3*a_10{5,1}.w);
% [pks_po_10,locs_po_10]=findpeaks(FUNCTION_10);
% [pks_pa_10,locs_pa_10]=findpeaks(-FUNCTION_10);
% % plot(FUNCTION_10);
% % hold on
% % plot(locs_po_10,pks_po_10,'o');
% % [pks_10,locs_10]=findpeaks(-FUNCTION_10);
% % plot(locs_pa_10,-pks_10,'*');
% % hold on;
% if length(pks_po_10)>1
% [pks_po_10,weizhi_max_10]=max(pks_po_10);
% locs_po_10=locs_po_10(weizhi_max_10);
% end
% if length(pks_pa_10)>1
% [pks_pa_10,weizhi_min_10]=min(-pks_pa_10);
% locs_pa_10=locs_pa_10(weizhi_min_10);
% else
% pks_pa_10=-pks_pa_10;
% end
% disp('第10点的相角与极大值')
% disp(locs_po_10),disp(pks_po_10);
% disp('第10点的相角与极小值')
% disp(locs_pa_10),disp(pks_pa_10);
%
% %第11个点
% [a_11,b_11]=createFits(x11,y11,x12,y12);
% a_11{5,1}.a0;
% FUNCTION_11=a_11{5,1}.a0 + a_11{5,1}.a1*cos(x3*a_11{5,1}.w)+ a_11{5,1}.b1*sin(x3*a_11{5,1}.w) +a_11{5,1}.a2*cos(2*x3*a_11{5,1}.w) + a_11{5,1}.b2*sin(2*x3*a_11{5,1}.w);
% [pks_po_11,locs_po_11]=findpeaks(FUNCTION_11);
% [pks_pa_11,locs_pa_11]=findpeaks(-FUNCTION_11);
% % plot(FUNCTION_11);
% % hold on
% % plot(locs_po_11,pks_po_11,'o');
% % [pks_11,locs_11]=findpeaks(-FUNCTION_11);
% % plot(locs_pa_11,-pks_11,'*');
% % hold on;
% if length(pks_po_11)>1
% [pks_po_11,weizhi_max_11]=max(pks_po_11);
% locs_po_11=locs_po_11(weizhi_max_11);
% end
% if length(pks_pa_11)>1
% [pks_pa_11,weizhi_min_11]=min(-pks_pa_11);
% locs_pa_11=locs_pa_11(weizhi_min_11);
% else
% pks_pa_11=-pks_pa_11;
% end
% disp('第11点的相角与极大值')
% disp(locs_po_11),disp(pks_po_11);
% disp('第11点的相角与极小值')
% disp(locs_pa_11),disp(pks_pa_11);
%
% %第12个点
% [a_12,~]=createFits(x12,y12,x13,y13);
% a_12{5,1}.a0;
% FUNCTION_12=a_12{5,1}.a0 + a_12{5,1}.a1*cos(x3*a_12{5,1}.w)+ a_12{5,1}.b1*sin(x3*a_12{5,1}.w) +a_12{5,1}.a2*cos(2*x3*a_12{5,1}.w) + a_12{5,1}.b2*sin(2*x3*a_12{5,1}.w);
% [pks_po_12,locs_po_12]=findpeaks(FUNCTION_12);
% [pks_pa_12,locs_pa_12]=findpeaks(-FUNCTION_12);
% % plot(FUNCTION_12);
% % hold on
% % plot(locs_po_12,pks_po_12,'o');
% % [pks_12,~]=findpeaks(-FUNCTION_12);
% % plot(locs_pa_12,-pks_12,'*');
% % hold on;
% if length(pks_po_12)>1
% [pks_po_12,weizhi_max_12]=max(pks_po_12);
% locs_po_12=locs_po_12(weizhi_max_12);
% end
% if length(pks_pa_12)>1
% [pks_pa_12,weizhi_min_12]=min(-pks_pa_12);
% locs_pa_12=locs_pa_12(weizhi_min_12);
% else
% pks_pa_12=-pks_pa_12;
% end
% disp('第12点的相角与极大值')
% disp(locs_po_12),disp(pks_po_12);
% disp('第12点的相角与极小值')
% disp(locs_pa_12),disp(pks_pa_12);
%
% %第13个点
% [a_13,~]=createFits(x13,y13,x14,y14);
% a_13{5,1}.a0;
% FUNCTION_13=a_13{5,1}.a0 + a_13{5,1}.a1*cos(x3*a_13{5,1}.w)+ a_13{5,1}.b1*sin(x3*a_13{5,1}.w) +a_13{5,1}.a2*cos(2*x3*a_13{5,1}.w) + a_13{5,1}.b2*sin(2*x3*a_13{5,1}.w);
% [pks_po_13,locs_po_13]=findpeaks(FUNCTION_13);
% [pks_pa_13,locs_pa_13]=findpeaks(-FUNCTION_13);
% % plot(FUNCTION_13);
% % hold on
% % plot(locs_po_13,pks_po_13,'o');
% % [pks_13,~]=findpeaks(-FUNCTION_13);
% % plot(locs_pa_13,-pks_13,'*');
% % hold on;
% if length(pks_po_13)>1
% [pks_po_13,weizhi_max_13]=max(pks_po_13);
% locs_po_13=locs_po_13(weizhi_max_13);
% end
% if length(pks_pa_13)>1
% [pks_pa_13,weizhi_min_13]=min(-pks_pa_13);
% locs_pa_13=locs_pa_13(weizhi_min_13);
% else
% pks_pa_13=-pks_pa_13;
% end
% disp('第13点的相角与极大值')
% disp(locs_po_13),disp(pks_po_13);
% disp('第13点的相角与极小值')
% disp(locs_pa_13),disp(pks_pa_13);
%
% %第14个点
% [a_14,~]=createFits(x14,y14,x15,y15);
% a_14{5,1}.a0;
% FUNCTION_14=a_14{5,1}.a0 + a_14{5,1}.a1*cos(x3*a_14{5,1}.w)+ a_14{5,1}.b1*sin(x3*a_14{5,1}.w) +a_14{5,1}.a2*cos(2*x3*a_14{5,1}.w) + a_14{5,1}.b2*sin(2*x3*a_14{5,1}.w);
% [pks_po_14,locs_po_14]=findpeaks(FUNCTION_14);
% [pks_pa_14,locs_pa_14]=findpeaks(-FUNCTION_14);
% % plot(FUNCTION_14);
% % hold on
% % plot(locs_po_14,pks_po_14,'o');
% % [pks_14,~]=findpeaks(-FUNCTION_14);
% % plot(locs_pa_14,-pks_14,'*');
% % hold on;
% if length(pks_po_14)>1
% [pks_po_14,weizhi_max_14]=max(pks_po_14);
% locs_po_14=locs_po_14(weizhi_max_14);
% end
% if length(pks_pa_14)>1
% [pks_pa_14,weizhi_min_14]=min(-pks_pa_14);
% locs_pa_14=locs_pa_14(weizhi_min_14);
% else
% pks_pa_14=-pks_pa_14;
% end
% disp('第14点的相角与极大值')
% disp(locs_po_14),disp(pks_po_14);
% disp('第14点的相角与极小值')
% disp(locs_pa_14),disp(pks_pa_14);
%
% %第15个点
% [a_15,~]=createFits(x15,y15,x16,y16);
% a_15{5,1}.a0;
% FUNCTION_15=a_15{5,1}.a0 + a_15{5,1}.a1*cos(x3*a_15{5,1}.w)+ a_15{5,1}.b1*sin(x3*a_15{5,1}.w) +a_15{5,1}.a2*cos(2*x3*a_15{5,1}.w) + a_15{5,1}.b2*sin(2*x3*a_15{5,1}.w);
% [pks_po_15,locs_po_15]=findpeaks(FUNCTION_15);
% [pks_pa_15,locs_pa_15]=findpeaks(-FUNCTION_15);
% % plot(FUNCTION_15);
% % hold on
% % plot(locs_po_15,pks_po_15,'o');
% % [pks_15,~]=findpeaks(-FUNCTION_15);
% % plot(locs_pa_15,-pks_15,'*');
% % hold on;
% if length(pks_po_15)>1
% [pks_po_15,weizhi_max_15]=max(pks_po_15);
% locs_po_15=locs_po_15(weizhi_max_15);
% end
% if length(pks_pa_15)>1
% [pks_pa_15,weizhi_min_15]=min(-pks_pa_15);
% locs_pa_15=locs_pa_15(weizhi_min_15);
% else
% pks_pa_15=-pks_pa_15;
% end
% disp('第15点的相角与极大值')
% disp(locs_po_15),disp(pks_po_15);
% disp('第15点的相角与极小值')
% disp(locs_pa_15),disp(pks_pa_15);
%
% %第16个点
% [a_16,~]=createFits(x16,y16,x17,y17);
% a_16{5,1}.a0;
% FUNCTION_16=a_16{5,1}.a0 + a_16{5,1}.a1*cos(x3*a_16{5,1}.w)+ a_16{5,1}.b1*sin(x3*a_16{5,1}.w) +a_16{5,1}.a2*cos(2*x3*a_16{5,1}.w) + a_16{5,1}.b2*sin(2*x3*a_16{5,1}.w);
% [pks_po_16,locs_po_16]=findpeaks(FUNCTION_16);
% [pks_pa_16,locs_pa_16]=findpeaks(-FUNCTION_16);
% % plot(FUNCTION_16);
% % hold on
% % plot(locs_po_16,pks_po_16,'o');
% % [pks_1,~]=findpeaks(-FUNCTION_16);
% % plot(locs_pa_16,-pks_16,'*');
% % hold on;
% if length(pks_po_16)>1
% [pks_po_16,weizhi_max_16]=max(pks_po_16);
% locs_po_16=locs_po_16(weizhi_max_16);
% end
% if length(pks_pa_16)>1
% [pks_pa_16,weizhi_min_16]=min(-pks_pa_16);
% locs_pa_16=locs_pa_16(weizhi_min_16);
% else
% pks_pa_16=-pks_pa_16;
% end
% disp('第16点的相角与极大值')
% disp(locs_po_16),disp(pks_po_16);
% disp('第16点的相角与极小值')
% disp(locs_pa_16),disp(pks_pa_16);
%
% %第17个点
% [a_17,~]=createFits(x17,y17,x18,y18);
% a_17{5,1}.a0;
% FUNCTION_17=a_17{5,1}.a0 + a_17{5,1}.a1*cos(x3*a_17{5,1}.w)+ a_17{5,1}.b1*sin(x3*a_17{5,1}.w) +a_17{5,1}.a2*cos(2*x3*a_17{5,1}.w) + a_17{5,1}.b2*sin(2*x3*a_17{5,1}.w);
% [pks_po_17,locs_po_17]=findpeaks(FUNCTION_17);
% [pks_pa_17,locs_pa_17]=findpeaks(-FUNCTION_17);
% % plot(FUNCTION_17);
% % hold on
% % plot(locs_po_17,pks_po_17,'o');
% % [pks_17,~]=findpeaks(-FUNCTION_17);
% % plot(locs_pa_17,-pks_17,'*');
% % hold on;
% if length(pks_po_17)>1
% [pks_po_17,weizhi_max_17]=max(pks_po_17);
% locs_po_17=locs_po_17(weizhi_max_17);
% end
% if length(pks_pa_17)>1
% [pks_pa_17,weizhi_min_17]=min(-pks_pa_17);
% locs_pa_17=locs_pa_17(weizhi_min_17);
% else
% pks_pa_17=-pks_pa_17;
% end
% disp('第17点的相角与极大值')
% disp(locs_po_17),disp(pks_po_17);
% disp('第17点的相角与极小值')
% disp(locs_pa_17),disp(pks_pa_17);
%
% %第18个点
% [a_18,~]=createFits(x18,y18,x19,y19);
% a_18{5,1}.a0;
% FUNCTION_18=a_18{5,1}.a0 + a_18{5,1}.a1*cos(x3*a_18{5,1}.w)+ a_18{5,1}.b1*sin(x3*a_18{5,1}.w) +a_18{5,1}.a2*cos(2*x3*a_18{5,1}.w) + a_18{5,1}.b2*sin(2*x3*a_18{5,1}.w);
% [pks_po_18,locs_po_18]=findpeaks(FUNCTION_18);
% [pks_pa_18,locs_pa_18]=findpeaks(-FUNCTION_18);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_18)>1
% [pks_po_18,weizhi_max_18]=max(pks_po_18);
% locs_po_18=locs_po_18(weizhi_max_18);
% end
% if length(pks_pa_18)>1
% [pks_pa_18,weizhi_min_18]=min(-pks_pa_18);
% locs_pa_18=locs_pa_18(weizhi_min_18);
% else
% pks_pa_18=-pks_pa_18;
% end
% disp('第18点的相角与极大值')
% disp(locs_po_18),disp(pks_po_18);
% disp('第18点的相角与极小值')
% disp(locs_pa_18),disp(pks_pa_18);
%
% %第19个点
% [a_19,~]=createFits(x19,y19,x20,y20);
% a_19{5,1}.a0;
% FUNCTION_19=a_19{5,1}.a0 + a_19{5,1}.a1*cos(x3*a_19{5,1}.w)+ a_19{5,1}.b1*sin(x3*a_19{5,1}.w) +a_19{5,1}.a2*cos(2*x3*a_19{5,1}.w) + a_19{5,1}.b2*sin(2*x3*a_19{5,1}.w);
% [pks_po_19,locs_po_19]=findpeaks(FUNCTION_19);
% [pks_pa_19,locs_pa_19]=findpeaks(-FUNCTION_19);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_19)>1
% [pks_po_19,weizhi_max_19]=max(pks_po_19);
% locs_po_19=locs_po_19(weizhi_max_19);
% end
% if length(pks_pa_19)>1
% [pks_pa_19,weizhi_min_19]=min(-pks_pa_19);
% locs_pa_19=locs_pa_19(weizhi_min_19);
% else
% pks_pa_19=-pks_pa_19;
% end
% disp('第18点的相角与极大值')
% disp(locs_po_19),disp(pks_po_19);
% disp('第18点的相角与极小值')
% disp(locs_pa_19),disp(pks_pa_19);
%
% %第20个点
% [a_20,~]=createFits(x20,y20,x21,y21);
% a_20{5,1}.a0;
% FUNCTION_20=a_20{5,1}.a0 + a_20{5,1}.a1*cos(x3*a_20{5,1}.w)+ a_20{5,1}.b1*sin(x3*a_20{5,1}.w) +a_20{5,1}.a2*cos(2*x3*a_20{5,1}.w) + a_20{5,1}.b2*sin(2*x3*a_20{5,1}.w);
% [pks_po_20,locs_po_20]=findpeaks(FUNCTION_20);
% [pks_pa_20,locs_pa_20]=findpeaks(-FUNCTION_20);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_20)>1
% [pks_po_20,weizhi_max_20]=max(pks_po_20);
% locs_po_20=locs_po_20(weizhi_max_20);
% end
% if length(pks_pa_20)>1
% [pks_pa_20,weizhi_min_20]=min(-pks_pa_20);
% locs_pa_20=locs_pa_20(weizhi_min_20);
% else
% pks_pa_20=-pks_pa_20;
% end
% disp('第18点的相角与极大值')
% disp(locs_po_20),disp(pks_po_20);
% disp('第18点的相角与极小值')
% disp(locs_pa_20),disp(pks_pa_20);
%
% %第21个点
% [a_21,~]=createFits(x21,y21,x22,y22);
% a_21{5,1}.a0;
% FUNCTION_21=a_21{5,1}.a0 + a_21{5,1}.a1*cos(x3*a_21{5,1}.w)+ a_21{5,1}.b1*sin(x3*a_21{5,1}.w) +a_21{5,1}.a2*cos(2*x3*a_21{5,1}.w) + a_21{5,1}.b2*sin(2*x3*a_21{5,1}.w);
% [pks_po_21,locs_po_21]=findpeaks(FUNCTION_21);
% [pks_pa_21,locs_pa_21]=findpeaks(-FUNCTION_21);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_21)>1
% [pks_po_21,weizhi_max_21]=max(pks_po_21);
% locs_po_21=locs_po_21(weizhi_max_21);
% end
% if length(pks_pa_21)>1
% [pks_pa_21,weizhi_min_21]=min(-pks_pa_21);
% locs_pa_21=locs_pa_21(weizhi_min_21);
% else
% pks_pa_21=-pks_pa_21;
% end
% disp('第21点的相角与极大值')
% disp(locs_po_21),disp(pks_po_21);
% disp('第21点的相角与极小值')
% disp(locs_pa_21),disp(pks_pa_21);
%
% %第22个点
% [a_22,~]=createFits(x22,y22,x23,y23);
% a_22{5,1}.a0;
% FUNCTION_22=a_22{5,1}.a0 + a_22{5,1}.a1*cos(x3*a_22{5,1}.w)+ a_22{5,1}.b1*sin(x3*a_22{5,1}.w) +a_22{5,1}.a2*cos(2*x3*a_22{5,1}.w) + a_22{5,1}.b2*sin(2*x3*a_22{5,1}.w);
% [pks_po_22,locs_po_22]=findpeaks(FUNCTION_22);
% [pks_pa_22,locs_pa_22]=findpeaks(-FUNCTION_22);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_22)>1
% [pks_po_22,weizhi_max_22]=max(pks_po_22);
% locs_po_22=locs_po_22(weizhi_max_22);
% end
% if length(pks_pa_22)>1
% [pks_pa_22,weizhi_min_22]=min(-pks_pa_22);
% locs_pa_22=locs_pa_22(weizhi_min_22);
% else
% pks_pa_22=-pks_pa_22;
% end
% disp('第22点的相角与极大值')
% disp(locs_po_22),disp(pks_po_22);
% disp('第22点的相角与极小值')
% disp(locs_pa_22),disp(pks_pa_22);
%
% %第23个点
% [a_23,~]=createFits(x23,y23,x24,y24);
% a_23{5,1}.a0;
% FUNCTION_23=a_23{5,1}.a0 + a_23{5,1}.a1*cos(x3*a_23{5,1}.w)+ a_23{5,1}.b1*sin(x3*a_23{5,1}.w) +a_23{5,1}.a2*cos(2*x3*a_23{5,1}.w) + a_23{5,1}.b2*sin(2*x3*a_23{5,1}.w);
% [pks_po_23,locs_po_23]=findpeaks(FUNCTION_23);
% [pks_pa_23,locs_pa_23]=findpeaks(-FUNCTION_23);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_23)>1
% [pks_po_23,weizhi_max_23]=max(pks_po_23);
% locs_po_23=locs_po_23(weizhi_max_23);
% end
% if length(pks_pa_23)>1
% [pks_pa_23,weizhi_min_23]=min(-pks_pa_23);
% locs_pa_23=locs_pa_23(weizhi_min_23);
% else
% pks_pa_23=-pks_pa_23;
% end
% disp('第23点的相角与极大值')
% disp(locs_po_23),disp(pks_po_23);
% disp('第23点的相角与极小值')
% disp(locs_pa_23),disp(pks_pa_23);
%
% %第24个点
% [a_24,~]=createFits(x24,y24,x25,y25);
% a_24{5,1}.a0;
% FUNCTION_24=a_24{5,1}.a0 + a_24{5,1}.a1*cos(x3*a_24{5,1}.w)+ a_24{5,1}.b1*sin(x3*a_24{5,1}.w) +a_24{5,1}.a2*cos(2*x3*a_24{5,1}.w) + a_24{5,1}.b2*sin(2*x3*a_24{5,1}.w);
% [pks_po_24,locs_po_24]=findpeaks(FUNCTION_24);
% [pks_pa_24,locs_pa_24]=findpeaks(-FUNCTION_24);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_24)>1
% [pks_po_24,weizhi_max_24]=max(pks_po_24);
% locs_po_24=locs_po_24(weizhi_max_24);
% end
% if length(pks_pa_24)>1
% [pks_pa_24,weizhi_min_24]=min(-pks_pa_24);
% locs_pa_24=locs_pa_24(weizhi_min_24);
% else
% pks_pa_24=-pks_pa_24;
% end
% disp('第24点的相角与极大值')
% disp(locs_po_24),disp(pks_po_24);
% disp('第24点的相角与极小值')
% disp(locs_pa_24),disp(pks_pa_24);
%
% %第25个点
% [a_25,~]=createFits(x25,y25,x26,y26);
% a_25{5,1}.a0;
% FUNCTION_25=a_25{5,1}.a0 + a_25{5,1}.a1*cos(x3*a_25{5,1}.w)+ a_25{5,1}.b1*sin(x3*a_25{5,1}.w) +a_25{5,1}.a2*cos(2*x3*a_25{5,1}.w) + a_25{5,1}.b2*sin(2*x3*a_25{5,1}.w);
% [pks_po_25,locs_po_25]=findpeaks(FUNCTION_25);
% [pks_pa_25,locs_pa_25]=findpeaks(-FUNCTION_25);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_25)>1
% [pks_po_25,weizhi_max_25]=max(pks_po_25);
% locs_po_25=locs_po_25(weizhi_max_25);
% end
% if length(pks_pa_25)>1
% [pks_pa_25,weizhi_min_25]=min(-pks_pa_25);
% locs_pa_25=locs_pa_25(weizhi_min_25);
% else
% pks_pa_25=-pks_pa_25;
% end
% disp('第25点的相角与极大值')
% disp(locs_po_25),disp(pks_po_25);
% disp('第25点的相角与极小值')
% disp(locs_pa_25),disp(pks_pa_25);
%
% %第26个点
% [a_26,~]=createFits(x26,y26,x27,y27);
% a_26{5,1}.a0;
% FUNCTION_26=a_26{5,1}.a0 + a_26{5,1}.a1*cos(x3*a_26{5,1}.w)+ a_26{5,1}.b1*sin(x3*a_26{5,1}.w) +a_26{5,1}.a2*cos(2*x3*a_26{5,1}.w) + a_26{5,1}.b2*sin(2*x3*a_26{5,1}.w);
% [pks_po_26,locs_po_26]=findpeaks(FUNCTION_26);
% [pks_pa_26,locs_pa_26]=findpeaks(-FUNCTION_26);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_26)>1
% [pks_po_26,weizhi_max_26]=max(pks_po_26);
% locs_po_26=locs_po_26(weizhi_max_26);
% end
% if length(pks_pa_26)>1
% [pks_pa_26,weizhi_min_26]=min(-pks_pa_26);
% locs_pa_26=locs_pa_26(weizhi_min_26);
% else
% pks_pa_26=-pks_pa_26;
% end
% disp('第26点的相角与极大值')
% disp(locs_po_26),disp(pks_po_26);
% disp('第26点的相角与极小值')
% disp(locs_pa_26),disp(pks_pa_26);
%
% %第27个点
% [a_27,~]=createFits(x27,y27,x28,y28);
% a_27{5,1}.a0;
% FUNCTION_27=a_27{5,1}.a0 + a_27{5,1}.a1*cos(x3*a_27{5,1}.w)+ a_27{5,1}.b1*sin(x3*a_27{5,1}.w) +a_27{5,1}.a2*cos(2*x3*a_27{5,1}.w) + a_27{5,1}.b2*sin(2*x3*a_27{5,1}.w);
% [pks_po_27,locs_po_27]=findpeaks(FUNCTION_27);
% [pks_pa_27,locs_pa_27]=findpeaks(-FUNCTION_27);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_27)>1
% [pks_po_27,weizhi_max_27]=max(pks_po_27);
% locs_po_27=locs_po_27(weizhi_max_27);
% end
% if length(pks_pa_27)>1
% [pks_pa_27,weizhi_min_27]=min(-pks_pa_27);
% locs_pa_27=locs_pa_27(weizhi_min_27);
% else
% pks_pa_27=-pks_pa_27;
% end
% disp('第27点的相角与极大值')
% disp(locs_po_27),disp(pks_po_27);
% disp('第27点的相角与极小值')
% disp(locs_pa_27),disp(pks_pa_27);
%
% %第28个点
% [a_28,~]=createFits(x28,y28,x29,y29);
% a_28{5,1}.a0;
% FUNCTION_28=a_28{5,1}.a0 + a_28{5,1}.a1*cos(x3*a_28{5,1}.w)+ a_28{5,1}.b1*sin(x3*a_28{5,1}.w) +a_28{5,1}.a2*cos(2*x3*a_28{5,1}.w) + a_28{5,1}.b2*sin(2*x3*a_28{5,1}.w);
% [pks_po_28,locs_po_28]=findpeaks(FUNCTION_28);
% [pks_pa_28,locs_pa_28]=findpeaks(-FUNCTION_28);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_28)>1
% [pks_po_28,weizhi_max_28]=max(pks_po_28);
% locs_po_28=locs_po_28(weizhi_max_28);
% end
% if length(pks_pa_28)>1
% [pks_pa_28,weizhi_min_28]=min(-pks_pa_28);
% locs_pa_28=locs_pa_28(weizhi_min_28);
% else
% pks_pa_28=-pks_pa_28;
% end
% disp('第28点的相角与极大值')
% disp(locs_po_28),disp(pks_po_28);
% disp('第28点的相角与极小值')
% disp(locs_pa_28),disp(pks_pa_28);
%
% %第29个点
% [a_29,~]=createFits(x29,y29,x30,y30);
% a_29{5,1}.a0;
% FUNCTION_29=a_29{5,1}.a0 + a_29{5,1}.a1*cos(x3*a_29{5,1}.w)+ a_29{5,1}.b1*sin(x3*a_29{5,1}.w) +a_29{5,1}.a2*cos(2*x3*a_29{5,1}.w) + a_29{5,1}.b2*sin(2*x3*a_29{5,1}.w);
% [pks_po_29,locs_po_29]=findpeaks(FUNCTION_29);
% [pks_pa_29,locs_pa_29]=findpeaks(-FUNCTION_29);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_29)>1
% [pks_po_29,weizhi_max_29]=max(pks_po_29);
% locs_po_29=locs_po_29(weizhi_max_29);
% end
% if length(pks_pa_29)>1
% [pks_pa_29,weizhi_min_29]=min(-pks_pa_29);
% locs_pa_29=locs_pa_29(weizhi_min_29);
% else
% pks_pa_29=-pks_pa_29;
% end
% disp('第29点的相角与极大值')
% disp(locs_po_29),disp(pks_po_29);
% disp('第29点的相角与极小值')
% disp(locs_pa_29),disp(pks_pa_29);
%
% %第30个点
% [a_30,~]=createFits(x30,y30,x31,y31);
% a_30{5,1}.a0;
% FUNCTION_30=a_30{5,1}.a0 + a_30{5,1}.a1*cos(x3*a_30{5,1}.w)+ a_30{5,1}.b1*sin(x3*a_30{5,1}.w) +a_30{5,1}.a2*cos(2*x3*a_30{5,1}.w) + a_30{5,1}.b2*sin(2*x3*a_30{5,1}.w);
% [pks_po_30,locs_po_30]=findpeaks(FUNCTION_30);
% [pks_pa_30,locs_pa_30]=findpeaks(-FUNCTION_30);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_30)>1
% [pks_po_30,weizhi_max_30]=max(pks_po_30);
% locs_po_30=locs_po_30(weizhi_max_30);
% end
% if length(pks_pa_30)>1
% [pks_pa_30,weizhi_min_30]=min(-pks_pa_30);
% locs_pa_30=locs_pa_30(weizhi_min_30);
% else
% pks_pa_30=-pks_pa_30;
% end
% disp('第30点的相角与极大值')
% disp(locs_po_30),disp(pks_po_30);
% disp('第30点的相角与极小值')
% disp(locs_pa_30),disp(pks_pa_30);
%
% %第31个点
% [a_31,~]=createFits(x31,y31,x32,y32);
% a_31{5,1}.a0;
% FUNCTION_31=a_31{5,1}.a0 + a_31{5,1}.a1*cos(x3*a_31{5,1}.w)+ a_31{5,1}.b1*sin(x3*a_31{5,1}.w) +a_31{5,1}.a2*cos(2*x3*a_31{5,1}.w) + a_31{5,1}.b2*sin(2*x3*a_31{5,1}.w);
% [pks_po_31,locs_po_31]=findpeaks(FUNCTION_31);
% [pks_pa_31,locs_pa_31]=findpeaks(-FUNCTION_31);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_31)>1
% [pks_po_31,weizhi_max_31]=max(pks_po_31);
% locs_po_31=locs_po_31(weizhi_max_31);
% end
% if length(pks_pa_31)>1
% [pks_pa_31,weizhi_min_31]=min(-pks_pa_31);
% locs_pa_31=locs_pa_31(weizhi_min_31);
% else
% pks_pa_31=-pks_pa_31;
% end
% disp('第31点的相角与极大值')
% disp(locs_po_31),disp(pks_po_31);
% disp('第31点的相角与极小值')
% disp(locs_pa_31),disp(pks_pa_31);
%
%
% %第32个点
% [a_32,~]=createFits(x32,y32,x33,y33);
% a_32{5,1}.a0;
% FUNCTION_32=a_32{5,1}.a0 + a_32{5,1}.a1*cos(x3*a_32{5,1}.w)+ a_32{5,1}.b1*sin(x3*a_32{5,1}.w) +a_32{5,1}.a2*cos(2*x3*a_32{5,1}.w) + a_32{5,1}.b2*sin(2*x3*a_32{5,1}.w);
% [pks_po_32,locs_po_32]=findpeaks(FUNCTION_32);
% [pks_pa_32,locs_pa_32]=findpeaks(-FUNCTION_32);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_32)>1
% [pks_po_32,weizhi_max_32]=max(pks_po_32);
% locs_po_32=locs_po_32(weizhi_max_32);
% end
% if length(pks_pa_32)>1
% [pks_pa_32,weizhi_min_32]=min(-pks_pa_32);
% locs_pa_32=locs_pa_32(weizhi_min_32);
% else
% pks_pa_32=-pks_pa_32;
% end
% disp('第32点的相角与极大值')
% disp(locs_po_32),disp(pks_po_32);
% disp('第32点的相角与极小值')
% disp(locs_pa_32),disp(pks_pa_32);
%
% %第33个点
% [a_33,~]=createFits(x33,y33,x34,y34);
% a_33{5,1}.a0;
% FUNCTION_33=a_33{5,1}.a0 + a_33{5,1}.a1*cos(x3*a_33{5,1}.w)+ a_33{5,1}.b1*sin(x3*a_33{5,1}.w) +a_33{5,1}.a2*cos(2*x3*a_33{5,1}.w) + a_33{5,1}.b2*sin(2*x3*a_33{5,1}.w);
% [pks_po_33,locs_po_33]=findpeaks(FUNCTION_33);
% [pks_pa_33,locs_pa_33]=findpeaks(-FUNCTION_33);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_33)>1
% [pks_po_33,weizhi_max_33]=max(pks_po_33);
% locs_po_33=locs_po_33(weizhi_max_33);
% end
% if length(pks_pa_33)>1
% [pks_pa_33,weizhi_min_33]=min(-pks_pa_33);
% locs_pa_33=locs_pa_33(weizhi_min_33);
% else
% pks_pa_33=-pks_pa_33;
% end
% disp('第33点的相角与极大值')
% disp(locs_po_33),disp(pks_po_33);
% disp('第33点的相角与极小值')
% disp(locs_pa_33),disp(pks_pa_33);
%
% %第34个点
% [a_34,~]=createFits(x34,y34,x35,y35);
% a_34{5,1}.a0;
% FUNCTION_34=a_34{5,1}.a0 + a_34{5,1}.a1*cos(x3*a_34{5,1}.w)+ a_34{5,1}.b1*sin(x3*a_34{5,1}.w) +a_34{5,1}.a2*cos(2*x3*a_34{5,1}.w) + a_34{5,1}.b2*sin(2*x3*a_34{5,1}.w);
% [pks_po_34,locs_po_34]=findpeaks(FUNCTION_34);
% [pks_pa_34,locs_pa_34]=findpeaks(-FUNCTION_34);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_34)>1
% [pks_po_34,weizhi_max_34]=max(pks_po_34);
% locs_po_34=locs_po_34(weizhi_max_34);
% end
% if length(pks_pa_34)>1
% [pks_pa_34,weizhi_min_34]=min(-pks_pa_34);
% locs_pa_34=locs_pa_34(weizhi_min_34);
% else
% pks_pa_34=-pks_pa_34;
% end
% disp('第34点的相角与极大值')
% disp(locs_po_34),disp(pks_po_34);
% disp('第34点的相角与极小值')
% disp(locs_pa_34),disp(pks_pa_34);
%
% %第35个点
% [a_35,~]=createFits(x35,y35,x36,y36);
% a_35{5,1}.a0;
% FUNCTION_35=a_35{5,1}.a0 + a_35{5,1}.a1*cos(x3*a_35{5,1}.w)+ a_35{5,1}.b1*sin(x3*a_35{5,1}.w) +a_35{5,1}.a2*cos(2*x3*a_35{5,1}.w) + a_35{5,1}.b2*sin(2*x3*a_35{5,1}.w);
% [pks_po_35,locs_po_35]=findpeaks(FUNCTION_35);
% [pks_pa_35,locs_pa_35]=findpeaks(-FUNCTION_35);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_35)>1
% [pks_po_35,weizhi_max_35]=max(pks_po_35);
% locs_po_35=locs_po_35(weizhi_max_35);
% end
% if length(pks_pa_35)>1
% [pks_pa_35,weizhi_min_35]=min(-pks_pa_35);
% locs_pa_35=locs_pa_35(weizhi_min_35);
% else
% pks_pa_35=-pks_pa_35;
% end
% disp('第35点的相角与极大值')
% disp(locs_po_35),disp(pks_po_35);
% disp('第35点的相角与极小值')
% disp(locs_pa_35),disp(pks_pa_35);
%
% %第36个点
% [a_36,~]=createFits(x36,y36,x37,y37);
% a_36{5,1}.a0;
% FUNCTION_36=a_36{5,1}.a0 + a_36{5,1}.a1*cos(x3*a_36{5,1}.w)+ a_36{5,1}.b1*sin(x3*a_36{5,1}.w) +a_36{5,1}.a2*cos(2*x3*a_36{5,1}.w) + a_36{5,1}.b2*sin(2*x3*a_36{5,1}.w);
% [pks_po_36,locs_po_36]=findpeaks(FUNCTION_36);
% [pks_pa_36,locs_pa_36]=findpeaks(-FUNCTION_36);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_36)>1
% [pks_po_36,weizhi_max_36]=max(pks_po_36);
% locs_po_36=locs_po_36(weizhi_max_36);
% end
% if length(pks_pa_36)>1
% [pks_pa_36,weizhi_min_36]=min(-pks_pa_36);
% locs_pa_36=locs_pa_36(weizhi_min_36);
% else
% pks_pa_36=-pks_pa_36;
% end
% disp('第36点的相角与极大值')
% disp(locs_po_36),disp(pks_po_36);
% disp('第36点的相角与极小值')
% disp(locs_pa_36),disp(pks_pa_36);
%
% %第37个点
% [a_37,~]=createFits(x37,y37,x38,y38);
% a_37{5,1}.a0;
% FUNCTION_37=a_37{5,1}.a0 + a_37{5,1}.a1*cos(x3*a_37{5,1}.w)+ a_37{5,1}.b1*sin(x3*a_37{5,1}.w) +a_37{5,1}.a2*cos(2*x3*a_37{5,1}.w) + a_37{5,1}.b2*sin(2*x3*a_37{5,1}.w);
% [pks_po_37,locs_po_37]=findpeaks(FUNCTION_37);
% [pks_pa_37,locs_pa_37]=findpeaks(-FUNCTION_37);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_37)>1
% [pks_po_37,weizhi_max_37]=max(pks_po_37);
% locs_po_37=locs_po_37(weizhi_max_37);
% end
% if length(pks_pa_37)>1
% [pks_pa_37,weizhi_min_37]=min(-pks_pa_37);
% locs_pa_37=locs_pa_37(weizhi_min_37);
% else
% pks_pa_37=-pks_pa_37;
% end
% disp('第37点的相角与极大值')
% disp(locs_po_37),disp(pks_po_37);
% disp('第37点的相角与极小值')
% disp(locs_pa_37),disp(pks_pa_37);
%
% %第38个点
% [a_38,~]=createFits(x38,y38,x39,y39);
% a_38{5,1}.a0;
% FUNCTION_38=a_38{5,1}.a0 + a_38{5,1}.a1*cos(x3*a_38{5,1}.w)+ a_38{5,1}.b1*sin(x3*a_38{5,1}.w) +a_38{5,1}.a2*cos(2*x3*a_38{5,1}.w) + a_38{5,1}.b2*sin(2*x3*a_38{5,1}.w);
% [pks_po_38,locs_po_38]=findpeaks(FUNCTION_38);
% [pks_pa_38,locs_pa_38]=findpeaks(-FUNCTION_38);
% % plot(FUNCTION_18);
% % hold on
% % plot(locs_po_18,pks_po_18,'o');
% % [pks_18,~]=findpeaks(-FUNCTION_18);
% % plot(locs_pa_18,-pks_18,'*');
% % hold on;
% if length(pks_po_38)>1
% [pks_po_38,weizhi_max_38]=max(pks_po_38);
% locs_po_38=locs_po_38(weizhi_max_38);
% end
% if length(pks_pa_38)>1
% [pks_pa_38,weizhi_min_38]=min(-pks_pa_38);
% locs_pa_38=locs_pa_38(weizhi_min_38);
% else
% pks_pa_38=-pks_pa_38;
% end
% disp('第38点的相角与极大值')
% disp(locs_po_38),disp(pks_po_38);
% disp('第38点的相角与极小值')
% disp(locs_pa_38),disp(pks_pa_38);
%
% 第39个点
% [a_39,~]=createFits(x39,y39,x1,y1);
% a_39{5,1}.a0;
% FUNCTION_39=a_39{5,1}.a0 + a_39{5,1}.a1*cos(x3*a_39{5,1}.w)+ a_39{5,1}.b1*sin(x3*a_39{5,1}.w) +a_39{5,1}.a2*cos(2*x3*a_39{5,1}.w) + a_39{5,1}.b2*sin(2*x3*a_39{5,1}.w);
% [pks_po_39,locs_po_39]=findpeaks(FUNCTION_39);
% [pks_pa_39,locs_pa_39]=findpeaks(-FUNCTION_39);
% plot(FUNCTION_18);
% hold on
% plot(locs_po_18,pks_po_18,'o');
% [pks_18,~]=findpeaks(-FUNCTION_18);
% plot(locs_pa_18,-pks_18,'*');
% hold on;
% if length(pks_po_39)>1
% [pks_po_39,weizhi_max_39]=max(pks_po_39);
% locs_po_39=locs_po_39(weizhi_max_39);
% end
% if length(pks_pa_39)>1
% [pks_pa_39,weizhi_min_39]=min(-pks_pa_39);
% locs_pa_39=locs_pa_39(weizhi_min_39);
% else
% pks_pa_39=-pks_pa_39;
% end
% disp('第38点的相角与极大值')
% disp(locs_po_39),disp(pks_po_39);
% disp('第38点的相角与极小值')
% disp(locs_pa_39),disp(pks_pa_39);

%% %至此，上面第一步已经完成，输出了每个点的极值以及相位；
locs_pa=[locs_pa_1,locs_pa_2,locs_pa_3,%locs_pa_4,locs_pa_5,locs_pa_6,locs_pa_7,locs_pa_8,locs_pa_9,locs_pa_10,...
% locs_pa_11,locs_pa_12,locs_pa_13,locs_pa_14,locs_pa_15,locs_pa_16,locs_pa_17,locs_pa_18,locs_pa_19,locs_pa_20,...
% locs_pa_21,locs_pa_22,locs_pa_23,locs_pa_24,locs_pa_25,locs_pa_26,locs_pa_27,locs_pa_28,locs_pa_19,locs_pa_30,...
% locs_pa_31,locs_pa_32,locs_pa_33,locs_pa_34,locs_pa_35,locs_pa_36,locs_pa_37,locs_pa_38,locs_pa_39
];
pks_pa=[pks_pa_1,pks_pa_2,pks_pa_3%,pks_pa_4,pks_pa_5,pks_pa_6,pks_pa_7,pks_pa_8,pks_pa_9,pks_pa_10,...
% pks_pa_11,pks_pa_12,pks_pa_13,pks_pa_14,pks_pa_15,pks_pa_16,pks_pa_17,pks_pa_18,pks_pa_19,pks_pa_20,...
% pks_pa_21,pks_pa_22,pks_pa_23,pks_pa_24,pks_pa_25,pks_pa_26,pks_pa_27,pks_pa_28,pks_pa_29,pks_pa_30,...
% pks_pa_31,pks_pa_32,pks_pa_33,pks_pa_34,pks_pa_35,pks_pa_36,pks_pa_37,pks_pa_38,pks_pa_39
];
pks_po=[pks_po_1,pks_po_2,pks_po_3
% ,pks_po_4,pks_po_5,pks_po_6,pks_po_7,pks_po_8,pks_po_9,pks_po_10,...
% pks_po_11,pks_po_12,pks_po_13,pks_po_14,pks_po_15,pks_po_16,pks_po_17,pks_po_18,pks_po_19,pks_po_20,...
% pks_po_21,pks_po_22,pks_po_23,pks_po_24,pks_po_25,pks_po_26,pks_po_27,pks_po28,pks_po_29,pks_po_30,...
% pks_po_31,pks_po_32,pks_po_33,pks_po_34,pks_po_35,pks_po_36,pks_po_37,pks_po_38,pks_po_39
];
%铁片
% for i=2:2:38
% if pks_po(i)-pks_pa(i)<0.08
% disp(i);
% disp('该点不用处理');
% else
% hight=pks_pa(i)-(pks_pa(i-1)+pks_pa(i+1))/2;
% if hight>0
% disp('下压点为');
% disp(i);
% disp('下压点的旋转角度为')
% disp(locs_pa(i));
% disp('下压量为');
% disp(hight);
% else
% disp('下压点为');
% disp(i);
% disp('下压点的旋转角度为')
% theta=locs_pa(i)+180;
% disp(mod(theta,360));
% disp('下压量为');
% disp(-hight);
% end
% end
% end
%铜片
for i=2:1:2
if pks_po(i)-pks_pa(i)<0.05
disp(i);
disp('该点不用处理');
else
hight=pks_pa(i)-(pks_pa(i-1)+pks_pa(i+1))/2;
if hight>0
disp('下压点为');
disp(i);
disp('下压点的旋转角度为')
disp(locs_pa(i));
disp('下压量为');
disp(hight);
else
disp('下压点为');
disp(i);
disp('下压点的旋转角度为')
theta=locs_pa(i)+180;
disp(mod(theta,360));
disp('下压量为');
disp(-hight);
end
end
end

%%
function [fitresult, gof] = createFits(x1, y1, x2, y2)
% 初始化.
% 初始化数组以存储拟合度和拟合优度。
fitresult = cell( 5, 1 );
gof = struct( 'sse', cell( 5, 1 ), ...
'rsquare', [], 'dfe', [], 'adjrsquare', [], 'rmse', [] );

[xData, yData] = prepareCurveData( x1, y1 );
ft = fittype( 'fourier2' );
opts = fitoptions( 'Method', 'NonlinearLeastSquares' );
opts.Display = 'Off';
opts.Robust = 'Bisquare';
opts.StartPoint = [0 0 0 0 0 0.017459112224018];
[fitresult{5}, gof(5)] = fit( xData, yData, ft, opts );
% figure( 'Name', 'untitled fit 5' );
% h = plot( fitresult{5}, xData, yData );
% legend( h, 'y1 vs. x1', 'untitled fit 5', 'Location', 'NorthEast', 'Interpreter', 'none' );
% % Label axes
% xlabel( 'x1', 'Interpreter', 'none' );
% ylabel( 'y1', 'Interpreter', 'none' );
% grid on
end

qq_43519163

关注

0
点赞
踩
0

收藏

觉得还不错? 一键收藏
0
评论
大唐直轴（三十九个点的）

% disp('第10点的相角与极大值')% % disp('第10点的相角与极小值')% % disp('第11点的相角与极大值')% % disp('第11点的相角与极小值')% % disp('第12点的相角与极大值')% % disp('第12点的相角与极小值')% % disp('第13点的相角与极大值')% % disp('第13点的相角与极小值')% % disp('第14点的相角与极小值')% % disp('第15点的相角与极大值')% % disp('第15点的相角与极小值')
复制链接

扫一扫