Skip to content

Commit

Permalink
Browse files Browse the repository at this point in the history
requested changes
  • Loading branch information
tmldeponti committed Mar 12, 2024
1 parent b281fca commit 937a7ee
Show file tree
Hide file tree
Showing 2 changed files with 5 additions and 6 deletions.
7 changes: 3 additions & 4 deletions sw/airborne/modules/ins/ins_ekf2.cpp
Expand Up @@ -481,11 +481,11 @@ static void send_ahrs_quat(struct transport_tx *trans, struct link_device *dev)
}


static void send_eternal_pose_down(struct transport_tx *trans, struct link_device *dev)
static void send_external_pose_down(struct transport_tx *trans, struct link_device *dev)
{
if(sample_ev.time_us==0){
return;
} else {
}
float sample_temp_ev[11];
sample_temp_ev[0] = (float) sample_ev.time_us;
sample_temp_ev[1] = sample_ev.pos(0) ;
Expand All @@ -510,7 +510,6 @@ static void send_eternal_pose_down(struct transport_tx *trans, struct link_devic
&sample_temp_ev[8],
&sample_temp_ev[9],
&sample_temp_ev[10] );
}
}
#endif

Expand Down Expand Up @@ -608,7 +607,7 @@ void ins_ekf2_init(void)
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_WIND_INFO_RET, send_wind_info_ret);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_BIAS, send_ahrs_bias);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_QUAT_INT, send_ahrs_quat);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_EXTERNAL_POSE_DOWN, send_eternal_pose_down);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_EXTERNAL_POSE_DOWN, send_external_pose_down);
#endif

/*
Expand Down
4 changes: 2 additions & 2 deletions sw/airborne/modules/ins/ins_ext_pose.c
Expand Up @@ -121,7 +121,7 @@ static void send_ins_ref(struct transport_tx *trans, struct link_device *dev)
&ins_ext_pos.ltp_def.hmsl, (float *)&fake_qfe);
}

static void send_eternal_pose_down(struct transport_tx *trans, struct link_device *dev)
static void send_external_pose_down(struct transport_tx *trans, struct link_device *dev)
{
pprz_msg_send_EXTERNAL_POSE_DOWN(trans, dev, AC_ID,
&ins_ext_pos.ev_time,
Expand Down Expand Up @@ -276,7 +276,7 @@ void ins_ext_pose_init(void)
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_INS, send_ins);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_INS_Z, send_ins_z);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_INS_REF, send_ins_ref);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_EXTERNAL_POSE_DOWN, send_eternal_pose_down);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_EXTERNAL_POSE_DOWN, send_external_pose_down);
register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_BIAS, send_ahrs_bias);
#endif

Expand Down

0 comments on commit 937a7ee

Please sign in to comment.