[PATCH 4/5] ublox: gprs-context: query networking mode for TOBY L2

[Jonas Bonn]

The TOBY L2 may run in either "bridge" mode or "router" mode.  For this
model, query the configured mode so that the appropriate settings are
communicated when the context is activated.
---

Only compile tested... I don't actually have a TOBY L2.

/Jonas

 drivers/ubloxmodem/gprs-context.c | 54 ++++++++++++++++++++++++++++++-
 1 file changed, 53 insertions(+), 1 deletion(-)

diff --git a/drivers/ubloxmodem/gprs-context.c 
b/drivers/ubloxmodem/gprs-context.c
index 389868c1..35abae02 100644
--- a/drivers/ubloxmodem/gprs-context.c
+++ b/drivers/ubloxmodem/gprs-context.c
@@ -43,6 +43,12 @@
 static const char *none_prefix[] = { NULL };
 static const char *cgcontrdp_prefix[] = { "+CGCONTRDP:", NULL };
 static const char *uipaddr_prefix[] = { "+UIPADDR:", NULL };
+static const char *ubmconf_prefix[] = { "+UBMCONF:", NULL };
+
+enum netmode {
+       NETWORKING_MODE_ROUTER,
+       NETWORKING_MODE_BRIDGE,
+};
 
 struct gprs_context_data {
        const struct ublox_model *model;
@@ -50,6 +56,7 @@ struct gprs_context_data {
        unsigned int active_context;
        ofono_gprs_context_cb_t cb;
        void *cb_data;
+       enum netmode networking_mode;
 };
 
 static void uipaddr_cb(gboolean ok, GAtResult *result, gpointer user_data)
@@ -240,7 +247,7 @@ static void ublox_gprs_read_settings(struct 
ofono_gprs_context *gc,
 
        DBG("cid %u", cid);
 
-       if (ublox_is_toby_l4(gcd->model)) {
+       if (gcd->networking_mode == NETWORKING_MODE_ROUTER) {
                /* Use DHCP */
                gcd->active_context = cid;
                set_gprs_context_interface(gc);
@@ -471,6 +478,42 @@ static void cgev_notify(GAtResult *result, gpointer 
user_data)
        gcd->active_context = 0;
 }
 
+static void at_ubmconf_read_cb(gboolean ok, GAtResult *result,
+                               gpointer user_data)
+{
+       struct ofono_gprs_context *gc = user_data;
+       struct gprs_context_data *gcd = ofono_gprs_context_get_data(gc);
+       GAtResultIter iter;
+       int mode;
+
+       if (!ok)
+               goto error;
+
+       g_at_result_iter_init(&iter, result);
+       if (!g_at_result_iter_next(&iter, "+UBMCONF:"))
+               goto error;
+
+       if (!g_at_result_iter_next_number(&iter, &mode))
+               goto error;
+
+       switch (mode) {
+       case 1:
+               gcd->networking_mode = NETWORKING_MODE_ROUTER;
+               break;
+       case 2:
+               gcd->networking_mode = NETWORKING_MODE_BRIDGE;
+               break;
+       default:
+               goto error;
+       }
+
+       return;
+
+error:
+       ofono_error("AT+UBMCONF? failed; assuming router mode");
+       gcd->networking_mode = NETWORKING_MODE_ROUTER;
+}
+
 static int ublox_gprs_context_probe(struct ofono_gprs_context *gc,
                                        unsigned int model_id, void *data)
 {
@@ -491,6 +534,15 @@ static int ublox_gprs_context_probe(struct 
ofono_gprs_context *gc,
 
        ofono_gprs_context_set_data(gc, gcd);
 
+       if (ublox_is_toby_l2(gcd->model)) {
+               g_at_chat_send(chat, "AT+UBMCONF?", ubmconf_prefix,
+                               at_ubmconf_read_cb, gc, NULL);
+       } else if (ublox_is_toby_l4(gcd->model)) {
+               gcd->networking_mode = NETWORKING_MODE_ROUTER;
+       } else {
+               gcd->networking_mode = NETWORKING_MODE_ROUTER;
+       }
+
        g_at_chat_register(chat, "+CGEV:", cgev_notify, FALSE, gc, NULL);
 
        return 0;
-- 
2.19.1

_______________________________________________
ofono mailing list
ofono@ofono.org
https://lists.ofono.org/mailman/listinfo/ofono