clc;
clear;
b_=1;
mn=3,z1=20,z2=38; %beta=12°,x1=0.6916,x2=0.2417
bi= 0.206318789944276 ; %接触半宽标量
Rp=mn*z1/2; % mm
Rg=mn*z2/2;
mp=1.5;
mg=(Rg^2/Rp^2)*mp;
Ip=1/2*mp*Rp^2; %小齿轮的转惯量
Ig=1/2*mg*Rg^2; %大齿轮的转动惯量
me=Ip*Ig/(Ip*Rg^2+Ig*Rp^2);
km=1.8349*10^6; %平均刚度
Tp=400; %小齿轮的输入转矩 N.M
fm=Tp/(Rp*0.001); %静态载荷
wn=sqrt(km/me);
T=2*pi/wn;
tspan=[0:T/1000:100*T];
kt=[0:T/1000:100*T];
k=1.8416e6-6.9053e4*cos((pi/10)*kt)-1.7962e5*sin((pi/10)*kt)+1.6784e4*cos(2*(pi/10)*kt)...
-3.2974e4*sin(2*(pi/10)*kt)-1.8323e4*cos(3*(pi/10)*kt)-1.1395e4*sin(3*(pi/10)*kt)...
-5.9408e3*cos(4*(pi/10)*kt)-1.9008e4*sin(4*(pi/10)*kt)+-3.1577e3*cos