qmi_result_print_tlvs prints the type and length field of a result to DBG() --- drivers/qmimodem/qmi.c | 17 +++++++++++++++++ drivers/qmimodem/qmi.h | 2 +- 2 files changed, 18 insertions(+), 1 deletion(-) diff --git a/drivers/qmimodem/qmi.c b/drivers/qmimodem/qmi.c index 30123723..17c6a6f3 100644 --- a/drivers/qmimodem/qmi.c +++ b/drivers/qmimodem/qmi.c @@ -1026,6 +1026,23 @@ void qmi_device_set_close_on_unref(struct qmi_device *device, bool do_close) device->close_on_unref = do_close; } +void qmi_result_print_tlvs(struct qmi_result *result) +{ + const void *ptr = result->data; + uint16_t len = result->length; + + while (len > QMI_TLV_HDR_SIZE) { + const struct qmi_tlv_hdr *tlv = ptr; + uint16_t tlv_length = GUINT16_FROM_LE(tlv->length); + + DBG("tlv: 0x%02x len 0x%04x", tlv->type, tlv->length); + + ptr += QMI_TLV_HDR_SIZE + tlv_length; + len -= QMI_TLV_HDR_SIZE + tlv_length; + } +} + + static const void *tlv_get(const void *data, uint16_t size, uint8_t type, uint16_t *length) { diff --git a/drivers/qmimodem/qmi.h b/drivers/qmimodem/qmi.h index 0cd8f7c9..bfe8e6b5 100644 --- a/drivers/qmimodem/qmi.h +++ b/drivers/qmimodem/qmi.h @@ -136,7 +136,7 @@ bool qmi_result_get_uint32(struct qmi_result *result, uint8_t type, uint32_t *value); bool qmi_result_get_uint64(struct qmi_result *result, uint8_t type, uint64_t *value); - +void qmi_result_print_tlvs(struct qmi_result *result); struct qmi_service; -- 2.13.0