[messages][ahrs] add comp_id to GEO_MAG

This commit is contained in:
Felix Ruess
2015-11-24 14:04:37 +01:00
parent ac901bce12
commit 003338dbb6
5 changed files with 5 additions and 4 deletions
+1
View File
@@ -1445,6 +1445,7 @@
<field name="Hx" type="float"/>
<field name="Hy" type="float"/>
<field name="Hz" type="float"/>
<field name="comp_id" type="uint8" values="NONE|GENERIC|GEOM|ICQ|ICE|FC|DCM|FINV|MLKF|GX3"/>
</message>
<message name="HFF" id="164">
@@ -85,7 +85,7 @@ static void send_euler_int(struct transport_tx *trans, struct link_device *dev)
static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
{
pprz_msg_send_GEO_MAG(trans, dev, AC_ID,
&ahrs_fc.mag_h.x, &ahrs_fc.mag_h.y, &ahrs_fc.mag_h.z);
&ahrs_fc.mag_h.x, &ahrs_fc.mag_h.y, &ahrs_fc.mag_h.z, &ahrs_fc_id);
}
static void send_filter_status(struct transport_tx *trans, struct link_device *dev)
@@ -70,7 +70,7 @@ static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
pprz_msg_send_GEO_MAG(trans, dev, AC_ID,
&ahrs_float_inv.mag_h.x,
&ahrs_float_inv.mag_h.y,
&ahrs_float_inv.mag_h.z);
&ahrs_float_inv.mag_h.z, &ahrs_finv_id);
}
static void send_filter_status(struct transport_tx *trans, struct link_device *dev)
@@ -68,7 +68,7 @@ static void send_bias(struct transport_tx *trans, struct link_device *dev)
static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
{
pprz_msg_send_GEO_MAG(trans, dev, AC_ID,
&ahrs_mlkf.mag_h.x, &ahrs_mlkf.mag_h.y, &ahrs_mlkf.mag_h.z);
&ahrs_mlkf.mag_h.x, &ahrs_mlkf.mag_h.y, &ahrs_mlkf.mag_h.z, &ahrs_mlkf_id);
}
static void send_filter_status(struct transport_tx *trans, struct link_device *dev)
@@ -91,7 +91,7 @@ static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
h_float.y = MAG_FLOAT_OF_BFP(ahrs_icq.mag_h.y);
h_float.z = MAG_FLOAT_OF_BFP(ahrs_icq.mag_h.z);
pprz_msg_send_GEO_MAG(trans, dev, AC_ID,
&h_float.x, &h_float.y, &h_float.z);
&h_float.x, &h_float.y, &h_float.z, &ahrs_icq_id);
}
static void send_filter_status(struct transport_tx *trans, struct link_device *dev)