611,8 → 611,8 |
#ifdef USE_MK3MAG |
if((CheckDelay(Compass_Timer)) && txd_complete) |
{ |
ToMk3Mag.Attitude[0] = (int16_t) (IntegralNick / 108); // approx. 0,1 Deg |
ToMk3Mag.Attitude[1] = (int16_t) (IntegralRoll / 108); // approx. 0,1 Deg |
ToMk3Mag.Attitude[0] = (int16_t) (IntegralNick / 130L); // approx. 0.1 deg |
ToMk3Mag.Attitude[1] = (int16_t) (IntegralRoll / 130L); // approx. 0.1 deg |
ToMk3Mag.UserParam[0] = FCParam.UserParam1; |
ToMk3Mag.UserParam[1] = FCParam.UserParam2; |
ToMk3Mag.CalState = CompassCalState; |