You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
15 lines
294 B
15 lines
294 B
t2 = cos(yaw); |
|
t3 = sin(roll); |
|
t4 = sin(yaw); |
|
t5 = cos(roll); |
|
t6 = sin(pitch); |
|
t7 = cos(pitch); |
|
A0[0][0] = t2*t7; |
|
A0[0][1] = -t4*t5+t2*t3*t6; |
|
A0[0][2] = t3*t4+t2*t5*t6; |
|
A0[1][0] = t4*t7; |
|
A0[1][1] = t2*t5+t3*t4*t6; |
|
A0[1][2] = -t2*t3+t4*t5*t6; |
|
A0[2][0] = -t6; |
|
A0[2][1] = t3*t7; |
|
A0[2][2] = t5*t7;
|
|
|