[PATCH 4/4] atmodem: packet switch bearer support

[Rémi Denis-Courmont]

---
 drivers/atmodem/gprs.c |   50 ++++++++++++++++++++++++++++++++++++++++++++++++
 1 files changed, 50 insertions(+), 0 deletions(-)

diff --git a/drivers/atmodem/gprs.c b/drivers/atmodem/gprs.c
index a38c6b4..1d4a8bf 100644
--- a/drivers/atmodem/gprs.c
+++ b/drivers/atmodem/gprs.c
@@ -200,6 +200,54 @@ static void xdatastat_notify(GAtResult *result, gpointer 
user_data)
        }
 }
 
+static void cpsb_notify(GAtResult *result, gpointer user_data)
+{
+       struct ofono_gprs *gprs = user_data;
+       GAtResultIter iter;
+       gint cid, bearer;
+
+       g_at_result_iter_init(&iter, result);
+       if (!g_at_result_iter_next(&iter, "+CPSB:"))
+               return;
+       if (!g_at_result_iter_next_number(&iter, &cid))
+               return;
+       if (!g_at_result_iter_next_number(&iter, &bearer))
+               return;
+
+       ofono_gprs_bearer_notify(gprs, cid, bearer);
+}
+
+static void cpsb_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+       struct ofono_gprs *gprs = user_data;
+       GAtResultIter iter;
+       gint cid, bearer;
+
+       if (!ok)
+               return;
+
+       g_at_result_iter_init(&iter, result);
+       if (!g_at_result_iter_next(&iter, "+CPSB:"))
+               return;
+
+       g_at_result_iter_next_number(&iter, NULL);
+       while (g_at_result_iter_next_number(&iter, &cid) &&
+                       g_at_result_iter_next_number(&iter, &bearer))
+               ofono_gprs_bearer_notify(gprs, cid, bearer);
+}
+
+static void cpsb_set_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+       struct ofono_gprs *gprs = user_data;
+       struct gprs_data *gd = ofono_gprs_get_data(gprs);
+
+       if (!ok)
+               return;
+
+       g_at_chat_register(gd->chat, "+CPSB:", cpsb_notify, FALSE, gprs, NULL);
+       g_at_chat_send(gd->chat, "AT+CPSB?", none_prefix, cpsb_cb, gprs, NULL);
+}
+
 static void gprs_initialized(gboolean ok, GAtResult *result, gpointer 
user_data)
 {
        struct ofono_gprs *gprs = user_data;
@@ -208,6 +256,8 @@ static void gprs_initialized(gboolean ok, GAtResult 
*result, gpointer user_data)
        g_at_chat_register(gd->chat, "+CGEV:", cgev_notify, FALSE, gprs, NULL);
        g_at_chat_register(gd->chat, "+CGREG:", cgreg_notify,
                                        FALSE, gprs, NULL);
+       g_at_chat_send(gd->chat, "AT+CPSB=1", none_prefix,
+               cpsb_set_cb, gprs, NULL);
 
        switch (gd->vendor) {
        case OFONO_VENDOR_IFX:
-- 
1.7.1

_______________________________________________
ofono mailing list
ofono@ofono.org
http://lists.ofono.org/listinfo/ofono