/** Run at PERIODIC_FREQUENCY (60Hz if not defined) */ void sensors_task(void) { //FIXME: this is just a kludge #if USE_AHRS && defined SITL && !USE_NPS update_ahrs_from_sim(); #endif }
void ahrs_align(void) { /* Currently not really simulated * body and imu have the same frame and always set to true value from sim */ update_ahrs_from_sim(); ahrs.status = AHRS_RUNNING; }
void ahrs_align(void) { /* Currently not really simulated * body and imu have the same frame and always set to true value from sim */ update_ahrs_from_sim(); /* Compute initial body orientation */ compute_body_orientation_and_rates(); ahrs.status = AHRS_RUNNING; }
void ahrs_propagate(void) { if (ahrs_sim_available) { update_ahrs_from_sim(); ahrs_sim_available = FALSE; } }
void ahrs_propagate(float dt __attribute__((unused))) { if (ahrs_sim_available) { update_ahrs_from_sim(); ahrs_sim_available = FALSE; } }