MATLAB Command Window
MATLAB Command Window
1 of 4
>> syms t
>> o1 = sym('o1(t)'); o2 = sym('o2(t)'); o3 = sym('o3(t)'); o4 = sym('o4(t)'); o5 = sym
('o5(t)'); o6 = sym('o6(t)');
>> a1 = [ cos(o1) -sin(o1) 0 0; sin(o1) cos(o1) 0 0; 0 0 1 0; 0 0 0 1]
a1 =
[ cos(o1(t)), -sin(o1(t)), 0, 0]
[ sin(o1(t)), cos(o1(t)), 0, 0]
[
0,
0, 1, 0]
[
0,
0, 0, 1]
>> syms A2 D2 D4 A3;
>> a2 = [ cos(o2) -sin(o2) 0 A2*cos(o3); sin(o2) cos(o2) 0
1]
A2*sin(o3) ; 0 0 1 D2; 0 0 0
a2 =
[ cos(o2(t)), -sin(o2(t)), 0, A2*cos(o3(t))]
[ sin(o2(t)), cos(o2(t)), 0, A2*sin(o3(t))]
[
0,
0, 1,
D2]
[
0,
0, 0,
1]
>> a3 = [ cos(o3) -sin(o3) 0 A2*cos(o3); sin(o3) cos(o3) 0
1]
A2*sin(o3) ; 0 0 1 D2; 0 0 0
a3 =
[ cos(o3(t)), -sin(o3(t)), 0, A2*cos(o3(t))]
[ sin(o3(t)), cos(o3(t)), 0, A2*sin(o3(t))]
[
0,
0, 1,
D2]
[
0,
0, 0,
1]
>> a2 =[ cos(o2) -sin(o2) 0 0; sin(o2) cos(o2) 0 0; 0 1 0 0; 0 0 0 1]
a2 =
[ cos(o2(t)), -sin(o2(t)), 0, 0]
[ sin(o2(t)), cos(o2(t)), 0, 0]
[
0,
1, 0, 0]
[
0,
0, 0, 1]
>> a2 =[ cos(o2) 0 sin(o2)
0; sin(o2) 0 -cos(o2) 0; 0 1 0 0; 0 0 0 1]
a2 =
[ cos(o2(t)), 0, sin(o2(t)), 0]
[ sin(o2(t)), 0, -cos(o2(t)), 0]
[
0, 1,
0, 0]
[
0, 0,
0, 1]
25/09/15 17:53
2 of 4
>> a3
a3 =
[ cos(o3(t)), -sin(o3(t)), 0, A2*cos(o3(t))]
[ sin(o3(t)), cos(o3(t)), 0, A2*sin(o3(t))]
[
0,
0, 1,
D2]
[
0,
0, 0,
1]
>> a4 = [ cos(o4) 0 sin(o4)
a4 =
[ cos(o4(t)), 0, sin(o4(t)), A3*cos(o4(t))]
[ sin(o4(t)), 0, -cos(o4(t)), A3*sin(o4(t))]
[
0, 1,
0,
0]
[
0, 0,
0,
1]
>> a5 =[ cos(o5) 0 sin(o5)
a5 =
[ cos(o5(t)), 0, sin(o5(t)), 0]
[ sin(o5(t)), 0, -cos(o5(t)), 0]
[
0, 1,
0, D4]
[
0, 0,
0, 1]
>> a6 = [ cos(o6) 0 sin(o6)
0; sin(o6) 0 -cos(o6) 0; 0 1 0 0; 0 0 0 1]
a6 =
[ cos(o6(t)), 0, sin(o6(t)), 0]
[ sin(o6(t)), 0, -cos(o6(t)), 0]
[
0, 1,
0, 0]
[
0, 0,
0, 1]
>> a1*a2*a3*a4*a5*a6
ans =
[ cos(o6(t))*(sin(o5(t))*(cos(o1(t))*sin(o2(t)) + cos(o2(t))*sin(o1(t))) - cos(o5(t))*
(cos(o3(t))*cos(o4(t))*(sin(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t))) - sin(o3(t))*sin
(o4(t))*(sin(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t))))) - sin(o6(t))*(cos(o3(t))*sin(o4
(t))*(sin(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t))) + cos(o4(t))*sin(o3(t))*(sin(o1(t))
*sin(o2(t)) - cos(o1(t))*cos(o2(t)))), - sin(o5(t))*(cos(o3(t))*cos(o4(t))*(sin(o1(t))
*sin(o2(t)) - cos(o1(t))*cos(o2(t))) - sin(o3(t))*sin(o4(t))*(sin(o1(t))*sin(o2(t)) - cos
(o1(t))*cos(o2(t)))) - cos(o5(t))*(cos(o1(t))*sin(o2(t)) + cos(o2(t))*sin(o1(t))), cos(o6
(t))*(cos(o3(t))*sin(o4(t))*(sin(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t))) + cos(o4(t))
*sin(o3(t))*(sin(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t)))) + sin(o6(t))*(sin(o5(t))*
(cos(o1(t))*sin(o2(t)) + cos(o2(t))*sin(o1(t))) - cos(o5(t))*(cos(o3(t))*cos(o4(t))*(sin
(o1(t))*sin(o2(t)) - cos(o1(t))*cos(o2(t))) - sin(o3(t))*sin(o4(t))*(sin(o1(t))*sin(o2
25/09/15 17:53
3 of 4
25/09/15 17:53
4 of 4