%~~~~~~~~~~~~~導(dǎo)入數(shù)據(jù)~~~~~~~~~~~~~%
clc
clear
Fs=71680;
N=Fs*5;
t=（0:N-1）/Fs;
Adc?=?1;?%直流分量幅度
%?S=sin（2*pi*t.^2-?pi/6）+sin（4*pi*t.^2-?pi/6）+sin（8*pi*t.^2-?pi/6）
%?S2=Adc+?sin（2*pi*?t.^2-?pi/6）;%參考軸的轉(zhuǎn)速為n（t）=60t?r/min

S=sin（2*pi*t.^2）+sin（4*pi*t.^2）+sin（8*pi*t.^2）;
S2=Adc+?sin（2*pi*?t.^2）;


array_time_amp=S;????%導(dǎo)入時(shí)域振動(dòng)信號(hào)
pluse=S2;?????????????%導(dǎo)入脈沖信號(hào)
figure（1）;
%?subplot（211）plot（tarray_time_amp）title（‘time?dominant振動(dòng)信號(hào)時(shí)域圖‘）xlabel（‘時(shí)間time‘）ylabel（‘幅值amplitude‘）;
subplot（211）plot（tarray_time_amp）title（‘變轉(zhuǎn)速數(shù)據(jù)‘）xlabel（‘時(shí)間time‘）ylabel（‘幅值amplitude‘）;
grid?on;
%?subplot（212）plot（tpluse）title（‘keyphasor鍵相脈沖仿真信號(hào)時(shí)域圖‘）xlabel（‘時(shí)間time‘）ylabel（‘幅值amplitude‘）;
subplot（212）plot（tpluse）title（‘轉(zhuǎn)速脈沖‘）xlabel（‘時(shí)間time‘）ylabel（‘幅值amplitude‘）;
grid?on;


%?%~~~~~~~~~~~~~~~計(jì)算脈沖發(fā)生時(shí)刻~~~~~~~~~~~~~~~%
%?Num_pluse1=1;
Num_pluse1=[];
Threshold=1.5;%設(shè)定脈沖閾值
for?temp2=1:length（pluse）-1;%設(shè)temp2為步長(zhǎng)為1的[12.....n-1]n-1維數(shù)組；即將所有的采樣點(diǎn)編號(hào)；length函數(shù)功能是返回pluse的數(shù)組維數(shù)；for循環(huán)體循環(huán)n-1次，再結(jié)束。
%?????for?temp2=1:length（pluse）-1;
????if（pluse（temp2）<1.5&&pluse（temp2+1）>=1.5）
?????????????Num_pluse1=[?Num_pluse1temp2+1];%Num_pluse1=[121967.....temp（2+1）]
????end
end
?Num_pluse1=Num_pluse1（1:length（Num_pluse1））;
if?length（Num_pluse1）<2returnend;%如果脈沖信號(hào)就一個(gè)數(shù)則跳出計(jì)算脈沖發(fā)生時(shí)刻的函數(shù)
?t_pluse=（Num_pluse1-1）/Fs;%
%?
%?
%?
%?
%~~~~~~~~~~~~~~~等角度時(shí)間計(jì)算~~~~~~~~~~~~~~~~%
delt_thet=pi/24;
t_angle=[];
for?temp3=3:length（t_pluse）;
b=inv（[1t_pluse（temp3-2）t_pluse（temp3-2）^2;1t_pluse（temp3-1）t_pluse（temp3-1）^2;1t_pluse（temp3）t_pluse（temp3）^2]）*[02*pi4*pi]‘;
????if?temp3==3;%（如果數(shù)temp3等于3則執(zhí)行第一個(gè)循環(huán)，如果temp3不等于3則執(zhí)行第二個(gè)循環(huán)，即在脈沖時(shí)刻[tt0tt3]執(zhí)行第一個(gè)循環(huán)，等角度時(shí)刻記到[t1，t72]）
???????k=0;
???????????while?k<1.5*2*pi/delt_thet;%0??????????????????tt=（sqrt（4*b（3）*（k*delt_thet-b（1））+b（2）^2）-b（2））/（2*（b（3）+eps））;
??????????????????t_angle=[t_anglett];
??????????????????k=k+1;
????????????end
????else
????????k=pi/delt_thet;%k=24（如果temp3不等于3則執(zhí)行第二個(gè)循環(huán)，即在脈沖時(shí)刻[tt1tt4].......[tt13tt16]執(zhí)行第二個(gè)循環(huán)，等角度時(shí)刻記到[t72，t120]，[t120t168]........[t648t696]））
????????????while?k>=pi/delt_thet?&&?k<1.5*2*pi/delt_thet;%?24????????????????tt=（sqrt（4*b（3）*（k*delt_thet-b（1））+b（2）^2）-b（2））/（2*（b（3）+eps））;
????????????????t_angle=[t_anglett];
????????????????k=k+1;
????????????end
????end
end
a