output all received drefs
This commit is contained in:
parent
8853b3306a
commit
4042ebb93d
24
readref.c
24
readref.c
@ -139,21 +139,25 @@ int main()
|
|||||||
}
|
}
|
||||||
printf("\n");
|
printf("\n");
|
||||||
|
|
||||||
// XXX: loop throught multiple drefs
|
// continue if payloadBytes is valid (1 byte + 8 bytes each dref)
|
||||||
if ((payloadBytes - 1) % 8 == 0)
|
if ((payloadBytes - 1) % sizeof(struct dref_struct_out) == 0)
|
||||||
{
|
{
|
||||||
memset(mqttTopic, 0, sizeof(mqttTopic));
|
// loop throught all provided drefs
|
||||||
memset(mqttPayload, 0, sizeof(mqttPayload));
|
for (int i = 1; i < payloadBytes; i += sizeof(struct dref_struct_out))
|
||||||
|
{
|
||||||
|
memset(mqttTopic, 0, sizeof(mqttTopic));
|
||||||
|
memset(mqttPayload, 0, sizeof(mqttPayload));
|
||||||
|
|
||||||
struct dref_struct_out drefRead;
|
struct dref_struct_out drefRead;
|
||||||
memcpy(&drefRead, &payload[1], 8);
|
memcpy(&drefRead, &payload[i], sizeof(struct dref_struct_out));
|
||||||
|
|
||||||
printf("%d: %f\n", drefRead.dref_sender_index, drefRead.dref_flt_value);
|
printf("%d: %f\n", drefRead.dref_sender_index, drefRead.dref_flt_value);
|
||||||
|
|
||||||
sprintf(mqttTopic, "/xplane/rref/%d", drefRead.dref_sender_index);
|
sprintf(mqttTopic, "/xplane/rref/%d", drefRead.dref_sender_index);
|
||||||
sprintf(mqttPayload, "%f", drefRead.dref_flt_value);
|
sprintf(mqttPayload, "%f", drefRead.dref_flt_value);
|
||||||
|
|
||||||
sendMqtt(mqtt, mqttTopic, mqttPayload, strlen(mqttPayload));
|
sendMqtt(mqtt, mqttTopic, mqttPayload, strlen(mqttPayload));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
|
Loading…
x
Reference in New Issue
Block a user