Esempio n. 1
0
//FIXME not the correct place
static void send_fliter_status(void) {
  uint8_t mde = 3;
  if (ahrs.status == AHRS_UNINIT) mde = 2;
  if (ahrs_timeout_counter > 10) mde = 5;
  uint16_t val = 0;
  DOWNLINK_SEND_STATE_FILTER_STATUS(DefaultChannel, DefaultDevice, &mde, &val);
}
Esempio n. 2
0
static void send_status(void) {
  uint16_t contrast = abs(infrared.roll) + abs(infrared.pitch) + abs(infrared.top);
  uint8_t mde = 3;
  if (contrast < 50) mde = 7;
  DOWNLINK_SEND_STATE_FILTER_STATUS(DefaultChannel, DefaultDevice, &mde, &contrast);
}