void ahrs_init(void) { init_at_com(); //Set navdata_demo to FALSE and flat trim the ar drone at_com_send_config("general:navdata_demo", "FALSE"); at_com_send_ftrim(); ahrs.status = AHRS_RUNNING; #if DOWNLINK register_periodic_telemetry(DefaultPeriodic, "AHRS_ARDRONE2", send_ahrs_ad2); #endif }
void ahrs_ardrone2_init(void) { init_at_com(); //Set navdata_demo to FALSE and flat trim the ar drone at_com_send_config("general:navdata_demo", "FALSE"); at_com_send_ftrim(); ahrs_ardrone2.is_aligned = TRUE; #if PERIODIC_TELEMETRY register_periodic_telemetry(DefaultPeriodic, "AHRS_ARDRONE2", send_ahrs_ad2); #endif }