This patch adds the initial SCO server socket handling.
---
plugins/hfp_ag_bluez5.c | 83 +++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 83 insertions(+)
diff --git a/plugins/hfp_ag_bluez5.c b/plugins/hfp_ag_bluez5.c
index c6b858e..ee8c8bf 100644
--- a/plugins/hfp_ag_bluez5.c
+++ b/plugins/hfp_ag_bluez5.c
@@ -48,6 +48,7 @@ struct hfp_ag {
struct ofono_emulator *em;
bdaddr_t local;
bdaddr_t peer;
+ guint sco_watch;
};
static guint modemwatch_id;
@@ -64,6 +65,9 @@ static void free_hfp_ag(void *data)
if (hfp_ag == NULL)
return;
+ if (hfp_ag->sco_watch)
+ g_source_remove(hfp_ag->sco_watch);
+
hfp_ags = g_slist_remove(hfp_ags, hfp_ag);
g_free(hfp_ag);
}
@@ -206,6 +210,82 @@ static const GDBusMethodTable profile_methods[] = {
{ }
};
+static gboolean sco_cb(GIOChannel *io, GIOCondition cond,
+ gpointer user_data)
+
+{
+ struct hfp_ag *hfp_ag = user_data;
+ char adapter_address[18];
+ char device_address[18];
+
+ if (cond & (G_IO_ERR | G_IO_HUP | G_IO_NVAL)) {
+ hfp_ag->sco_watch = 0;
+
+ bt_ba2str(&hfp_ag->local, adapter_address);
+ bt_ba2str(&hfp_ag->peer, device_address);
+ DBG("SCO: %s - %s (closed)", adapter_address, device_address);
+
+ return FALSE;
+ }
+
+ return TRUE;
+}
+
+static gboolean hfp_ag_sco_accept(int fd, struct sockaddr_sco *raddr)
+{
+ struct sockaddr_sco laddr;
+ socklen_t optlen;
+ GSList *l;
+ char adapter_address[18];
+ char device_address[18];
+ struct hfp_ag *hfp_ag = NULL;
+ GIOChannel *sco_io;
+ int err;
+
+ memset(&laddr, 0, sizeof(laddr));
+ optlen = sizeof(laddr);
+ if (getsockname(fd, (struct sockaddr *) &laddr, &optlen) < 0) {
+ err = errno;
+ ofono_error("SCO getsockname(): %s (%d)", strerror(err), err);
+ return FALSE;
+ }
+
+ for (l = hfp_ags; l; l = l->next) {
+ struct hfp_ag *tmp = l->data;
+
+ if (bt_bacmp(&laddr.sco_bdaddr, &tmp->local) != 0)
+ continue;
+
+ if (bt_bacmp(&raddr->sco_bdaddr, &tmp->peer) != 0)
+ continue;
+
+ hfp_ag = tmp;
+ break;
+ }
+
+ if (!hfp_ag) {
+ ofono_error("Rejecting SCO: SLC connection missing!");
+ return FALSE;
+ }
+
+ bt_ba2str(&laddr.sco_bdaddr, adapter_address);
+ bt_ba2str(&raddr->sco_bdaddr, device_address);
+ DBG("SCO: %s < %s (incoming)", adapter_address, device_address);
+
+ sco_io = g_io_channel_unix_new(fd);
+
+ g_io_channel_set_close_on_unref(sco_io, TRUE);
+ g_io_channel_set_flags(sco_io, G_IO_FLAG_NONBLOCK, NULL);
+
+ hfp_ag->sco_watch = g_io_add_watch(sco_io,
+ G_IO_ERR | G_IO_HUP | G_IO_NVAL,
+ sco_cb, hfp_ag);
+
+ g_io_channel_unref(sco_io);
+
+ return TRUE;
+}
+
static void sim_state_watch(enum ofono_sim_state new_state, void *data)
{
struct ofono_modem *modem = data;
@@ -219,6 +299,7 @@ static void sim_state_watch(enum ofono_sim_state new_state,
void *data)
if (modems != NULL)
return;
+ bt_unregister_sco_server(hfp_ag_sco_accept);
bluetooth_unregister_profile(conn, HFP_AG_EXT_PROFILE_PATH);
return;
@@ -234,6 +315,8 @@ static void sim_state_watch(enum ofono_sim_state new_state,
void *data)
bluetooth_register_profile(conn, HFP_AG_UUID, "hfp_ag",
HFP_AG_EXT_PROFILE_PATH);
+
+ bt_register_sco_server(hfp_ag_sco_accept);
}
static gboolean sim_watch_remove(gpointer key, gpointer value,
--
1.7.9.5
_______________________________________________
ofono mailing list
ofono@ofono.org
http://lists.ofono.org/listinfo/ofono
