handsfree-audio: Add setting SCO air mode

diff --git a/src/handsfree-audio.c b/src/handsfree-audio.c
index 0bdeb99..c311b04 100644 (file)
--- a/src/handsfree-audio.c
+++ b/src/handsfree-audio.c
@@ -68,6 +68,33 @@ static GSList *drivers = 0;
 static ofono_bool_t has_wideband = FALSE;
 static int defer_setup = 1;
 
+static uint16_t codec2setting(uint8_t codec)
+{
+       switch (codec) {
+               case HFP_CODEC_CVSD:
+                       return BT_VOICE_CVSD_16BIT;
+               default:
+                       return BT_VOICE_TRANSPARENT;
+       }
+}
+
+static ofono_bool_t apply_settings_from_codec(int fd, uint8_t codec)
+{
+       struct bt_voice voice;
+
+       /* CVSD is the default, no need to set BT_VOICE. */
+       if (codec == HFP_CODEC_CVSD)
+               return TRUE;
+
+       memset(&voice, 0, sizeof(voice));
+       voice.setting = codec2setting(codec);
+
+       if (setsockopt(fd, SOL_BLUETOOTH, BT_VOICE, &voice, sizeof(voice)) < 0)
+               return FALSE;
+
+       return TRUE;
+}
+
 static void send_new_connection(const char *card, int fd, uint8_t codec)
 {
        DBusMessage *msg;
@@ -150,6 +177,11 @@ static gboolean sco_accept(GIOChannel *io, GIOCondition cond,
                return TRUE;
        }
 
+       if (apply_settings_from_codec(nsk, card->selected_codec) == FALSE) {
+               close(nsk);
+               return TRUE;
+       }
+
        send_new_connection(card->path, nsk, card->selected_codec);
        close(nsk);