diff --git a/android/handsfree.c b/android/handsfree.c
index 70b730c..76a2de2 100644
--- a/android/handsfree.c
+++ b/android/handsfree.c
return true;
}
+static bool disconnect_sco(void)
+{
+ if (!device.sco)
+ return false;
+
+ device_set_audio_state(HAL_EV_HANDSFREE_AUDIO_STATE_DISCONNECTING);
+
+ if (device.sco_watch) {
+ g_source_remove(device.sco_watch);
+ device.sco_watch = 0;
+ }
+
+ g_io_channel_shutdown(device.sco, TRUE, NULL);
+ g_io_channel_unref(device.sco);
+ device.sco = NULL;
+
+ device_set_audio_state(HAL_EV_HANDSFREE_AUDIO_STATE_DISCONNECTED);
+
+ return true;
+}
+
static void handle_connect_audio(const void *buf, uint16_t len)
{
const struct hal_cmd_handsfree_connect_audio *cmd = buf;
static void handle_disconnect_audio(const void *buf, uint16_t len)
{
+ const struct hal_cmd_handsfree_disconnect_audio *cmd = buf;
+ bdaddr_t bdaddr;
+ uint8_t status;
+
DBG("");
+ android2bdaddr(cmd->bdaddr, &bdaddr);
+
+ if (device.audio_state != HAL_EV_HANDSFREE_AUDIO_STATE_CONNECTED ||
+ bacmp(&device.bdaddr, &bdaddr)) {
+ status = HAL_STATUS_FAILED;
+ goto done;
+ }
+
+ status = disconnect_sco() ? HAL_STATUS_SUCCESS : HAL_STATUS_FAILED;
+
+done:
ipc_send_rsp(hal_ipc, HAL_SERVICE_ID_HANDSFREE,
- HAL_OP_HANDSFREE_DISCONNECT_AUDIO, HAL_STATUS_FAILED);
+ HAL_OP_HANDSFREE_DISCONNECT_AUDIO, status);
}
static void handle_start_vr(const void *buf, uint16_t len)