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;