diff --git a/android/handsfree.c b/android/handsfree.c
index cb5e657..7ca0ba8 100644
--- a/android/handsfree.c
+++ b/android/handsfree.c
hfp_gw_send_info(device.gw, "+BCS: %u", type);
}
-static void send_sco_fd(GIOChannel *chan)
-{
- if (sco_ipc) {
- int fd = g_io_channel_unix_get_fd(chan);
- GError *err = NULL;
- uint16_t mtu = 48;
- struct sco_rsp_connect rsp;
-
- if (!bt_io_get(chan, &err, BT_IO_OPT_MTU, &mtu,
- BT_IO_OPT_INVALID)) {
- error("Unable to get MTU: %s\n", err->message);
- g_clear_error(&err);
- }
-
- DBG("fd %d mtu %u", fd, mtu);
-
- rsp.mtu = mtu;
-
- ipc_send_rsp_full(sco_ipc, SCO_SERVICE_ID,
- SCO_OP_CONNECT, sizeof(rsp), &rsp,
- fd);
- }
-}
-
static void connect_sco_cb(GIOChannel *chan, GError *err, gpointer user_data)
{
if (err) {
sco_watch_cb, NULL);
device_set_audio_state(HAL_EV_HANDSFREE_AUDIO_STATE_CONNECTED);
- send_sco_fd(chan);
}
static bool connect_sco(void)
static void bt_sco_connect(const void *buf, uint16_t len)
{
+ int fd;
+ GError *err;
+ struct sco_rsp_connect rsp;
+
DBG("");
- if (device.sco) {
- send_sco_fd(device.sco);
- return;
+ if (!device.sco)
+ goto failed;
+
+ err = NULL;
+ if (!bt_io_get(device.sco, &err, BT_IO_OPT_MTU, &rsp.mtu,
+ BT_IO_OPT_INVALID)) {
+ error("Unable to get MTU: %s\n", err->message);
+ g_clear_error(&err);
+ goto failed;
}
- connect_audio();
+ fd = g_io_channel_unix_get_fd(device.sco);
+
+ DBG("fd %d mtu %u", fd, rsp.mtu);
+
+ ipc_send_rsp_full(sco_ipc, SCO_SERVICE_ID, SCO_OP_CONNECT,
+ sizeof(rsp), &rsp, fd);
+
+ return;
+
+failed:
+ ipc_send_rsp(sco_ipc, SCO_SERVICE_ID, SCO_OP_STATUS, SCO_STATUS_FAILED);
}
static const struct ipc_handler sco_handlers[] = {