-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathElemMe.m
42 lines (33 loc) · 1.28 KB
/
ElemMe.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
function [Me] = ElemMe(Li,p)
% Parameters
mu = p.mu;
rS = p.rS;
r0 = p.r0;
d = p.d;
% Element mass matrix [Me]
M1 = (mu*Li/420) * [ 156, 22*Li, 0, 54, -13*Li, 0;
22*Li, 4*Li^2, 0, 13*Li, -3*Li^2, 0;
0, 0, 0, 0, 0, 0;
54, 13*Li, 0, 156, -22*Li, 0;
-13*Li,-3*Li^2, 0, -22*Li, 4*Li^2, 0;
0, 0, 0, 0, 0, 0];
M2 = (mu*r0^2/(30*Li)) * [36, 3*Li, 0, -36, 3*Li 0;
3*Li, 4*Li^2, 0, -3*Li, -Li^2, 0;
0, 0, 0, 0, 0, 0;
-36, -3*Li, 0, 36, -3*Li, 0;
3*Li, -Li^2, 0, -3*Li, 4*Li^2, 0;
0, 0, 0, 0, 0, 0];
M3 = (mu*rS^2*Li/6) * [0, 0, 0, 0, 0, 0;
0, 0, 0, 0, 0, 0;
0, 0, 2, 0, 0, 1;
0, 0, 0, 0, 0, 0;
0, 0, 0, 0, 0, 0;
0, 0, 1, 0, 0, 2];
M4 = (mu*d*Li/60) * [0, 0, 21, 0, 0, 9;
0, 0, 3*Li, 0, 0, 2*Li;
21, 3*Li, 0, 9, -2*Li, 0;
0, 0, 9, 0, 0, 21;
0, 0, -2*Li, 0, 0, -3*Li;
9, 2*Li, 0, 21, -3*Li 0];
Me = M1 + M2 + M3 + M4;
end