From mboxrd@z Thu Jan 1 00:00:00 1970 Content-Type: multipart/mixed; boundary="===============1272191491038236727==" MIME-Version: 1.0 From: =?unknown-8bit?q?Fr=C3=A9d=C3=A9ric?= Danis Subject: [PATCH v3 1/2] hfp_ag: start server on sim 'ready' state Date: Thu, 21 Jul 2011 16:58:08 +0200 Message-ID: <1311260289-15708-1-git-send-email-frederic.danis@linux.intel.com> List-Id: To: ofono@ofono.org --===============1272191491038236727== Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable update HFP AG server to start only when a modem has its SIM atom in 'ready' state and has voice call capability --- plugins/hfp_ag.c | 69 +++++++++++++++++++++++++++++++++++++++++++-------= ---- 1 files changed, 55 insertions(+), 14 deletions(-) diff --git a/plugins/hfp_ag.c b/plugins/hfp_ag.c index 191708b..a97b3d0 100644 --- a/plugins/hfp_ag.c +++ b/plugins/hfp_ag.c @@ -40,6 +40,7 @@ static struct server *server; static guint modemwatch_id; static GList *modems; +static GHashTable *sim_hash =3D NULL; = static const gchar *hfp_ag_record =3D "\n" @@ -115,27 +116,63 @@ static void hfp_ag_connect_cb(GIOChannel *io, GError = *err, gpointer user_data) ofono_emulator_register(em, fd); } = -static void voicecall_watch(struct ofono_atom *atom, - enum ofono_atom_watch_condition cond, - void *data) +static void sim_state_watch(enum ofono_sim_state new_state, void *data) { struct ofono_modem *modem =3D data; = - if (cond =3D=3D OFONO_ATOM_WATCH_CONDITION_REGISTERED) { - modems =3D g_list_append(modems, modem); - - if (modems->next =3D=3D NULL) - server =3D bluetooth_register_server(HFP_AG_CHANNEL, - hfp_ag_record, - hfp_ag_connect_cb, - NULL); - } else { + if (new_state !=3D OFONO_SIM_STATE_READY) { modems =3D g_list_remove(modems, modem); if (modems =3D=3D NULL && server !=3D NULL) { bluetooth_unregister_server(server); server =3D NULL; } + + return; } + + if (__ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_VOICECALL) + =3D=3D NULL) + return; + + modems =3D g_list_append(modems, modem); + + if (modems->next =3D=3D NULL) + server =3D bluetooth_register_server(HFP_AG_CHANNEL, + hfp_ag_record, + hfp_ag_connect_cb, + NULL); +} + +static gboolean sim_watch_remove(gpointer key, gpointer value, + gpointer user_data) +{ + struct ofono_sim *sim =3D key; + + ofono_sim_remove_state_watch(sim, GPOINTER_TO_UINT(value)); + + return TRUE; +} + +static void sim_watch(struct ofono_atom *atom, + enum ofono_atom_watch_condition cond, + void *data) +{ + struct ofono_sim *sim =3D __ofono_atom_get_data(atom); + struct ofono_modem *modem =3D data; + int watch; + + if (cond =3D=3D OFONO_ATOM_WATCH_CONDITION_UNREGISTERED) { + sim_state_watch(OFONO_SIM_STATE_NOT_PRESENT, modem); + + sim_watch_remove(sim, g_hash_table_lookup(sim_hash, sim), NULL); + g_hash_table_remove(sim_hash, sim); + + return; + } + + watch =3D ofono_sim_add_state_watch(sim, sim_state_watch, modem, NULL); + g_hash_table_insert(sim_hash, sim, GUINT_TO_POINTER(watch)); + sim_state_watch(ofono_sim_get_state(sim), modem); } = static void modem_watch(struct ofono_modem *modem, gboolean added, void *u= ser) @@ -145,8 +182,8 @@ static void modem_watch(struct ofono_modem *modem, gboo= lean added, void *user) if (added =3D=3D FALSE) return; = - __ofono_modem_add_atom_watch(modem, OFONO_ATOM_TYPE_VOICECALL, - voicecall_watch, modem, NULL); + __ofono_modem_add_atom_watch(modem, OFONO_ATOM_TYPE_SIM, + sim_watch, modem, NULL); } = static void call_modemwatch(struct ofono_modem *modem, void *user) @@ -156,6 +193,8 @@ static void call_modemwatch(struct ofono_modem *modem, = void *user) = static int hfp_ag_init() { + sim_hash =3D g_hash_table_new(g_direct_hash, g_direct_equal); + modemwatch_id =3D __ofono_modemwatch_add(modem_watch, NULL, NULL); __ofono_modem_foreach(call_modemwatch, NULL); = @@ -166,6 +205,8 @@ static void hfp_ag_exit() { __ofono_modemwatch_remove(modemwatch_id); g_list_free(modems); + g_hash_table_foreach_remove(sim_hash, sim_watch_remove, NULL); + g_hash_table_destroy(sim_hash); = if (server) { bluetooth_unregister_server(server); -- = 1.7.1 --===============1272191491038236727==--