r1=12.564;%半径
ae=16;%切削宽度
tk=3.1722;%切入时间
n=760;%转速
l=100;%悬伸
t=3.1:0.0002:3.4;%切削时间
w=4560;%转速
x=t;%振动位移公式所对应时间
a1 = 0.0007306
b1 = 423
c1 = -14.97
a2 = 0.0006607
b2 = 213.2
c2 = -14.71
a3 = 0.0008034
b3 = 408.8
c3 = -36.86
a4 = 0.0007284
b4 = 201.5
c4 = -44.31
a5 = 0.0001277
b5 = 269.4
c5 = 9.191
a6 = 2.929e-05
b6 = 226.3
c6 = 11.8
a7 = 4.838e-05
b7 = 365.9
c7 = 0.9131
a8 = 0.0001067
b8 = 350.2
c8 = 16.77
Ax= a1*sin(b1*x+c1) + a2*sin(b2*x+c2) + a3*sin(b3*x+c3) + a4*sin(b4*x+c4) + a5*sin(b5*x+c5) + a6*sin(b6*x+c6) + a7*sin(b7*x+c7) + a8*sin(b8*x+c8);%x方向振动位移
a11 = 0.0005841
b11 = 421
c11 = -4.726
a21 = 0.0005188
b21 = 210
c21 = -0.3359
a31 = 0.0004947
b31 = 407.3
c31 = -27.93
a41 = 0.0005465
b41 = 198.4
c41 = -30.19
a51 = 0.0001935
b51 = 621.9
c51 = 22.16
a61 = 7.375e-05
b61 = 274.6
c61 = -4.914
a71 = 8.769e-05
b71 = 175.1
c71 = -25.76
a81 = -1.061e-06
b81 = 394.3
c81 = -57.47
Ay = a11*sin(b11*x+c11) + a21*sin(b21*x+c21) + a31*sin(b31*x+c31) + a41*sin(b41*x+c41) + a51*sin(b51*x+c51) + a61*sin(b61*x+c61) + a71*sin(b71*x+c71) + a81*sin(b81*x+c81);%y方向振动位移
a111 = 0.0002761
b111 = 417.1
c111 = 4.844
a211 = 0.0002121
b211 = 192.6
c211 = -12.44
a311 = 0.0001672
b311 = 208.2
c311 = 4.301
a411 = 0.0002142
b411 = 407.8
c411 = -31.96
a511 = 0.0001009
b511 = 633.8
c511 = -20
a611 = 7.181e-05
b611 = 150.5
c611 = -15.3
a711 = 4.557e-05
b711 = 481.9
c711 = -0.6223
a811 = 9.574e-05
b811 = 614.9
c811 = -27.14
Az = a111*sin(b111*x+c111) + a211*sin(b211*x+c211) + a311*sin(b311*x+c311) + a411*sin(b411*x+c411) + a511*sin(b511*x+c511) + a611*sin(b611*x+c611) + a711*sin(b711*x+c711) + a811*sin(b811*x+c811); %x方向振动位移
fx1=pi/2-asin(ae-r1-Ay);
fx2=fx1-w*tk+floor((w*tk)/(2*pi));
fx3=fx2+w*t-floor((fx2+w*tk)/(2*pi));
test=sqrt(Ax.^2+Ay.^2);
test1=l-Az;
fx4=atan(test/test1);
plot(fx3,fx4)
grid on