12:26 p.m.
It handles client ATD*99# request and complete GPRS connection. Pass
client IP address through IPCP packet to client side.
---
include/emulator.h | 30 +++++++
src/emulator.c | 222 ++++++++++++++++++++++++++++++++++++++++++++++++++++
2 files changed, 252 insertions(+), 0 deletions(-)
diff --git a/include/emulator.h b/include/emulator.h
index 2a45c65..641f38c 100644
--- a/include/emulator.h
+++ b/include/emulator.h
@@ -34,10 +34,40 @@ enum ofono_emulator_status {
OFONO_EMULATOR_STATUS_IDLE = 0,
OFONO_EMULATOR_STATUS_CREATE,
OFONO_EMULATOR_STATUS_DESTROY,
+ OFONO_EMULATOR_STATUS_DUN_CONNECT,
+ OFONO_EMULATOR_STATUS_DUN_CONNECTED,
+ OFONO_EMULATOR_STATUS_DUN_DISCONNECTED,
};
enum _GAtServerResult;
+typedef void (*ofono_emulator_cb_t)(enum _GAtServerResult res, void *data);
+
+struct ofono_emulator_req {
+ void *data;
+ ofono_emulator_cb_t cb;
+ void *cb_data;
+};
+
+typedef void (*ofono_emulator_gprs_connect_cb)(const struct ofono_error *error,
+ const char *interface,
+ const char *local,
+ const char *peer,
+ const char **dns, void *data);
+
+struct ofono_emulator_gprs_connect_req {
+ const char *dial_str;
+ ofono_emulator_gprs_connect_cb cb;
+ void *cb_data;
+};
+
+struct ofono_emulator_gprs_context_req {
+ const char *proto;
+ const char *apn;
+ ofono_emulator_cb_t cb;
+ void *cb_data;
+};
+
struct ofono_emulator *ofono_emulator_create(struct ofono_modem *modem,
enum ofono_atom_type type,
GIOChannel *io);
diff --git a/src/emulator.c b/src/emulator.c
index 9ecc06c..378426c 100644
--- a/src/emulator.c
+++ b/src/emulator.c
@@ -32,6 +32,22 @@
#include "ofono.h"
#include "common.h"
#include "gatserver.h"
+#include "gatppp.h"
+
+struct context_settings {
+ char *interface;
+ gboolean static_ip;
+ char *ip;
+ char *netmask;
+ char *gateway;
+ char **dns;
+};
+
+struct dun_context {
+ ofono_bool_t active;
+ struct context_settings settings;
+ struct ofono_gprs_primary_context pri_ctx;
+};
struct ofono_emulator {
struct ofono_modem *modem;
@@ -39,6 +55,8 @@ struct ofono_emulator {
enum ofono_atom_type type;
unsigned int id;
GAtServer *server;
+ GAtPPP *ppp;
+ struct dun_context context;
enum ofono_emulator_status status;
struct ofono_watchlist *status_watches;
};
@@ -113,6 +131,201 @@ static void notify_status_watches(struct ofono_emulator *e, void
*data)
}
}
+static struct ofono_emulator_req *ofono_emulator_req_new(void *cb,
+ void *cb_data)
+{
+ struct ofono_emulator_req *req;
+
+ req = g_try_new0(struct ofono_emulator_req, 1);
+ if (!req)
+ return req;
+
+ req->cb = cb;
+ req->cb_data = cb_data;
+
+ return req;
+}
+
+static void ppp_connect(const char *interface, const char *local,
+ const char *remote,
+ const char *dns1, const char *dns2,
+ gpointer user_data)
+{
+ struct ofono_emulator *e = user_data;
+ struct dun_context *ctx = &e->context;
+ struct context_settings *settings = &ctx->settings;
+
+ e->status = OFONO_EMULATOR_STATUS_DUN_CONNECTED;
+ ctx->active = TRUE;
+
+ DBG("DUN server connected!\n");
+
+ DBG("Network Device: %s\n", settings->interface);
+ DBG("IP Address: %s\n", settings->ip);
+ DBG("Remote IP Address: %s\n", settings->gateway);
+ DBG("Primary DNS Server: %s\n", settings->dns[0]);
+ DBG("Secondary DNS Server: %s\n", settings->dns[1]);
+}
+
+static void ppp_disconnect(GAtPPPDisconnectReason reason, gpointer user_data)
+{
+ struct ofono_emulator *e = user_data;
+ struct dun_context *ctx = &e->context;
+ struct context_settings *settings = &ctx->settings;
+ struct ofono_emulator_req *req;
+
+ DBG("");
+
+ g_at_ppp_unref(e->ppp);
+ e->ppp = NULL;
+
+ g_at_server_resume(e->server);
+
+ ctx->active = FALSE;
+
+ g_free(settings->interface);
+ g_free(settings->ip);
+ g_free(settings->netmask);
+ g_free(settings->gateway);
+ g_strfreev(settings->dns);
+
+ req = ofono_emulator_req_new(NULL, NULL);
+ if (!req)
+ return;
+
+ e->status = OFONO_EMULATOR_STATUS_DUN_DISCONNECTED;
+ notify_status_watches(e, req);
+
+ g_free(req);
+}
+
+static gboolean setup_ppp(gpointer user_data)
+{
+ struct ofono_emulator *e = user_data;
+ GAtServer *server = e->server;
+ GAtIO *io;
+ struct context_settings *settings = &e->context.settings;
+
+ DBG("");
+
+ io = g_at_server_get_io(server);
+
+ /* suspend server port */
+ g_at_server_suspend(server);
+
+ /* open ppp */
+ e->ppp = g_at_ppp_server_new_from_io(io, settings->ip);
+ if (e->ppp == NULL) {
+ g_at_server_resume(server);
+ return FALSE;
+ }
+
+ g_at_ppp_set_server_info(e->ppp, settings->gateway,
+ settings->dns[0], settings->dns[1]);
+ g_at_ppp_set_credentials(e->ppp, "", "");
+ g_at_ppp_set_debug(e->ppp, ofono_emulator_debug, "PPP");
+
+ /* set connect and disconnect callbacks */
+ g_at_ppp_set_connect_function(e->ppp, ppp_connect, e);
+ g_at_ppp_set_disconnect_function(e->ppp, ppp_disconnect, e);
+
+ return FALSE;
+}
+
+static void gprs_connect_cb(const struct ofono_error *error,
+ const char *interface,
+ const char *local,
+ const char *peer,
+ const char **dns, void *data)
+{
+ struct ofono_emulator *e = data;
+ struct context_settings *settings = &e->context.settings;
+ const char *netmask = "255.255.255.255";
+
+ DBG("");
+
+ if (error->type != OFONO_ERROR_TYPE_NO_ERROR)
+ goto error;
+
+ if (!dns[0] || !dns[1])
+ goto error;
+
+ settings->interface = g_strdup(interface);
+ settings->static_ip = FALSE;
+ settings->ip = g_strdup(local);
+ settings->netmask = g_strdup(netmask);
+ settings->gateway = g_strdup(peer);
+ settings->dns = g_strdupv((char **)dns);
+
+ g_at_server_send_intermediate(e->server, "CONNECT");
+
+ g_idle_add(setup_ppp, e);
+
+ return;
+
+error:
+ g_at_server_send_final(e->server, G_AT_SERVER_RESULT_NO_CARRIER);
+}
+
+static gboolean dial_call(struct ofono_emulator *e, const char *dial_str)
+{
+ char c = *dial_str;
+
+ DBG("dial call %s", dial_str);
+
+ if (c == '*' || c == '#' || c == 'T' || c == 't') {
+ struct ofono_emulator_gprs_connect_req *req;
+
+ req = g_try_new0(struct ofono_emulator_gprs_connect_req, 1);
+ if (!req)
+ return FALSE;
+
+ req->cb = gprs_connect_cb;
+ req->cb_data = e;
+ req->dial_str = dial_str;
+
+ e->status = OFONO_EMULATOR_STATUS_DUN_CONNECT;
+ notify_status_watches(e, req);
+
+ g_free(req);
+ }
+
+ return TRUE;
+}
+
+static void dial_cb(GAtServerRequestType type, GAtResult *result,
+ gpointer user_data)
+{
+ struct ofono_emulator *e = user_data;
+ GAtServer *server = e->server;
+ GAtServerResult res = G_AT_SERVER_RESULT_ERROR;
+ GAtResultIter iter;
+ const char *dial_str;
+
+ if (type != G_AT_SERVER_REQUEST_TYPE_SET)
+ goto error;
+
+ g_at_result_iter_init(&iter, result);
+
+ if (!g_at_result_iter_next(&iter, "D"))
+ goto error;
+
+ dial_str = g_at_result_iter_raw_line(&iter);
+ if (!dial_str)
+ goto error;
+
+ if (e->context.active == TRUE)
+ goto error;
+
+ if (!dial_call(e, dial_str))
+ goto error;
+
+ return;
+
+error:
+ g_at_server_send_final(server, res);
+}
+
static void emulator_remove(struct ofono_atom *atom)
{
struct ofono_emulator *e = __ofono_atom_get_data(atom);
@@ -173,6 +386,13 @@ static void emulator_disconnect(gpointer user_data)
static void emulator_unregister(struct ofono_atom *atom)
{
+ struct ofono_emulator *e = __ofono_atom_get_data(atom);
+
+ if (e->ppp) {
+ g_at_ppp_shutdown(e->ppp);
+ g_at_ppp_unref(e->ppp);
+ e->ppp = NULL;
+ }
}
struct ofono_emulator *ofono_emulator_create(struct ofono_modem *modem,
@@ -205,5 +425,7 @@ struct ofono_emulator *ofono_emulator_create(struct ofono_modem
*modem,
__ofono_atom_register(e->atom, emulator_unregister);
+ g_at_server_register(e->server, "D", dial_cb, e, NULL);
+
return e;
}
--
1.7.0.4