示例#1
0
/** 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
}
示例#2
0
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;
}
示例#3
0
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;
}
示例#4
0
void ahrs_propagate(void) {
  if (ahrs_sim_available) {
    update_ahrs_from_sim();
    ahrs_sim_available = FALSE;
  }
}
示例#5
0
void ahrs_propagate(float dt __attribute__((unused))) {
  if (ahrs_sim_available) {
    update_ahrs_from_sim();
    ahrs_sim_available = FALSE;
  }
}