forked from Mechanics-For-Design-Group/Mechanics_Proj_3
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathIRB460.m
83 lines (71 loc) · 3.05 KB
/
IRB460.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
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
% IRB460 is a class that contains D-H parameters of IRB460
classdef IRB460
properties (Access = public)
% a struct that contains all parameters.
parameters;
end
methods
% initialization
function obj = IRB460()
% left & right range of angle1, angle2, angle3.
obj.parameters.angle1L = deg2rad(-165);
obj.parameters.angle1R = deg2rad(165);
obj.parameters.angle2L = deg2rad(-40);
obj.parameters.angle2R = deg2rad(85);
obj.parameters.angle3L = deg2rad(-20);
obj.parameters.angle3R = deg2rad(120);
% Initial D-H Parameters for alpha, a, d, theta.S
obj.parameters.dG1 = 235.5;
obj.parameters.a1I = 260;
obj.parameters.d1I = 742.5-obj.parameters.dG1;
obj.parameters.alphaI2 = deg2rad(-90);
obj.parameters.thetaI2 = deg2rad(-90);
obj.parameters.a23 = 945;
obj.parameters.theta23 = deg2rad(90);
obj.parameters.a34 = 1025;
obj.parameters.alpha46 = deg2rad(-90);
obj.parameters.a46 = 220;
obj.parameters.d46 = 251.5;
% obj.parameters.C0_G=[-8.37;-0.202;107.46];
% obj.parameters.C1_1=[-147.973;-22.763;347.734];
% obj.parameters.C6_2=[0;894.7/2;0];
% obj.parameters.C7_3=[0;-200;0];
% obj.parameters.S1_G=[-264.88;0;140.84];
% obj.parameters.SC8=[-3;0;60];
% obj.parameters.C9_3=[984.96;0;0];
% obj.parameters.C11_4=[124.94;0;0];
% new version of COMs
obj.parameters.C0_G = [-0.202; 8.370; 107.46];
obj.parameters.C1_1 = [-22.763; 147.973; 333.194];
obj.parameters.SC2_3 = [-0.208; -123.447; 21.675];
obj.parameters.SC4_2 = [472.5; 0; -37.163];
obj.parameters.Q1_3 = [-945; 0; 0];
obj.parameters.S1_1 = [-274.88; 0; 140.84];
obj.parameters.SC5_2 = [472.5; -29.525; -261.5];
obj.parameters.C6_2 = [395.286; 23.441; 18.027];
obj.parameters.C7_3 = [-200; 0; 0];
obj.parameters.SC8_1 = [-41.55; 0; 115.34];
obj.parameters.C9_3 = [512.5; 0; 0];
obj.parameters.S2_1 = [227.85; 0; 196.15];
obj.parameters.SC10_3 = [512.5; 0; -164.5];
obj.parameters.C11_4 = [158.779; 68.352; -28.625];
% desity: 1000kg/m^3
obj.parameters.rho = 1000;
% masses of each moving parts
obj.parameters.m1 = 65.561;
obj.parameters.m2 = 5.282;
obj.parameters.m4 = 2.946;
obj.parameters.m5 = 1.443;
obj.parameters.m6 = 12.418;
obj.parameters.m7 = (1/4)*9.698;
obj.parameters.m8 = 2.851;
obj.parameters.m9 = (3/4)*9.698;
obj.parameters.m10 = 1.416;
obj.parameters.m11 = 6.013;
end
% get parameters
function parameters = get_parameters(obj)
parameters = obj.parameters;
end
end
end