--- src/voicecall.c | 111 ++++++++++++++++++++++++++++++++++++++++++++++++++++++- 1 files changed, 110 insertions(+), 1 deletions(-)
diff --git a/src/voicecall.c b/src/voicecall.c index 3af614b..066cdb9 100644 --- a/src/voicecall.c +++ b/src/voicecall.c @@ -52,6 +52,7 @@ struct ofono_voicecall { struct ofono_sim *sim; unsigned int sim_watch; unsigned int sim_state_watch; + unsigned int modem_online_watch; const struct ofono_voicecall_driver *driver; void *driver_data; struct ofono_atom *atom; @@ -133,6 +134,22 @@ static void add_to_en_list(GSList **l, const char **list) *l = g_slist_prepend(*l, g_strdup(list[i++])); } +static gint number_compare(gconstpointer a, gconstpointer b) +{ + const char *s1 = a, *s2 = b; + return strcmp(s1, s2); +} + +static ofono_bool_t emergency_number(struct ofono_voicecall *vc, + const char *number) +{ + if (!number) + return FALSE; + + return g_slist_find_custom(vc->en_list, + number, number_compare) ? TRUE : FALSE; +} + static const char *disconnect_reason_to_string(enum ofono_disconnect_reason r) { switch (r) { @@ -1125,6 +1142,7 @@ static struct voicecall *dial_handle_result(struct ofono_voicecall *vc, static void manager_dial_callback(const struct ofono_error *error, void *data) { struct ofono_voicecall *vc = data; + struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); DBusMessage *reply; const char *number; gboolean need_to_emit; @@ -1143,8 +1161,12 @@ static void manager_dial_callback(const struct ofono_error *error, void *data) dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path, DBUS_TYPE_INVALID); - } else + } else { + if (emergency_number(vc, number)) + ofono_modem_dec_emergency_mode(modem); + reply = __ofono_error_failed(vc->pending); + } __ofono_dbus_pending_reply(&vc->pending, reply); @@ -1156,6 +1178,7 @@ static DBusMessage *manager_dial(DBusConnection *conn, DBusMessage *msg, void *data) { struct ofono_voicecall *vc = data; + struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); const char *number; struct ofono_phone_number ph; const char *clirstr; @@ -1195,6 +1218,15 @@ static DBusMessage *manager_dial(DBusConnection *conn, string_to_phone_number(number, &ph); + if (emergency_number(vc, number)) { + ofono_bool_t online = ofono_modem_get_online(modem); + + ofono_modem_inc_emergency_mode(modem); + + if (!online) + return NULL; + } + vc->driver->dial(vc, &ph, clir, OFONO_CUG_OPTION_DEFAULT, manager_dial_callback, vc); @@ -1748,6 +1780,7 @@ void ofono_voicecall_disconnected(struct ofono_voicecall *vc, int id, const struct ofono_error *error) { struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); + const char *number; GSList *l; struct voicecall *call; time_t ts; @@ -1767,6 +1800,7 @@ void ofono_voicecall_disconnected(struct ofono_voicecall *vc, int id, } call = l->data; + number = phone_number_to_string(&call->call->phone_number); ts = time(NULL); prev_status = call->call->status; @@ -1805,6 +1839,9 @@ void ofono_voicecall_disconnected(struct ofono_voicecall *vc, int id, voicecalls_emit_call_removed(vc, call); + if (emergency_number(vc, number)) + ofono_modem_dec_emergency_mode(modem); + voicecall_dbus_unregister(vc, call); vc->call_list = g_slist_remove(vc->call_list, call); @@ -2067,6 +2104,7 @@ static void voicecall_unregister(struct ofono_atom *atom) static void voicecall_remove(struct ofono_atom *atom) { struct ofono_voicecall *vc = __ofono_atom_get_data(atom); + struct ofono_modem *modem = __ofono_atom_get_modem(atom); DBG("atom: %p", atom); @@ -2108,6 +2146,12 @@ static void voicecall_remove(struct ofono_atom *atom) g_queue_free(vc->toneq); } + if (vc->modem_online_watch) { + __ofono_modem_remove_online_watch(modem, + vc->modem_online_watch); + vc->modem_online_watch = 0; + } + g_free(vc); } @@ -2205,6 +2249,7 @@ static void sim_watch(struct ofono_atom *atom, static void dial_request_cb(const struct ofono_error *error, void *data) { struct ofono_voicecall *vc = data; + struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); gboolean need_to_emit; struct voicecall *v; @@ -2214,6 +2259,9 @@ static void dial_request_cb(const struct ofono_error *error, void *data) if (v == NULL) { dial_request_finish(vc); + if (emergency_number(vc, + phone_number_to_string(&vc->dial_req->ph))) + ofono_modem_dec_emergency_mode(modem); return; } @@ -2237,6 +2285,53 @@ static void dial_request_cb(const struct ofono_error *error, void *data) voicecalls_emit_call_added(vc, v); } +static void modem_online_watch(ofono_bool_t online, void *data) +{ + struct ofono_voicecall *vc = data; + struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); + DBusMessage *reply; + const char *number; + struct ofono_phone_number ph; + const char *clirstr; + enum ofono_clir_option clir; + + if (ofono_modem_get_emergency_mode(modem) != TRUE) + return; + + if (vc->dial_req) + vc->driver->dial(vc, &vc->dial_req->ph, + OFONO_CLIR_OPTION_DEFAULT, + OFONO_CUG_OPTION_DEFAULT, + dial_request_cb, vc); + + if (!vc->pending) + return; + + if (strcmp(dbus_message_get_member(vc->pending), "Dial")) + return; + + if (dbus_message_get_args(vc->pending, NULL, DBUS_TYPE_STRING, &number, + DBUS_TYPE_STRING, &clirstr, + DBUS_TYPE_INVALID) == FALSE) + return; + + if (!emergency_number(vc, number)) + return; + + if (!online) { + reply = __ofono_error_failed(vc->pending); + __ofono_dbus_pending_reply(&vc->pending, reply); + ofono_modem_dec_emergency_mode(modem); + return; + } + + clir_string_to_clir(clirstr, &clir); + string_to_phone_number(number, &ph); + + vc->driver->dial(vc, &ph, clir, OFONO_CUG_OPTION_DEFAULT, + manager_dial_callback, vc); +} + void ofono_voicecall_register(struct ofono_voicecall *vc) { DBusConnection *conn = ofono_dbus_get_connection(); @@ -2255,6 +2350,9 @@ void ofono_voicecall_register(struct ofono_voicecall *vc) } ofono_modem_add_interface(modem, OFONO_VOICECALL_MANAGER_INTERFACE); + vc->modem_online_watch = __ofono_modem_add_online_watch(modem, + modem_online_watch, + vc, NULL); /* * Start out with the 22.101 mandated numbers, if we have a SIM and @@ -2331,6 +2429,17 @@ ofono_bool_t __ofono_voicecall_is_busy(struct ofono_voicecall *vc, static void dial_request(struct ofono_voicecall *vc) { + struct ofono_modem *modem = __ofono_atom_get_modem(vc->atom); + + if (emergency_number(vc, phone_number_to_string(&vc->dial_req->ph))) { + ofono_bool_t online = ofono_modem_get_online(modem); + + ofono_modem_inc_emergency_mode(modem); + + if (!online) + return; + } + vc->driver->dial(vc, &vc->dial_req->ph, OFONO_CLIR_OPTION_DEFAULT, OFONO_CUG_OPTION_DEFAULT, dial_request_cb, vc); } -- 1.7.0.4 _______________________________________________ ofono mailing list ofono@ofono.org http://lists.ofono.org/listinfo/ofono