DevelopEnv/matlab
[Matlab] Euler to Rotation Matrix
퓨림노
2012. 1. 18. 22:27
void CEuler::ConversionEulerToMatrix( float azimuth, float pitch, float roll, float *matrix )
{
float sa, ca, sb,cb, sh, ch;
sa = sin(pitch); // attitude
ca = cos(pitch); //
sb = sin(roll); // bank
cb = cos(roll); //
sh = sin(azimuth); // heading
ch = cos(azimuth); //
matrix[0] = ch * ca;
matrix[1] = sh * sb - ch * sa * cb;
matrix[2] = ch * sa * sb + sh * cb;
matrix[3] = sa;
matrix[4] = ca * cb;
matrix[5] = -ca * sb;
matrix[6] = -sh * ca;
matrix[7] = sh * sa * cb + ch * sb;
matrix[8] = -sh * sa * sb + ch * cb;
}
f