function f = NewMyModel(t,y)
syms w;
% ====================== 基本参数 ==================================================
Cw = 0.07; Cn = 0.1; % 阻尼比?
Jr = 54151.73; % 叶轮与轮毂 单位 kg.m^2
Jg = 280.50; % 电机与制动盘
K1 = 5.356e+7; % 低速轴 单位 N.m/rad
K2 = 4.205e+7; % 中速轴
K3 = 4.601e+04; % 高速轴4.601e+4
C1 = 20000; C2 = 20000; C3 = 200000;
a = cos(20*pi/180); % cos(20°)
% ======================= 第一级行星轮? ================================================
Rc1 = 0.4; %行星架 m
Rp11 = 0.22553; Rp12 = 0.22553; Rp13 = 0.22553; % 行星轮基圆半径?
Rs1 = 0.14565; % 太阳轮基圆半径
Krp11 = 1.5e8; Krp12 =1.5e8; Krp13 = 1.5e8; % 内啮合刚度
Ksp11 = 1.0e8; Ksp12 =1.0e8; Ksp13 = 1.0e8; % 外啮合刚度
% 外啮合阻尼
Csp11 = 2*Cw*sqrt(Ksp11/(1/318.452+1/294.520));
Csp12 = 2*Cw*sqrt(Ksp12/(1/318.452+1/294.520));
Csp13 = 2*Cw*sqrt(Ksp13/(1/318.452+1/294.520));
% 外啮合
Crp11 = 2*Cn*sqrt(Krp11/(1/1504.804+1/294.520));
Crp12 = 2*Cn*sqrt(Krp12/(1/1504.804+1/294.520));
Crp13 = 2*Cn*sqrt(Krp13/(1/1504.804+1/294.520));
Jc1 = 531.443; % 行星架与行星轮等效惯量357.262 + 3* 294.520 * (0.4^2)
Jp11 = 12.105; Jp12 = 12.105; Jp13 = 12.105; % 行星轮
Js1 = 23.747; % 太阳轮?
% ====================== 第二级行星轮 =================================================
Rc2 = 0.231;
Rp21 = 0.217069/2; Rp22 = 0.217069/2; Rp23 = 0.217069/2;
Rs2 = 0.222237/2;
Krp21 =6e7; Krp22 = 6e7; Krp23 =6e7;
Ksp21 = 5.5e7; Ksp22 = 5.5e7; Ksp23 = 5.5e7;
Csp21 = 2*Cw*sqrt(Ksp21/(1/318.452+1/294.520));
Csp22 = 2*Cw*sqrt(Ksp22/(1/318.452+1/294.520));
Csp23 = 2*Cw*sqrt(Ksp23/(1/318.452+1/294.520));
Crp21 = 2*Cn*sqrt(Krp21/(1/1504.804+1/294.520));
Crp22 = 2*Cn*sqrt(Krp22/(1/1504.804+1/294.520));
Crp23 = 2*Cn*sqrt(Krp23/(1/1504.804+1/294.520));
Jc2 = 28.89 + 3 * 31.33*(0.231^2);
Jp21 = 0.32; Jp22 = 0.32; Jp23 = 0.32;
Js2 = 1.85;
% 转动惯量矩阵
J = [Jr 0 0 0 0 0 0 0 0 0 0 0;
0 Jc1 0 0 0 0 0 0 0 0 0 0;
0 0 Jp11 0 0 0 0 0 0 0 0 0;
0 0 0 Jp12 0 0 0 0 0 0 0 0;
0 0 0 0 Jp13 0 0 0 0 0 0 0;
0 0 0 0 0 Js1 0 0 0 0 0 0;
0 0 0 0 0 0 Jc2 0 0 0 0 0;
0 0 0 0 0 0 0 Jp21 0 0 0 0;
0 0 0 0 0 0 0 0 Jp22 0 0 0;
0 0 0 0 0 0 0 0 0 Jp23 0 0;
0 0 0 0 0 0 0 0 0 0 Js2 0;
0 0 0 0 0 0 0 0 0 0 0 Jg
];
% 刚度矩阵
%(1)
K0101 = K1; K0102 = -K1; K0103 = 0; K0104 = 0; K0105 = 0; K0106 = 0; K0107 = 0;
K0108 = 0; K0109 = 0; K0110 = 0; K0111 = 0; K0112= 0;
%(2)
K0201 = -K1;
K0202 = -Ksp11*((Rc1)^2)*(a^2)- Ksp12*((Rc1)^2)*(a^2)-Ksp12*((Rc1)^2)*(a^2)-Krp11*((Rc1)^2)*(a^2)-Krp12*((Rc1)^2)*(a^2)-Krp13*((Rc1)^2)*(a^2) + K1;
K0203 = Krp11*Rp11*Rc1*a - Ksp11*Rp11*Rc1*a;
K0204 = Krp12*Rp12*Rc1*a - Ksp12*Rp12*Rc1*a;
K0205 = Krp13*Rp13*Rc1*a - Ksp13*Rp13*Rc1*a;
K0206 = Ksp11*Rs1*Rc1*a + Ksp12*Rs1*Rc1*a + Ksp13*Rs1*Rc1*a;
K0207 = 0; K0208 = 0; K0209 = 0; K0210 = 0; K0211 = 0; K0212 = 0;
%(3)
K0301 = 0;
K0302 = -Ksp11*Rc1*Rp11*a+Krp11*Rc1*Rp11*a;
K0303 = -Ksp11*Rp11*Rp11-Krp11*Rp11*Rp11;
K0304 = 0;
K0305 = 0;
K0306 = Ksp11*Rs1*Rp11;
K0307 = 0; K0308 = 0; K0309 = 0; K0310 = 0; K0311 = 0; K0312 = 0;
%(4)
K0401 = 0;
K0402 = -Ksp12*Rc1*Rp12*a+Krp12*Rc1*Rp12*a;
K0403 = 0;
K0404 = -Ksp12*Rp12*Rp12-Krp12*Rp12*Rp12;
K0405 = 0;
K0406 = Ksp12*Rs1*Rp12;
K0407 = 0; K0408 = 0; K0409 = 0; K0410 = 0; K0411 = 0; K0412 = 0;
%(5)
K0501 = 0;
K0502 = -Ksp13*Rc1*Rp13*a+Krp13*Rc1*Rp13*a;
K0503 = 0;
K0504 = 0;
K0505 = -Ksp13*Rp13*Rp13-Krp13*Rp13*Rp13;
K0506 = Ksp13*Rs1*Rp13;
K0507 = 0; K0508 = 0; K0509 = 0; K0510 = 0; K0511 = 0; K0512 = 0;
%(6)
K0601 = 0;
K0602 = Ksp11*Rc1*Rs1*a + Ksp12*Rc1*Rs1*a + Ksp13*Rc1*Rs1*a;
K0603 = Ksp11*Rp11*Rs1;
K0604 = Ksp12*Rp12*Rs1;
K0605 = Ksp13*Rp13*Rs1;
K0606 = -Ksp11*Rs1*Rs1-Ksp12*Rs1*Rs1-Ksp12*Rs1*Rs1+K2;
K0607 = -K2;
K0608 = 0; K0609 = 0; K0610 = 0; K0611 = 0; K0612 = 0;
%(7)
K0701 = 0; K0702 = 0; K0703 = 0; K0704 = 0; K0705 = 0;
K0706 = -K2;
K0707 = -Ksp21*((Rc2)^2)*(a^2)-Ksp22*((Rc2)^2)*(a^2)-Ksp23*((Rc2)^2)*(a^2)-Krp21*((Rc2)^2)*(a^2)-Krp22*((Rc2)^2)*(a^2)-Krp23*((Rc2)^2)*(a^2)+K2;
K0708 = Krp21*Rp21*Rc2*a-Ksp21*Rp21*Rc2*a;
K0709 = Krp22*Rp22*Rc2*a-Ksp22*Rp22*Rc2*a;
K0710 = Krp23*Rp23*Rc2*a-Ksp23*Rp23*Rc2*a;
K0711 = Ksp21*Rs2*Rc2*a+Ksp22*Rs2*Rc2*a+Ksp23*Rs2*Rc2*a;
K0712 = 0;
%(8)
K0801 = 0; K0802 = 0; K0803 = 0; K0804 = 0; K0805 = 0; K0806 = 0;
K0807 = -Ksp21*Rc2*Rp21*a+Krp21*Rc2*Rp21*a;
K0808 = -Ksp21*Rp21*Rp21-Krp21*Rp21*Rp21;
K0809 = 0;
K0810 = 0;
K0811 = Ksp21*Rs2*Rp21;
K0812 = 0;
%(9)
K0901 = 0; K0902 = 0; K0903 = 0; K0904 = 0; K0905 = 0; K0906 = 0;
K0907 = -Ksp22*Rc2*Rp22*a+Krp22*Rc2*Rp22*a;
K0908 = 0;
K0909 = -Ksp22*Rp22*Rp22-Krp22*Rp22*Rp22;
K0910 = 0;
K0911 = Ksp22*Rs2*Rp22;
K0912 = 0;
%(10)
K1001 = 0; K1002 = 0; K1003 = 0; K1004 = 0; K1005 = 0; K1006 = 0;
K1007 = -Ksp23*Rc2*Rp23*a+Krp23*Rc2*Rp23*a;
K1008 = 0;
K1009 = 0;
K1010 = -Ksp23*Rp23*Rp23-Krp23*Rp23*Rp23;
K1011 = Ksp23*Rs2*Rp23;
K1012 = 0;
%(11)
K1101 = 0; K1102 = 0; K1103 = 0; K1104 = 0; K1105 = 0; K1106 = 0;
K1107 = Ksp21*Rc2*Rs2*a+Ksp22*Rc2*Rs2*a+Ksp23*Rc2*Rs2*a;
K1108 = Ksp21*Rp21*Rs2;
K1109 = Ksp22*Rp22*Rs2;
K1110 = Ksp23*Rp23*Rs2;
K1111 = -Ksp21*Rs2*Rs2-Ksp22*Rs2*Rs2-Ksp23*Rs2*Rs2+K3;
K1112 = -K3;
%(12)
K1201 = 0; K1202 = 0; K1203 = 0; K1204 = 0; K1205 = 0; K1206 = 0;
K1207 = 0; K1208 = 0; K1209 = 0; K1210 = 0;
K1211 = -K3;
K1212 = K3;
K = [K0101 K0102 K0103 K0104 K0105 K0106 K0107 K0108 K0109 K0110 K0111 K0112;
K0201 K0202 K0203 K0204 K0205 K0206 K0207 K0208 K0209 K0210 K0211 K0212;
K0301 K0302 K0303 K0304 K0305 K0306 K0307 K0308 K0309 K0310 K0311 K0312;
K0401 K0402 K0403 K0404 K0405 K0406 K0407 K0408 K0409 K0410 K0411 K0412;
K0501 K0502 K0503 K0504 K0505 K0506 K0507 K0508 K0509 K0510 K0511 K0512;
K0601 K0602 K0603 K0604 K0605 K0606 K0607 K0608 K0609 K0610 K0611 K0612;
K0701 K0702 K0703 K0704 K0705 K0706 K0707 K0708 K0709 K0710 K0711 K0712;
K0801 K0802 K0803 K0804 K0805 K0806 K0807 K0808 K0809 K0810 K0811 K0812;
K0901 K0902 K0903 K0904 K0905 K0906 K0907 K0908 K0909 K0910 K0911 K0912;
K1001 K1002 K1003 K1004 K1005 K1006 K1007 K1008 K1009 K1010 K1011 K1012;
K1101 K1102 K1103 K1104 K1105 K1106 K1107 K1108 K1109 K1110 K1111 K1112;
K1201 K1202 K1203 K1204 K1205 K1206 K1207 K1208 K1209 K1210 K1211 K1212];
% 阻尼矩阵
%(1)
C0101 = C1; C0102 = -C1; C0103 = 0;C0104 = 0;C0105 = 0;C0106 = 0;C0107 = 0;C0108 = 0;
C0109 = 0;C0110 = 0;C0111 = 0;C0112 = 0;
%(2)
C0201 = -C1;
C0202 = -Csp11*((Rc1)^2)*(a^2)-Csp12*((Rc1)^2)*(a^2)-Csp13*((Rc1)^2)*(a^2)-Crp11*((Rc1)^2)*(a^2)-Crp12*((Rc1)^2)*(a^2)-Crp13*((Rc1)^2)*(a^2)+C1;
C0203 = Crp11*Rp11*Rc1*a-Csp11*Rp11*Rc1*a;
C0204 = Crp12*Rp12*Rc1*a-Csp12*Rp12*Rc1*a;
C0205 = Crp13*Rp13*Rc1*a-Csp13*Rp13*Rc1*a;
C0206 = Csp11*Rs1*Rc1*a+Csp12*Rs1*Rc1*a+Csp13*Rs1*Rc1*a;
C0207 = 0; C0208 = 0; C0209 = 0; C0210 = 0; C0211 = 0; C0212 =0;
%(3)
C0301 = 0;
C0302 = -Csp11*Rc1*Rp11*a+Crp11*Rc1*Rp11*a;
C0303 = -Csp11*Rp11*Rp11-Crp11*Rp11*Rp11;
C0304 = 0; C0305 = 0;
C0306 = Csp11*Rs1*Rp11;
C0307 = 0; C0308 = 0; C0309 = 0; C0310 = 0; C0311 = 0; C0312 = 0;
%(4)
C0401 = 0;
C0402 = -Csp12*Rc1*Rp12*a+Crp12*Rc1*Rp12*a;
C0403 = 0;
C0404 = -Csp12*Rp12*Rp12-Crp12*Rp12*Rp12;
C0405= 0;
C0406 = Csp12*Rs1*Rp12;
C0407 = 0; C0408 = 0; C0409 = 0; C0410 = 0; C0411 = 0; C0412 = 0;
%(5)
C0501 = 0;
C0502 = -Csp13*Rc1*Rp13*a+Crp13*Rc
- 1
- 2
前往页