-
Notifications
You must be signed in to change notification settings - Fork 2
/
getAngleNTranslationList.m
152 lines (143 loc) · 4.11 KB
/
getAngleNTranslationList.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
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
function [ang_list, trans_list] = getAngleNTranslationList(list_num)
if list_num < 100
list_num = list_num;
elseif list_num >= 100 && list_num < 200
list_num = list_num - 100;
elseif list_num >= 200 && list_num < 300
list_num = list_num - 200;
elseif list_num >= 300 && list_num < 400
list_num = list_num - 300;
elseif list_num >= 400 && list_num < 500
list_num = list_num - 400;
else
error("No such list_num %i", list_num)
end
switch list_num
case 1
ang_list = [0,0,0];
trans_list = [2, 0 0];
case 2
ang_list = [0,0,0];
trans_list = [4, 0 0];
case 3
ang_list = [0,0,0];
trans_list = [6, 0 0];
case 4
ang_list = [0,0,0];
trans_list = [8, 0 0];
case 5
ang_list = [0,0,0];
trans_list = [10, 0 0];
case 6
ang_list = [0,0,0];
trans_list = [12, 0 0];
case 7
ang_list = [0,0,0];
trans_list = [14, 0 0];
case 8
ang_list = [0,0,0];
trans_list = [16, 0 0];
case 9
ang_list = [0,0,0];
trans_list = [18, 0 0];
case 10
ang_list = [0,0,0];
trans_list = [20, 0 0];
case 11
ang_list = [0,0,0];
trans_list = [22, 0 0];
case 12
ang_list = [0,0,0];
trans_list = [24, 0 0];
case 13
ang_list = [0,0,0];
trans_list = [26, 0 0];
case 14
ang_list = [0,0,0];
trans_list = [28, 0 0];
case 15
ang_list = [0,0,0];
trans_list = [30, 0 0];
case 16
ang_list = [0,0,0];
trans_list = [32, 0 0];
case 17
ang_list = [0,0,0];
trans_list = [34, 0 0];
case 18
ang_list = [0,0,0];
trans_list = [36, 0 0];
case 19
ang_list = [0,0,0];
trans_list = [38, 0 0];
case 20
ang_list = [0,0,0];
trans_list = [40, 0 0];
case 21
ang_list = [20,30,30];
trans_list = [2, 0 0];
case 22
ang_list = [20,30,30];
trans_list = [4, 0 0];
case 23
ang_list = [20,30,30];
trans_list = [6, 0 0];
case 24
ang_list = [20,30,30];
trans_list = [8, 0 0];
case 25
ang_list = [20,30,30];
trans_list = [10, 0 0];
case 26
ang_list = [20,30,30];
trans_list = [12, 0 0];
case 27
ang_list = [20,30,30];
trans_list = [14, 0 0];
case 28
ang_list = [20,30,30];
trans_list = [16, 0 0];
case 29
ang_list = [20,30,30];
trans_list = [18, 0 0];
case 30
ang_list = [20,30,30];
trans_list = [20, 0 0];
case 31
ang_list = [20,30,30];
trans_list = [22, 0 0];
case 32
ang_list = [20,30,30];
trans_list = [24, 0 0];
case 33
ang_list = [20,30,30];
trans_list = [26, 0 0];
case 34
ang_list = [20,30,30];
trans_list = [28, 0 0];
case 35
ang_list = [20,30,30];
trans_list = [30, 0 0];
case 36
ang_list = [20,30,30];
trans_list = [32, 0 0];
case 37
ang_list = [20,30,30];
trans_list = [34, 0 0];
case 38
ang_list = [20,30,30];
trans_list = [36, 0 0];
case 39
ang_list = [20,30,30];
trans_list = [38, 0 0];
case 40
ang_list = [20,30,30];
trans_list = [40, 0 0];
% pose illustration
case 99
ang_list = [20,-5,0];
trans_list = [2, 0 0];
otherwise
error("No such list number : %i", list_num)
end
end