Add sr_packet_copy/_free functions.
These will be used to make a copy of a packet on the session bus, valid for the duration of the device instance that generated it.
This commit is contained in:
parent
98edee7926
commit
8143cfdc90
|
@ -567,6 +567,9 @@ SR_PRIV int sr_session_send(const struct sr_dev_inst *sdi,
|
|||
const struct sr_datafeed_packet *packet);
|
||||
SR_PRIV int sr_session_stop_sync(struct sr_session *session);
|
||||
SR_PRIV int sr_sessionfile_check(const char *filename);
|
||||
SR_PRIV int sr_packet_copy(const struct sr_datafeed_packet *packet,
|
||||
struct sr_datafeed_packet **copy);
|
||||
SR_PRIV void sr_packet_free(struct sr_datafeed_packet *packet);
|
||||
|
||||
/*--- std.c -----------------------------------------------------------------*/
|
||||
|
||||
|
|
115
src/session.c
115
src/session.c
|
@ -946,4 +946,119 @@ SR_API int sr_session_source_remove_channel(struct sr_session *session,
|
|||
return _sr_session_source_remove(session, (gintptr)channel);
|
||||
}
|
||||
|
||||
static void *copy_src(struct sr_config *src)
|
||||
{
|
||||
struct sr_config *new_src;
|
||||
|
||||
new_src = g_malloc(sizeof(struct sr_config));
|
||||
memcpy(new_src, src, sizeof(struct sr_config));
|
||||
g_variant_ref(src->data);
|
||||
|
||||
return new_src;
|
||||
}
|
||||
|
||||
SR_PRIV int sr_packet_copy(const struct sr_datafeed_packet *packet,
|
||||
struct sr_datafeed_packet **copy)
|
||||
{
|
||||
const struct sr_datafeed_meta *meta;
|
||||
struct sr_datafeed_meta *meta_copy;
|
||||
const struct sr_datafeed_logic *logic;
|
||||
struct sr_datafeed_logic *logic_copy;
|
||||
const struct sr_datafeed_analog *analog;
|
||||
struct sr_datafeed_analog *analog_copy;
|
||||
uint8_t *payload;
|
||||
|
||||
*copy = g_malloc0(sizeof(struct sr_datafeed_packet));
|
||||
(*copy)->type = packet->type;
|
||||
|
||||
switch (packet->type) {
|
||||
case SR_DF_TRIGGER:
|
||||
case SR_DF_END:
|
||||
/* No payload. */
|
||||
break;
|
||||
case SR_DF_HEADER:
|
||||
payload = g_malloc(sizeof(struct sr_datafeed_header));
|
||||
memcpy(payload, packet->payload, sizeof(struct sr_datafeed_header));
|
||||
(*copy)->payload = payload;
|
||||
break;
|
||||
case SR_DF_META:
|
||||
meta = packet->payload;
|
||||
meta_copy = g_malloc(sizeof(struct sr_datafeed_meta));
|
||||
meta_copy->config = g_slist_copy_deep(meta->config,
|
||||
(GCopyFunc)copy_src, NULL);
|
||||
(*copy)->payload = meta_copy;
|
||||
break;
|
||||
case SR_DF_LOGIC:
|
||||
logic = packet->payload;
|
||||
logic_copy = g_malloc(sizeof(logic));
|
||||
logic_copy->length = logic->length;
|
||||
logic_copy->unitsize = logic->unitsize;
|
||||
memcpy(logic_copy->data, logic->data, logic->length * logic->unitsize);
|
||||
(*copy)->payload = logic_copy;
|
||||
break;
|
||||
case SR_DF_ANALOG:
|
||||
analog = packet->payload;
|
||||
analog_copy = g_malloc(sizeof(analog));
|
||||
analog_copy->channels = g_slist_copy(analog->channels);
|
||||
analog_copy->num_samples = analog->num_samples;
|
||||
analog_copy->mq = analog->mq;
|
||||
analog_copy->unit = analog->unit;
|
||||
analog_copy->mqflags = analog->mqflags;
|
||||
memcpy(analog_copy->data, analog->data,
|
||||
analog->num_samples * sizeof(float));
|
||||
(*copy)->payload = analog_copy;
|
||||
break;
|
||||
default:
|
||||
sr_err("Unknown packet type %d", packet->type);
|
||||
return SR_ERR;
|
||||
}
|
||||
|
||||
return SR_OK;
|
||||
}
|
||||
|
||||
void sr_packet_free(struct sr_datafeed_packet *packet)
|
||||
{
|
||||
const struct sr_datafeed_meta *meta;
|
||||
const struct sr_datafeed_logic *logic;
|
||||
const struct sr_datafeed_analog *analog;
|
||||
struct sr_config *src;
|
||||
GSList *l;
|
||||
|
||||
switch (packet->type) {
|
||||
case SR_DF_TRIGGER:
|
||||
case SR_DF_END:
|
||||
/* No payload. */
|
||||
break;
|
||||
case SR_DF_HEADER:
|
||||
/* Payload is a simple struct. */
|
||||
g_free((void *)packet->payload);
|
||||
break;
|
||||
case SR_DF_META:
|
||||
meta = packet->payload;
|
||||
for (l = meta->config; l; l = l->next) {
|
||||
src = l->data;
|
||||
g_variant_unref(src->data);
|
||||
g_free(src);
|
||||
}
|
||||
g_slist_free(meta->config);
|
||||
g_free((void *)packet->payload);
|
||||
break;
|
||||
case SR_DF_LOGIC:
|
||||
logic = packet->payload;
|
||||
g_free(logic->data);
|
||||
g_free((void *)packet->payload);
|
||||
break;
|
||||
case SR_DF_ANALOG:
|
||||
analog = packet->payload;
|
||||
g_slist_free(analog->channels);
|
||||
g_free(analog->data);
|
||||
g_free((void *)packet->payload);
|
||||
break;
|
||||
default:
|
||||
sr_err("Unknown packet type %d", packet->type);
|
||||
}
|
||||
g_free(packet);
|
||||
|
||||
}
|
||||
|
||||
/** @} */
|
||||
|
|
Loading…
Reference in New Issue