From a04525d9e167a44b8295af922114d34062e9feaf Mon Sep 17 00:00:00 2001 From: Carlo Lobrano Date: Tue, 21 Feb 2017 16:04:00 +0100 Subject: wda: extended wda set format message to enable QMUX Added the following configurable values: - upload datagram protocol - download datagram protocol - download datagram max size - download max datagrams - endpoint type - endpoint interface number According to last GobiNet from CodeAura project, it is necessary to set the following values to enable multiple data connection through one controller device: - upload datagram protocol = QMAP - download datagram protocol = QMAP - download datagram max size = 32 (it seems working even without setting it) - download max datagrams = 32768 (it seems working even without setting it) - endpoint type = HSUSB (it seems working even without setting it) - endpoint interface number = this depends on the modem, but it seems working even without setting it --- data/qmi-service-wda.json | 13 ++- src/libqmi-glib/qmi-enums.h | 20 ++++ src/qmicli/qmicli-helpers.c | 42 ++++++++ src/qmicli/qmicli-helpers.h | 4 + src/qmicli/qmicli-wda.c | 238 +++++++++++++++++++++++++++++++++++++++++--- 5 files changed, 304 insertions(+), 13 deletions(-) diff --git a/data/qmi-service-wda.json b/data/qmi-service-wda.json index d15551d..35e6a9c 100644 --- a/data/qmi-service-wda.json +++ b/data/qmi-service-wda.json @@ -83,7 +83,18 @@ "mandatory" : "no", "type" : "TLV", "since" : "1.10", - "format" : "guint32" } ], + "format" : "guint32" }, + { "name" : "Endpoint Info", + "id" : "0x17", + "mandatory" : "no", + "type" : "TLV", + "since" : "1.18", + "format" : "sequence", + "contents" : [ { "name" : "Endpoint Type", + "format" : "guint32", + "public-format" : "QmiDataEndpointType"}, + { "name" : "Interface Number", + "format" : "guint32"}] }], "output" : [ { "common-ref" : "Operation Result" }, { "name" : "QoS Format", "id" : "0x10", diff --git a/src/libqmi-glib/qmi-enums.h b/src/libqmi-glib/qmi-enums.h index 083370b..f9ce25e 100644 --- a/src/libqmi-glib/qmi-enums.h +++ b/src/libqmi-glib/qmi-enums.h @@ -145,4 +145,24 @@ typedef enum { * Since: 1.0 */ +/** + * QmiDataEndpointType: + * @QMI_DATA_ENDPOINT_TYPE_HSUSB: Data Endpoint Type HSUSB. + * @QMI_DATA_ENDPOINT_TYPE_UNDEFINED: Data Endpoint Type undefined. + * + * Data Endpoint Type. + * + * Since: 1.18 + */ +typedef enum { /*< underscore_name=qmi_data_endpoint_type > */ + QMI_DATA_ENDPOINT_TYPE_HSUSB = 0X02, + QMI_DATA_ENDPOINT_TYPE_UNDEFINED = 0XFF, +} QmiDataEndpointType; + +/** + * qmi_data_endpoint_type_get_string: + * + * Since: 1.18 + */ + #endif /* _LIBQMI_GLIB_QMI_ENUMS_H_ */ diff --git a/src/qmicli/qmicli-helpers.c b/src/qmicli/qmicli-helpers.c index 46e17db..0711253 100644 --- a/src/qmicli/qmicli-helpers.c +++ b/src/qmicli/qmicli-helpers.c @@ -547,6 +547,48 @@ qmicli_read_link_layer_protocol_from_string (const gchar *str, } gboolean +qmicli_read_data_aggregation_protocol_from_string (const gchar *str, + QmiWdaDataAggregationProtocol *out) +{ + GType type; + GEnumClass *enum_class; + GEnumValue *enum_value; + + type = qmi_wda_data_aggregation_protocol_get_type (); + enum_class = G_ENUM_CLASS (g_type_class_ref (type)); + enum_value = g_enum_get_value_by_nick (enum_class, str); + + if (enum_value) + *out = (QmiWdaDataAggregationProtocol)enum_value->value; + else + g_printerr ("error: invalid data aggregation protocol value given: '%s'\n", str); + + g_type_class_unref (enum_class); + return !!enum_value; +} + +gboolean +qmicli_read_data_endpoint_type_from_string (const gchar *str, + QmiDataEndpointType *out) +{ + GType type; + GEnumClass *enum_class; + GEnumValue *enum_value; + + type = qmi_data_endpoint_type_get_type (); + enum_class = G_ENUM_CLASS (g_type_class_ref (type)); + enum_value = g_enum_get_value_by_nick (enum_class, str); + + if (enum_value) + *out = (QmiDataEndpointType)enum_value->value; + else + g_printerr ("error: invalid data aggregation protocol value given: '%s'\n", str); + + g_type_class_unref (enum_class); + return !!enum_value; +} + +gboolean qmicli_read_autoconnect_setting_from_string (const gchar *str, QmiWdsAutoconnectSetting *out) { diff --git a/src/qmicli/qmicli-helpers.h b/src/qmicli/qmicli-helpers.h index 4a1e087..3ae880b 100644 --- a/src/qmicli/qmicli-helpers.h +++ b/src/qmicli/qmicli-helpers.h @@ -59,6 +59,10 @@ gboolean qmicli_read_expected_data_format_from_string (const gchar *str, QmiDeviceExpectedDataFormat *out); gboolean qmicli_read_link_layer_protocol_from_string (const gchar *str, QmiWdaLinkLayerProtocol *out); +gboolean qmicli_read_data_aggregation_protocol_from_string (const gchar *str, + QmiWdaDataAggregationProtocol *out); +gboolean qmicli_read_data_endpoint_type_from_string (const gchar *str, + QmiDataEndpointType *out); gboolean qmicli_read_autoconnect_setting_from_string (const gchar *str, QmiWdsAutoconnectSetting *out); gboolean qmicli_read_autoconnect_setting_roaming_from_string (const gchar *str, diff --git a/src/qmicli/qmicli-wda.c b/src/qmicli/qmicli-wda.c index 1d8f075..9df3d4b 100644 --- a/src/qmicli/qmicli-wda.c +++ b/src/qmicli/qmicli-wda.c @@ -33,6 +33,10 @@ #include "qmicli.h" #include "qmicli-helpers.h" +#define QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAMS_UNDEFINED 0xFFFFFFFF +#define QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAM_SIZE_UNDEFINED 0xFFFFFFFF +#define QMI_WDA_ENDPOINT_INTERFACE_NUMBER_UNDEFINED -1 + /* Context */ typedef struct { QmiDevice *device; @@ -49,8 +53,8 @@ static gboolean noop_flag; static GOptionEntry entries[] = { { "wda-set-data-format", 0, 0, G_OPTION_ARG_STRING, &set_data_format_str, - "Set data format", - "[raw-ip|802-3]" + "Set data format (allowed keys: link-layer-protocol (802-3|raw-ip), ul-protocol (tlp|qc-ncm|mbim|rndis|qmap), dl-protocol (tlp|qc-ncm|mbim|rndis|qmap), dl-datagrams-max-size, dl-max-datagrams, ep-type (undefined|hsusb), ep-iface-number)", + "[\"key=value,...\"]" }, { "wda-get-data-format", 0, 0, G_OPTION_ARG_NONE, &get_data_format_flag, "Get data format", @@ -294,29 +298,239 @@ set_data_format_ready (QmiClientWda *client, operation_shutdown (TRUE); } + +typedef struct { + QmiWdaLinkLayerProtocol link_layer_protocol; + QmiWdaDataAggregationProtocol ul_protocol; + QmiWdaDataAggregationProtocol dl_protocol; + guint32 dl_datagram_max_size; + guint32 dl_max_datagrams; + QmiDataEndpointType endpoint_type; + guint32 endpoint_iface_number; +} SetDataFormatProperties; + + +static gboolean +set_data_format_properties_handle (const gchar *key, + const gchar *value, + GError **error, + gpointer user_data) +{ + SetDataFormatProperties *props = (SetDataFormatProperties *)user_data; + + if (!value || !value[0]) { + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "key '%s' requires a value", + key); + return FALSE; + } + + if (g_ascii_strcasecmp (key, "link-layer-protocol") == 0) { + if (!qmicli_read_link_layer_protocol_from_string (value, &(props->link_layer_protocol))) { + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "Unrecognized Link Layer Protocol '%s'", + value); + return FALSE; + } + return TRUE; + } + + if (g_ascii_strcasecmp (key, "ul-protocol") == 0) { + if (!qmicli_read_data_aggregation_protocol_from_string (value, &(props->ul_protocol))) { + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "Unrecognized Data Aggregation Protocol '%s'", + value); + return FALSE; + } + return TRUE; + } + + if (g_ascii_strcasecmp (key, "dl-protocol") == 0) { + if (!qmicli_read_data_aggregation_protocol_from_string (value, &(props->dl_protocol))) { + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "Unrecognized Data Aggregation Protocol '%s'", + value); + return FALSE; + } + return TRUE; + } + + if (g_ascii_strcasecmp (key, "dl-datagram-max-size") == 0) { + props->dl_datagram_max_size = atoi(value); + return TRUE; + } + + if (g_ascii_strcasecmp (key, "dl-max-datagrams") == 0) { + props->dl_max_datagrams = atoi(value); + return TRUE; + } + + if (g_ascii_strcasecmp (key, "ep-type") == 0) { + if (!qmicli_read_data_endpoint_type_from_string (value, &(props->endpoint_type))) { + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "Unrecognized Endpoint Type '%s'", + value); + return FALSE; + } + return TRUE; + } + + if (g_ascii_strcasecmp (key, "ep-iface-number") == 0) { + props->endpoint_iface_number = atoi(value); + return TRUE; + } + + g_set_error (error, + QMI_CORE_ERROR, + QMI_CORE_ERROR_FAILED, + "Unrecognized option '%s'", + key); + return FALSE; +} + static QmiMessageWdaSetDataFormatInput * set_data_format_input_create (const gchar *str) { QmiMessageWdaSetDataFormatInput *input = NULL; - QmiWdaLinkLayerProtocol link_layer_protocol; + GError *error = NULL; + SetDataFormatProperties props = { + .link_layer_protocol = QMI_WDA_LINK_LAYER_PROTOCOL_UNKNOWN, + .ul_protocol = QMI_WDA_DATA_AGGREGATION_PROTOCOL_DISABLED, + .dl_protocol = QMI_WDA_DATA_AGGREGATION_PROTOCOL_DISABLED, + .dl_datagram_max_size = QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAM_SIZE_UNDEFINED, + .dl_max_datagrams = QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAMS_UNDEFINED, + .endpoint_type = QMI_DATA_ENDPOINT_TYPE_UNDEFINED, + .endpoint_iface_number = QMI_WDA_ENDPOINT_INTERFACE_NUMBER_UNDEFINED, + }; + + input = qmi_message_wda_set_data_format_input_new (); + + /* New key=value format */ + if (strchr (str, '=')) { + if (!qmicli_parse_key_value_string (str, + &error, + set_data_format_properties_handle, + &props)) { + g_printerr ("error: could not parse input string '%s'\n", error->message); + g_error_free (error); + goto error_out; + } + + if (!qmi_message_wda_set_data_format_input_set_uplink_data_aggregation_protocol ( + input, + props.ul_protocol, + &error)) { + g_printerr ("error: could not set Upload data aggregation protocol '%d': %s\n", + props.ul_protocol, error->message); + g_error_free (error); + goto error_out; + } + + if (!qmi_message_wda_set_data_format_input_set_downlink_data_aggregation_protocol ( + input, + props.dl_protocol, + &error)) { + g_printerr ("error: could not set Download data aggregation protocol '%d': %s\n", + props.dl_protocol, error->message); + g_error_free (error); + goto error_out; - if (qmicli_read_link_layer_protocol_from_string (str, &link_layer_protocol)) { - GError *error = NULL; + } - input = qmi_message_wda_set_data_format_input_new (); - if (!qmi_message_wda_set_data_format_input_set_link_layer_protocol ( + if (props.dl_datagram_max_size != QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAM_SIZE_UNDEFINED && + !qmi_message_wda_set_data_format_input_set_downlink_data_aggregation_max_size ( input, - link_layer_protocol, + props.dl_datagram_max_size, &error)) { - g_printerr ("error: couldn't create input data bundle: '%s'\n", - error->message); + g_printerr ("error: could not set Download data aggregation max size %d: %s\n", + props.dl_datagram_max_size, error->message); g_error_free (error); - qmi_message_wda_set_data_format_input_unref (input); - input = NULL; + goto error_out; + } + + if (props.dl_max_datagrams != QMI_WDA_DL_AGGREGATION_PROTOCOL_MAX_DATAGRAMS_UNDEFINED && + !qmi_message_wda_set_data_format_input_set_downlink_data_aggregation_max_datagrams ( + input, + props.dl_max_datagrams, + &error)) { + g_printerr ("error: could not set Download data aggregation max datagrams %d: %s\n", + props.dl_max_datagrams, error->message); + g_error_free (error); + goto error_out; + + } + + if ((props.endpoint_type == QMI_DATA_ENDPOINT_TYPE_UNDEFINED) ^ + (props.endpoint_iface_number == QMI_WDA_ENDPOINT_INTERFACE_NUMBER_UNDEFINED)) { + g_printerr ("error: endpoint type and interface number must be both set or both unset\n"); + goto error_out; + } + + if (props.endpoint_type != QMI_DATA_ENDPOINT_TYPE_UNDEFINED && + !qmi_message_wda_set_data_format_input_set_endpoint_info ( + input, + props.endpoint_type, + props.endpoint_iface_number, + &error)) { + g_printerr ("error: could not set peripheral endpoint id: %s\n", error->message); + g_error_free (error); + goto error_out; + + } + + if (props.endpoint_iface_number != QMI_WDA_ENDPOINT_INTERFACE_NUMBER_UNDEFINED && + !qmi_message_wda_set_data_format_input_set_endpoint_info ( + input, + QMI_DATA_ENDPOINT_TYPE_HSUSB, + props.endpoint_iface_number, + &error)) { + g_printerr ("error: could not set peripheral endpoint id: %s\n", error->message); + g_error_free (error); + goto error_out; + + } + } + /* Old non key=value format, like this: + * "[(raw-ip|802-3)]" + */ + else { + if (!qmicli_read_link_layer_protocol_from_string (str, &(props.link_layer_protocol))) { + g_printerr ("Unrecognized Link Layer Protocol '%s'\n", str); + goto error_out; + } + } + + if (props.link_layer_protocol == QMI_WDA_LINK_LAYER_PROTOCOL_UNKNOWN) { + g_printerr ("error: Link Layer Protocol value is missing\n"); + goto error_out; + } + + if (!qmi_message_wda_set_data_format_input_set_link_layer_protocol ( + input, + props.link_layer_protocol, + &error)) { + g_printerr ("error: couldn't create input data bundle: '%s'\n", + error->message); + g_error_free (error); + goto error_out; } return input; + +error_out: + qmi_message_wda_set_data_format_input_unref (input); + return NULL; } static void -- cgit v1.1