/* * * oFono - Open Source Telephony * * Copyright (C) 2008-2011 Intel Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA * */ #ifdef HAVE_CONFIG_H #include #endif #include #include #include #include "ofono.h" #include "gatserver.h" #include "gatppp.h" #define DUN_SERVER_ADDRESS "192.168.1.1" #define DUN_PEER_ADDRESS "192.168.1.2" #define DUN_DNS_SERVER_1 "10.10.10.10" #define DUN_DNS_SERVER_2 "10.10.10.11" struct ofono_emulator { struct ofono_atom *atom; enum ofono_emulator_type type; GAtServer *server; GAtPPP *ppp; guint source; gboolean slc; int l_features; int r_features; int events_mode; gboolean events_ind; GSList *indicators; }; struct indicator { char *name; int value; int min; int max; }; static void emulator_debug(const char *str, void *data) { ofono_info("%s: %s\n", (char *)data, str); } static void emulator_disconnect(gpointer user_data) { struct ofono_emulator *em = user_data; DBG("%p", em); ofono_emulator_remove(em); } static void ppp_connect(const char *iface, const char *local, const char *remote, const char *dns1, const char *dns2, gpointer user_data) { DBG("Network Device: %s\n", iface); DBG("IP Address: %s\n", local); DBG("Remote IP Address: %s\n", remote); DBG("Primary DNS Server: %s\n", dns1); DBG("Secondary DNS Server: %s\n", dns2); } static void ppp_disconnect(GAtPPPDisconnectReason reason, gpointer user_data) { struct ofono_emulator *em = user_data; DBG(""); g_at_ppp_unref(em->ppp); em->ppp = NULL; if (em->server == NULL) return; g_at_server_resume(em->server); } static gboolean setup_ppp(gpointer user_data) { struct ofono_emulator *em = user_data; GAtIO *io; DBG(""); em->source = 0; io = g_at_server_get_io(em->server); g_at_server_suspend(em->server); em->ppp = g_at_ppp_server_new_from_io(io, DUN_SERVER_ADDRESS); if (em->ppp == NULL) { g_at_server_resume(em->server); return FALSE; } g_at_ppp_set_server_info(em->ppp, DUN_PEER_ADDRESS, DUN_DNS_SERVER_1, DUN_DNS_SERVER_2); g_at_ppp_set_credentials(em->ppp, "", ""); g_at_ppp_set_debug(em->ppp, emulator_debug, "PPP"); g_at_ppp_set_connect_function(em->ppp, ppp_connect, em); g_at_ppp_set_disconnect_function(em->ppp, ppp_disconnect, em); return FALSE; } static gboolean dial_call(struct ofono_emulator *em, const char *dial_str) { char c = *dial_str; DBG("dial call %s", dial_str); if (c == '*' || c == '#' || c == 'T' || c == 't') { g_at_server_send_intermediate(em->server, "CONNECT"); em->source = g_idle_add(setup_ppp, em); } return TRUE; } static void dial_cb(GAtServer *server, GAtServerRequestType type, GAtResult *result, gpointer user_data) { struct ofono_emulator *em = user_data; GAtResultIter iter; const char *dial_str; DBG(""); if (type != G_AT_SERVER_REQUEST_TYPE_SET) goto error; g_at_result_iter_init(&iter, result); if (!g_at_result_iter_next(&iter, "")) goto error; dial_str = g_at_result_iter_raw_line(&iter); if (!dial_str) goto error; if (em->ppp) goto error; if (!dial_call(em, dial_str)) goto error; return; error: g_at_server_send_final(em->server, G_AT_SERVER_RESULT_ERROR); } static void brsf_cb(GAtServer *server, GAtServerRequestType type, GAtResult *result, gpointer user_data) { struct ofono_emulator *em = user_data; GAtResultIter iter; int val; char buf[16]; switch (type) { case G_AT_SERVER_REQUEST_TYPE_SET: g_at_result_iter_init(&iter, result); g_at_result_iter_next(&iter, ""); if (g_at_result_iter_next_number(&iter, &val) == FALSE) goto fail; if ((val < 0) && (val > 127)) goto fail; em->r_features = val; sprintf(buf, "+BRSF: %d", em->l_features); g_at_server_send_info(em->server, buf, TRUE); g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); break; default: fail: g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR); break; } } static void cind_cb(GAtServer *server, GAtServerRequestType type, GAtResult *result, gpointer user_data) { struct ofono_emulator *em = user_data; GSList *l; struct indicator *ind; gsize size; int len; char *buf; char *tmp; switch (type) { case G_AT_SERVER_REQUEST_TYPE_QUERY: /* * "+CIND: " + terminating null + number of indicators * * (max of 3 digits in the value + separator) */ size = 7 + 1 + (g_slist_length(em->indicators) * 4); buf = g_try_malloc0(size); if (buf == NULL) goto fail; len = sprintf(buf, "+CIND: "); tmp = buf + len; for (l = em->indicators; l; l = l->next) { ind = l->data; len = sprintf(tmp, "%s%d", l == em->indicators ? "" : ",", ind->value); tmp = tmp + len; } g_at_server_send_info(em->server, buf, TRUE); g_free(buf); g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); break; case G_AT_SERVER_REQUEST_TYPE_SUPPORT: /* * '+CIND: ' + terminating null + number of indicators * * ( indicator name + '("",(000,000))' + separator) */ size = 8; for (l = em->indicators; l; l = l->next) { ind = l->data; size += strlen(ind->name) + 15; } buf = g_try_malloc0(size); if (buf == NULL) goto fail; len = sprintf(buf, "+CIND: "); tmp = buf + len; for (l = em->indicators; l; l = l->next) { ind = l->data; len = sprintf(tmp, "%s(\"%s\",(%d%c%d))", l == em->indicators ? "" : ",", ind->name, ind->min, (ind->max - ind->min) == 1 ? ',' : '-', ind->max); tmp = tmp + len; } g_at_server_send_info(server, buf, TRUE); g_free(buf); g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); break; default: fail: g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR); break; } } static void cmer_cb(GAtServer *server, GAtServerRequestType type, GAtResult *result, gpointer user_data) { struct ofono_emulator *em = user_data; char buf[32]; switch (type) { case G_AT_SERVER_REQUEST_TYPE_QUERY: sprintf(buf, "+CMER: %d,0,0,%d,0", em->events_mode, em->events_ind); g_at_server_send_info(em->server, buf, TRUE); g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); break; case G_AT_SERVER_REQUEST_TYPE_SUPPORT: sprintf(buf, "+CMER: (0,3),(0),(0),(0,1),(0)"); g_at_server_send_info(em->server, buf, TRUE); g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); break; case G_AT_SERVER_REQUEST_TYPE_SET: { GAtResultIter iter; int mode = em->events_mode; int ind = em->events_ind; int val; g_at_result_iter_init(&iter, result); g_at_result_iter_next(&iter, ""); /* mode */ if (!g_at_result_iter_next_number_default(&iter, mode, &mode)) goto fail; if (mode != 0 && mode != 3) goto fail; /* keyp */ if (!g_at_result_iter_next_number_default(&iter, 0, &val)) { if (!g_at_result_iter_skip_next(&iter)) goto done; goto fail; } if (val != 0) goto fail; /* disp */ if (!g_at_result_iter_next_number_default(&iter, 0, &val)) { if (!g_at_result_iter_skip_next(&iter)) goto done; goto fail; } if (val != 0) goto fail; /* ind */ if (!g_at_result_iter_next_number_default(&iter, ind, &ind)) { if (!g_at_result_iter_skip_next(&iter)) goto done; goto fail; } if (ind != 0 && ind != 1) goto fail; /* bfr */ if (!g_at_result_iter_next_number_default(&iter, 0, &val)) { if (!g_at_result_iter_skip_next(&iter)) goto done; goto fail; } if (val != 0) goto fail; /* check that bfr is last parameter */ if (g_at_result_iter_skip_next(&iter)) goto fail; done: em->events_mode = mode; em->events_ind = ind; g_at_server_send_final(server, G_AT_SERVER_RESULT_OK); em->slc = TRUE; break; } default: fail: g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR); break; } } static void emulator_add_indicator(struct ofono_emulator *em, const char* name, int min, int max, int dflt) { struct indicator *ind; ind = g_try_new0(struct indicator, 1); if (ind == NULL) { ofono_error("Unable to allocate indicator structure"); return; } ind->name = g_strdup(name); ind->min = min; ind->max = max; ind->value = dflt; em->indicators = g_slist_append(em->indicators, ind); } static void emulator_unregister(struct ofono_atom *atom) { struct ofono_emulator *em = __ofono_atom_get_data(atom); GSList *l; DBG("%p", em); if (em->source) { g_source_remove(em->source); em->source = 0; } for (l = em->indicators; l; l = l->next) { struct indicator *ind = l->data; g_free(ind->name); g_free(ind); } g_slist_free(em->indicators); em->indicators = NULL; g_at_server_unref(em->server); em->server = NULL; } void ofono_emulator_register(struct ofono_emulator *em, int fd) { GIOChannel *io; DBG("%p, %d", em, fd); if (fd < 0) return; io = g_io_channel_unix_new(fd); em->server = g_at_server_new(io); if (em->server == NULL) return; g_io_channel_unref(io); g_at_server_set_debug(em->server, emulator_debug, "Server"); g_at_server_set_disconnect_function(em->server, emulator_disconnect, em); if (em->type == OFONO_EMULATOR_TYPE_HFP) { emulator_add_indicator(em, OFONO_EMULATOR_IND_SERVICE, 0, 1, 0); emulator_add_indicator(em, OFONO_EMULATOR_IND_SIGNAL, 0, 5, 0); emulator_add_indicator(em, OFONO_EMULATOR_IND_ROAMING, 0, 1, 0); emulator_add_indicator(em, OFONO_EMULATOR_IND_BATTERY, 0, 5, 5); g_at_server_register(em->server, "+BRSF", brsf_cb, em, NULL); g_at_server_register(em->server, "+CIND", cind_cb, em, NULL); g_at_server_register(em->server, "+CMER", cmer_cb, em, NULL); } __ofono_atom_register(em->atom, emulator_unregister); if (em->type == OFONO_EMULATOR_TYPE_DUN) g_at_server_register(em->server, "D", dial_cb, em, NULL); else if (em->type == OFONO_EMULATOR_TYPE_HFP) g_at_server_set_echo(em->server, FALSE); } static void emulator_remove(struct ofono_atom *atom) { struct ofono_emulator *em = __ofono_atom_get_data(atom); DBG("atom: %p", atom); g_free(em); } struct ofono_emulator *ofono_emulator_create(struct ofono_modem *modem, enum ofono_emulator_type type) { struct ofono_emulator *em; enum ofono_atom_type atom_t; DBG("modem: %p, type: %d", modem, type); if (type == OFONO_EMULATOR_TYPE_DUN) atom_t = OFONO_ATOM_TYPE_EMULATOR_DUN; else if (type == OFONO_EMULATOR_TYPE_HFP) atom_t = OFONO_ATOM_TYPE_EMULATOR_HFP; else return NULL; em = g_try_new0(struct ofono_emulator, 1); if (em == NULL) return NULL; em->type = type; /* TODO: Check real local features */ em->l_features = 32; em->events_mode = 3; /* default mode is forwarding events */ em->atom = __ofono_modem_add_atom_offline(modem, atom_t, emulator_remove, em); return em; } void ofono_emulator_remove(struct ofono_emulator *em) { __ofono_atom_free(em->atom); } void ofono_emulator_send_final(struct ofono_emulator *em, const struct ofono_error *final) { char buf[256]; /* * TODO: Handle various CMEE modes and report error strings from * common.c */ switch (final->type) { case OFONO_ERROR_TYPE_CMS: sprintf(buf, "+CMS ERROR: %d", final->error); g_at_server_send_ext_final(em->server, buf); break; case OFONO_ERROR_TYPE_CME: sprintf(buf, "+CME ERROR: %d", final->error); g_at_server_send_ext_final(em->server, buf); break; case OFONO_ERROR_TYPE_NO_ERROR: g_at_server_send_final(em->server, G_AT_SERVER_RESULT_OK); break; case OFONO_ERROR_TYPE_CEER: case OFONO_ERROR_TYPE_SIM: case OFONO_ERROR_TYPE_FAILURE: g_at_server_send_final(em->server, G_AT_SERVER_RESULT_ERROR); break; }; } void ofono_emulator_send_unsolicited(struct ofono_emulator *em, const char *result) { g_at_server_send_unsolicited(em->server, result); } void ofono_emulator_send_intermediate(struct ofono_emulator *em, const char *result) { g_at_server_send_intermediate(em->server, result); } void ofono_emulator_send_info(struct ofono_emulator *em, const char *line, ofono_bool_t last) { g_at_server_send_info(em->server, line, last); } struct handler { ofono_emulator_request_cb_t cb; void *data; ofono_destroy_func destroy; struct ofono_emulator *em; }; struct ofono_emulator_request { GAtResultIter iter; enum ofono_emulator_request_type type; }; static void handler_proxy(GAtServer *server, GAtServerRequestType type, GAtResult *result, gpointer userdata) { struct handler *h = userdata; struct ofono_emulator_request req; if (h->em->type == OFONO_EMULATOR_TYPE_HFP && h->em->slc == FALSE) { g_at_server_send_final(h->em->server, G_AT_SERVER_RESULT_ERROR); return; } switch (type) { case G_AT_SERVER_REQUEST_TYPE_COMMAND_ONLY: req.type = OFONO_EMULATOR_REQUEST_TYPE_COMMAND_ONLY; break; case G_AT_SERVER_REQUEST_TYPE_SET: req.type = OFONO_EMULATOR_REQUEST_TYPE_SET; break; case G_AT_SERVER_REQUEST_TYPE_QUERY: req.type = OFONO_EMULATOR_REQUEST_TYPE_QUERY; break; case G_AT_SERVER_REQUEST_TYPE_SUPPORT: req.type = OFONO_EMULATOR_REQUEST_TYPE_SUPPORT; } g_at_result_iter_init(&req.iter, result); g_at_result_iter_next(&req.iter, ""); h->cb(h->em, &req, h->data); } static void handler_destroy(gpointer userdata) { struct handler *h = userdata; if (h->destroy) h->destroy(h->data); g_free(h); } ofono_bool_t ofono_emulator_add_handler(struct ofono_emulator *em, const char *prefix, ofono_emulator_request_cb_t cb, void *data, ofono_destroy_func destroy) { struct handler *h; h = g_new0(struct handler, 1); h->cb = cb; h->data = data; h->destroy = destroy; h->em = em; if (g_at_server_register(em->server, prefix, handler_proxy, h, handler_destroy) == TRUE) return TRUE; g_free(h); return FALSE; } ofono_bool_t ofono_emulator_remove_handler(struct ofono_emulator *em, const char *prefix) { return g_at_server_unregister(em->server, prefix); } ofono_bool_t ofono_emulator_request_next_string( struct ofono_emulator_request *req, const char **str) { return g_at_result_iter_next_string(&req->iter, str); } ofono_bool_t ofono_emulator_request_next_number( struct ofono_emulator_request *req, int *number) { return g_at_result_iter_next_number(&req->iter, number); } const char *ofono_emulator_request_get_raw(struct ofono_emulator_request *req) { return g_at_result_iter_raw_line(&req->iter); } enum ofono_emulator_request_type ofono_emulator_request_get_type( struct ofono_emulator_request *req) { return req->type; } void ofono_emulator_set_indicator(struct ofono_emulator *em, const char *name, int value) { GSList *l; int i; char buf[20]; for (i = 1, l = em->indicators; l; l = l->next, i++) { struct indicator *ind = l->data; if (g_str_equal(ind->name, name) == FALSE) continue; if (ind->value == value || value < ind->min || value > ind->max) return; ind->value = value; if (em->events_mode == 3 && em->events_ind && em->slc) { sprintf(buf, "+CIEV: %d,%d", i, ind->value); g_at_server_send_info(em->server, buf, TRUE); } return; } }