Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 386 → Rev 387

/branches/v0.60_MicroMag3_Nick666/trunc/compass.c
200,11 → 200,11
div_faktor = (uint16_t)EE_Parameter.UserParam1 * 8;
// Berechung von sinus und cosinus
MM3.NickGrad = -(IntegralNick/div_faktor);
MM3.NickGrad = (IntegralNick/div_faktor);
sin_nick = sin_f(MM3.NickGrad);
cos_nick = cos_f(MM3.NickGrad);
MM3.RollGrad = -(IntegralRoll/div_faktor);
MM3.RollGrad = (IntegralRoll/div_faktor);
sin_roll = sin_f(MM3.RollGrad);
cos_roll = cos_f(MM3.RollGrad);