/*** This file is part of PulseAudio. Copyright 2014 Wim Taymans PulseAudio is free software; you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; either version 2.1 of the License, or (at your option) any later version. PulseAudio is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU Lesser General Public License along with PulseAudio; if not, see . ***/ #ifdef HAVE_CONFIG_H #include #endif #include #include #include #include #include #include #include #include #include #include #include #include "bluez5-util.h" #include "bt-codec-msbc.h" #include "upower.h" #define MANDATORY_CALL_INDICATORS \ "(\"call\",(0-1))," \ "(\"callsetup\",(0-3))," \ "(\"callheld\",(0-2))" \ struct pa_bluetooth_backend { pa_core *core; pa_dbus_connection *connection; pa_bluetooth_discovery *discovery; pa_hook_slot *adapter_uuids_changed_slot; pa_hook_slot *host_battery_level_changed_slot; pa_upower_backend *upower; bool enable_shared_profiles; bool enable_hsp_hs; bool enable_hfp_hf; bool cmer_indicator_reporting_enabled; uint32_t cind_enabled_indicators; PA_LLIST_HEAD(pa_dbus_pending, pending); }; struct transport_data { int rfcomm_fd; pa_io_event *rfcomm_io; int sco_fd; pa_io_event *sco_io; pa_mainloop_api *mainloop; }; struct hfp_config { uint32_t capabilities; int state; bool support_codec_negotiation; bool support_msbc; bool supports_indicators; int selected_codec; }; /* * the separate hansfree headset (HF) and Audio Gateway (AG) features */ enum hfp_hf_features { HFP_HF_EC_NR = 0, HFP_HF_CALL_WAITING = 1, HFP_HF_CLI = 2, HFP_HF_VR = 3, HFP_HF_RVOL = 4, HFP_HF_ESTATUS = 5, HFP_HF_ECALL = 6, HFP_HF_CODECS = 7, HFP_HF_INDICATORS = 8, }; enum hfp_ag_features { HFP_AG_THREE_WAY = 0, HFP_AG_EC_NR = 1, HFP_AG_VR = 2, HFP_AG_RING = 3, HFP_AG_NUM_TAG = 4, HFP_AG_REJECT = 5, HFP_AG_ESTATUS = 6, HFP_AG_ECALL = 7, HFP_AG_EERR = 8, HFP_AG_CODECS = 9, HFP_AG_INDICATORS = 10, }; /* * Always keep this struct in sync with indicator discovery of AT+CIND=? * These indicators are used in bitflags and intentionally start at 1 * since AT+CIND indicators start at index 1. */ typedef enum pa_bluetooth_ag_to_hf_indicators { CIND_CALL_INDICATOR = 1, CIND_CALL_SETUP_INDICATOR = 2, CIND_CALL_HELD_INDICATOR = 3, CIND_SERVICE_INDICATOR = 4, CIND_BATT_CHG_INDICATOR = 5, CIND_INDICATOR_MAX = 6 } pa_bluetooth_ag_to_hf_indicators_t; /* gateway features we support, which is as little as we can get away with */ static uint32_t hfp_features = /* HFP 1.6 requires this */ (1 << HFP_AG_ESTATUS ) | (1 << HFP_AG_CODECS) | (1 << HFP_AG_INDICATORS); #define HSP_AG_PROFILE "/Profile/HSPAGProfile" #define HFP_AG_PROFILE "/Profile/HFPAGProfile" #define HSP_HS_PROFILE "/Profile/HSPHSProfile" /* RFCOMM channel for HSP headset role * The choice seems to be a bit arbitrary -- it looks like at least channels 2, 4 and 5 also work*/ #define HSP_HS_DEFAULT_CHANNEL 3 /* Total number of trying to reconnect */ #define SCO_RECONNECTION_COUNT 3 #define PROFILE_INTROSPECT_XML \ DBUS_INTROSPECT_1_0_XML_DOCTYPE_DECL_NODE \ "" \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ " " \ "" static pa_volume_t hsp_gain_to_volume(uint16_t gain) { pa_volume_t volume = (pa_volume_t) (( gain * PA_VOLUME_NORM /* Round to closest by adding half the denominator */ + HSP_MAX_GAIN / 2 ) / HSP_MAX_GAIN); if (volume > PA_VOLUME_NORM) volume = PA_VOLUME_NORM; return volume; } static uint16_t volume_to_hsp_gain(pa_volume_t volume) { uint16_t gain = volume * HSP_MAX_GAIN / PA_VOLUME_NORM; if (gain > HSP_MAX_GAIN) gain = HSP_MAX_GAIN; return gain; } static bool is_peer_audio_gateway(pa_bluetooth_profile_t peer_profile) { switch(peer_profile) { case PA_BLUETOOTH_PROFILE_HFP_HF: case PA_BLUETOOTH_PROFILE_HSP_HS: return false; case PA_BLUETOOTH_PROFILE_HFP_AG: case PA_BLUETOOTH_PROFILE_HSP_AG: return true; default: pa_assert_not_reached(); } } static bool is_pulseaudio_audio_gateway(pa_bluetooth_profile_t peer_profile) { return !is_peer_audio_gateway(peer_profile); } static pa_dbus_pending* send_and_add_to_pending(pa_bluetooth_backend *backend, DBusMessage *m, DBusPendingCallNotifyFunction func, void *call_data) { pa_dbus_pending *p; DBusPendingCall *call; pa_assert(backend); pa_assert(m); pa_assert_se(dbus_connection_send_with_reply(pa_dbus_connection_get(backend->connection), m, &call, -1)); p = pa_dbus_pending_new(pa_dbus_connection_get(backend->connection), m, call, backend, call_data); PA_LLIST_PREPEND(pa_dbus_pending, backend->pending, p); dbus_pending_call_set_notify(call, func, p, NULL); return p; } static void rfcomm_fmt_write(int fd, const char* fmt_line, const char *fmt_command, va_list ap) { size_t len; char buf[512]; char command[512]; pa_vsnprintf(command, sizeof(command), fmt_command, ap); pa_log_debug("RFCOMM >> %s", command); len = pa_snprintf(buf, sizeof(buf), fmt_line, command); /* we ignore any errors, it's not critical and real errors should * be caught with the HANGUP and ERROR events handled above */ if ((size_t)write(fd, buf, len) != len) pa_log_error("RFCOMM write error: %s", pa_cstrerror(errno)); } /* The format of COMMAND line sent from HS to AG is COMMAND */ static void rfcomm_write_command(int fd, const char *fmt, ...) { va_list ap; va_start(ap, fmt); rfcomm_fmt_write(fd, "%s\r", fmt, ap); va_end(ap); } /* The format of RESPONSE line sent from AG to HS is RESPONSE */ static void rfcomm_write_response(int fd, const char *fmt, ...) { va_list ap; va_start(ap, fmt); rfcomm_fmt_write(fd, "\r\n%s\r\n", fmt, ap); va_end(ap); } static int sco_setsockopt_enable_bt_voice(pa_bluetooth_transport *t, int fd) { /* the mSBC codec requires a special transparent eSCO connection */ struct bt_voice voice; memset(&voice, 0, sizeof(voice)); voice.setting = BT_VOICE_TRANSPARENT; if (setsockopt(fd, SOL_BLUETOOTH, BT_VOICE, &voice, sizeof(voice)) < 0) { pa_log_error("sockopt(): %s", pa_cstrerror(errno)); return -1; } pa_log_info("Enabled BT_VOICE_TRANSPARENT connection for mSBC"); return 0; } static int sco_do_connect(pa_bluetooth_transport *t) { pa_bluetooth_device *d = t->device; struct sockaddr_sco addr; socklen_t len; int err, i; int sock; bdaddr_t src; bdaddr_t dst; const char *src_addr, *dst_addr; src_addr = d->adapter->address; dst_addr = d->address; /* don't use ba2str to avoid -lbluetooth */ for (i = 5; i >= 0; i--, src_addr += 3) src.b[i] = strtol(src_addr, NULL, 16); for (i = 5; i >= 0; i--, dst_addr += 3) dst.b[i] = strtol(dst_addr, NULL, 16); sock = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_SCO); if (sock < 0) { pa_log_error("socket(SEQPACKET, SCO) %s", pa_cstrerror(errno)); return -1; } len = sizeof(addr); memset(&addr, 0, len); addr.sco_family = AF_BLUETOOTH; bacpy(&addr.sco_bdaddr, &src); if (bind(sock, (struct sockaddr *) &addr, len) < 0) { pa_log_error("bind(): %s", pa_cstrerror(errno)); goto fail_close; } if (t->setsockopt && t->setsockopt(t, sock) < 0) goto fail_close; memset(&addr, 0, len); addr.sco_family = AF_BLUETOOTH; bacpy(&addr.sco_bdaddr, &dst); pa_log_info("doing connect"); err = connect(sock, (struct sockaddr *) &addr, len); if (err < 0 && !(errno == EAGAIN || errno == EINPROGRESS)) { pa_log_error("connect(): %s", pa_cstrerror(errno)); goto fail_close; } return sock; fail_close: close(sock); return -1; } static int sco_do_accept(pa_bluetooth_transport *t) { struct transport_data *trd = t->userdata; struct sockaddr_sco addr; socklen_t optlen; int sock; memset(&addr, 0, sizeof(addr)); optlen = sizeof(addr); pa_log_info ("doing accept"); sock = accept(trd->sco_fd, (struct sockaddr *) &addr, &optlen); if (sock < 0) { if (errno != EAGAIN) pa_log_error("accept(): %s", pa_cstrerror(errno)); goto fail; } return sock; fail: return -1; } static int sco_acquire_cb(pa_bluetooth_transport *t, bool optional, size_t *imtu, size_t *omtu) { int sock; socklen_t len; int i; if (optional) sock = sco_do_accept(t); else { for (i = 0; i < SCO_RECONNECTION_COUNT; i++) { sock = sco_do_connect(t); if (sock < 0) { pa_log_debug("err is %s and reconnection count is %d", pa_cstrerror(errno), i); pa_msleep(300); continue; } else break; } } if (sock < 0) goto fail; /* The correct block size should take into account the SCO MTU from * the Bluetooth adapter and (for adapters in the USB bus) the MxPS * value from the Isoc USB endpoint in use by btusb and should be * made available to userspace by the Bluetooth kernel subsystem. * * Set initial MTU to max known payload length of HCI packet * in USB Alternate Setting 5 (144 bytes) * See also pa_bluetooth_transport::last_read_size handling * and comment about MTU size in bt_prepare_encoder_buffer() */ if (imtu) *imtu = 144; if (omtu) *omtu = 144; if (t->device->autodetect_mtu) { struct sco_options sco_opt; len = sizeof(sco_opt); memset(&sco_opt, 0, len); if (getsockopt(sock, SOL_SCO, SCO_OPTIONS, &sco_opt, &len) < 0) pa_log_warn("getsockopt(SCO_OPTIONS) failed, loading defaults"); else { pa_log_debug("autodetected imtu = omtu = %u", sco_opt.mtu); if (imtu) *imtu = sco_opt.mtu; if (omtu) *omtu = sco_opt.mtu; } } return sock; fail: return -1; } static void sco_release_cb(pa_bluetooth_transport *t) { pa_log_info("Transport %s released", t->path); /* device will close the SCO socket for us */ } static ssize_t sco_transport_write(pa_bluetooth_transport *t, int fd, const void* buffer, size_t size, size_t write_mtu) { ssize_t l = 0; size_t written = 0; size_t write_size; pa_assert(t); /* since SCO setup is symmetric, fix write MTU to be size of last read packet */ if (t->last_read_size) write_mtu = PA_MIN(t->last_read_size, write_mtu); /* if encoder buffer has less data than required to make complete packet */ if (size < write_mtu) return 0; /* write out MTU sized chunks only */ while (written < size) { write_size = PA_MIN(size - written, write_mtu); if (write_size < write_mtu) break; l = pa_write(fd, buffer + written, write_size, &t->stream_write_type); if (l < 0) break; written += l; } if (l < 0) { if (errno == EAGAIN) { /* Hmm, apparently the socket was not writable, give up for now */ pa_log_debug("Got EAGAIN on write() after POLLOUT, probably there is a temporary connection loss."); /* Drain write buffer */ written = size; } else if (errno == EINVAL && t->last_read_size == 0) { /* Likely write_link_mtu is still wrong, retry after next successful read */ pa_log_debug("got write EINVAL, next successful read should fix MTU"); /* Drain write buffer */ written = size; } else { pa_log_error("Failed to write data to socket: %s", pa_cstrerror(errno)); /* Report error from write call */ return -1; } } /* if too much data left discard it all */ if (size - written >= write_mtu) { pa_log_warn("Wrote memory block to socket only partially! %lu written, discarding pending write size %lu larger than write_mtu %lu", written, size, write_mtu); /* Drain write buffer */ written = size; } return written; } static void sco_io_callback(pa_mainloop_api *io, pa_io_event *e, int fd, pa_io_event_flags_t events, void *userdata) { pa_bluetooth_transport *t = userdata; pa_assert(io); pa_assert(t); if (events & (PA_IO_EVENT_HANGUP|PA_IO_EVENT_ERROR)) { pa_log_error("error listening SCO connection: %s", pa_cstrerror(errno)); goto fail; } if (t->state != PA_BLUETOOTH_TRANSPORT_STATE_PLAYING) { pa_log_info("SCO incoming connection: changing state to PLAYING"); pa_bluetooth_transport_set_state (t, PA_BLUETOOTH_TRANSPORT_STATE_PLAYING); } fail: return; } static int sco_listen(pa_bluetooth_transport *t) { struct transport_data *trd = t->userdata; struct sockaddr_sco addr; int sock, i; bdaddr_t src; const char *src_addr; sock = socket(PF_BLUETOOTH, SOCK_SEQPACKET | SOCK_NONBLOCK | SOCK_CLOEXEC, BTPROTO_SCO); if (sock < 0) { pa_log_error("socket(SEQPACKET, SCO) %s", pa_cstrerror(errno)); return -1; } src_addr = t->device->adapter->address; /* don't use ba2str to avoid -lbluetooth */ for (i = 5; i >= 0; i--, src_addr += 3) src.b[i] = strtol(src_addr, NULL, 16); /* Bind to local address */ memset(&addr, 0, sizeof(addr)); addr.sco_family = AF_BLUETOOTH; bacpy(&addr.sco_bdaddr, &src); if (bind(sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) { pa_log_error("bind(): %s", pa_cstrerror(errno)); goto fail_close; } pa_log_info ("doing listen"); if (listen(sock, 1) < 0) { pa_log_error("listen(): %s", pa_cstrerror(errno)); goto fail_close; } trd->sco_fd = sock; trd->sco_io = trd->mainloop->io_new(trd->mainloop, sock, PA_IO_EVENT_INPUT, sco_io_callback, t); return sock; fail_close: close(sock); return -1; } static void register_profile_reply(DBusPendingCall *pending, void *userdata) { DBusMessage *r; pa_dbus_pending *p; pa_bluetooth_backend *b; pa_bluetooth_profile_t profile; pa_assert(pending); pa_assert_se(p = userdata); pa_assert_se(b = p->context_data); pa_assert_se(profile = (pa_bluetooth_profile_t)p->call_data); pa_assert_se(r = dbus_pending_call_steal_reply(pending)); if (dbus_message_is_error(r, BLUEZ_ERROR_NOT_SUPPORTED)) { pa_log_info("Couldn't register profile %s because it is disabled in BlueZ", pa_bluetooth_profile_to_string(profile)); profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_ACTIVE); goto finish; } if (dbus_message_get_type(r) == DBUS_MESSAGE_TYPE_ERROR) { pa_log_error(BLUEZ_PROFILE_MANAGER_INTERFACE ".RegisterProfile() failed: %s: %s", dbus_message_get_error_name(r), pa_dbus_get_error_message(r)); profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_ACTIVE); goto finish; } profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_REGISTERED); finish: dbus_message_unref(r); PA_LLIST_REMOVE(pa_dbus_pending, b->pending, p); pa_dbus_pending_free(p); } static void register_profile(pa_bluetooth_backend *b, const char *object, const char *uuid, pa_bluetooth_profile_t profile) { DBusMessage *m; DBusMessageIter i, d; dbus_bool_t autoconnect; dbus_uint16_t version, chan; pa_assert(profile_status_get(b->discovery, profile) == PA_BLUETOOTH_PROFILE_STATUS_ACTIVE); pa_log_debug("Registering Profile %s %s", pa_bluetooth_profile_to_string(profile), uuid); pa_assert_se(m = dbus_message_new_method_call(BLUEZ_SERVICE, "/org/bluez", BLUEZ_PROFILE_MANAGER_INTERFACE, "RegisterProfile")); dbus_message_iter_init_append(m, &i); pa_assert_se(dbus_message_iter_append_basic(&i, DBUS_TYPE_OBJECT_PATH, &object)); pa_assert_se(dbus_message_iter_append_basic(&i, DBUS_TYPE_STRING, &uuid)); dbus_message_iter_open_container(&i, DBUS_TYPE_ARRAY, DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &d); if (pa_bluetooth_uuid_is_hsp_hs(uuid)) { /* In the headset role, the connection will only be initiated from the remote side */ autoconnect = 0; pa_dbus_append_basic_variant_dict_entry(&d, "AutoConnect", DBUS_TYPE_BOOLEAN, &autoconnect); chan = HSP_HS_DEFAULT_CHANNEL; pa_dbus_append_basic_variant_dict_entry(&d, "Channel", DBUS_TYPE_UINT16, &chan); /* HSP version 1.2 */ version = 0x0102; pa_dbus_append_basic_variant_dict_entry(&d, "Version", DBUS_TYPE_UINT16, &version); } dbus_message_iter_close_container(&i, &d); profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_REGISTERING); send_and_add_to_pending(b, m, register_profile_reply, (void *)profile); } static void transport_put(pa_bluetooth_transport *t) { pa_bluetooth_transport_put(t); pa_log_debug("Transport %s available for profile %s", t->path, pa_bluetooth_profile_to_string(t->profile)); } static pa_volume_t set_sink_volume(pa_bluetooth_transport *t, pa_volume_t volume); static pa_volume_t set_source_volume(pa_bluetooth_transport *t, pa_volume_t volume); static bool hfp_rfcomm_handle(int fd, pa_bluetooth_transport *t, const char *buf) { struct pa_bluetooth_discovery *discovery = t->device->discovery; struct hfp_config *c = t->config; int indicator, mode, val; char str[5]; const char *r; size_t len; const char *state = NULL; /* first-time initialize selected codec to CVSD */ if (c->selected_codec == 0) c->selected_codec = 1; /* stateful negotiation */ if (c->state == 0 && sscanf(buf, "AT+BRSF=%d", &val) == 1) { c->capabilities = val; pa_log_info("HFP capabilities returns 0x%x", val); rfcomm_write_response(fd, "+BRSF: %d", hfp_features); c->supports_indicators = !!(1 << HFP_HF_INDICATORS); c->state = 1; return true; } else if (sscanf(buf, "AT+BIA=%s", str) == 1) { /* Indicators start with index 1 and follow the order of the AT+CIND=? response */ indicator = 1; while ((r = pa_split_in_place(str, ",", &len, &state))) { /* Ignore updates to mandantory indicators which are always ON */ if (indicator == CIND_CALL_INDICATOR || indicator == CIND_CALL_SETUP_INDICATOR || indicator == CIND_CALL_HELD_INDICATOR) continue; /* Indicators may have no value and should be skipped */ if (len == 0) continue; if (len == 1 && r[0] == '1') discovery->native_backend->cind_enabled_indicators |= (1 << indicator); else if (len == 1 && r[0] == '0') discovery->native_backend->cind_enabled_indicators &= ~(1 << indicator); else { pa_log_error("Unable to parse indicator of AT+BIA command: %s", buf); rfcomm_write_response(fd, "ERROR"); return false; } indicator++; } return true; } else if (sscanf(buf, "AT+BAC=%3s", str) == 1) { c->support_msbc = false; /* check if codec id 2 (mSBC) is in the list of supported codecs */ while ((r = pa_split_in_place(str, ",", &len, &state))) { if (len == 1 && r[0] == '2') { c->support_msbc = true; break; } } c->support_codec_negotiation = true; if (c->state == 1) { /* initial list of codecs supported by HF */ } else { /* HF sent updated list of codecs */ } /* no state change */ return true; } else if (c->state == 1 && pa_startswith(buf, "AT+CIND=?")) { /* UPower backend available, declare support for more indicators */ if (discovery->native_backend->upower) { rfcomm_write_response(fd, "+CIND: " MANDATORY_CALL_INDICATORS "," "(\"service\",(0-1))," "(\"battchg\",(0-5))"); /* Minimal indicators supported without any additional backend */ } else { rfcomm_write_response(fd, "+CIND: " MANDATORY_CALL_INDICATORS "," "(\"service\",(0-1))"); } c->state = 2; return true; } else if (c->state == 2 && pa_startswith(buf, "AT+CIND?")) { if (discovery->native_backend->upower) rfcomm_write_response(fd, "+CIND: 0,0,0,0,%u", pa_upower_get_battery_level(discovery->native_backend->upower)); else rfcomm_write_response(fd, "+CIND: 0,0,0,0"); c->state = 3; return true; } else if ((c->state == 2 || c->state == 3) && pa_startswith(buf, "AT+CMER=")) { if (sscanf(buf, "AT+CMER=%d,%*d,%*d,%d", &mode, &val) == 2) { /* Bluetooth HFP spec only defines mode == 3 */ if (mode != 3) { pa_log_warn("Unexpected mode for AT+CMER: %d", mode); } /* Configure CMER event reporting */ discovery->native_backend->cmer_indicator_reporting_enabled = !!val; pa_log_debug("Event indications enabled? %s", pa_yes_no(val)); rfcomm_write_response(fd, "OK"); } else { pa_log_error("Unable to parse AT+CMER command: %s", buf); rfcomm_write_response(fd, "ERROR"); return false; } if (c->support_codec_negotiation) { if (c->support_msbc && pa_bluetooth_discovery_get_enable_msbc(t->device->discovery)) { rfcomm_write_response(fd, "+BCS:2"); c->state = 4; } else { rfcomm_write_response(fd, "+BCS:1"); c->state = 4; } } else { c->state = 5; pa_bluetooth_transport_reconfigure(t, pa_bluetooth_get_hf_codec("CVSD"), sco_transport_write, NULL); transport_put(t); } return false; } else if (sscanf(buf, "AT+BCS=%d", &val)) { if (val == 1) { pa_bluetooth_transport_reconfigure(t, pa_bluetooth_get_hf_codec("CVSD"), sco_transport_write, NULL); } else if (val == 2 && pa_bluetooth_discovery_get_enable_msbc(t->device->discovery)) { pa_bluetooth_transport_reconfigure(t, pa_bluetooth_get_hf_codec("mSBC"), sco_transport_write, sco_setsockopt_enable_bt_voice); } else { pa_assert_fp(val != 1 && val != 2); rfcomm_write_response(fd, "ERROR"); return false; } c->selected_codec = val; if (c->state == 4) { c->state = 5; pa_log_info("HFP negotiated codec %s", t->bt_codec->name); transport_put(t); } return true; } else if (c->supports_indicators && pa_startswith(buf, "AT+BIND=?")) { // Support battery indication rfcomm_write_response(fd, "+BIND: (2)"); return true; } else if (c->supports_indicators && pa_startswith(buf, "AT+BIND?")) { // Battery indication is enabled rfcomm_write_response(fd, "+BIND: 2,1"); return true; } else if (c->supports_indicators && pa_startswith(buf, "AT+BIND=")) { // If this comma-separated list contains `2`, the HF is // able to report values for the battery indicator. return true; } else if (c->supports_indicators && sscanf(buf, "AT+BIEV=%u,%u", &indicator, &val)) { switch (indicator) { case 2: pa_log_notice("Battery Level: %d%%", val); if (val < 0 || val > 100) { pa_log_error("Battery HF indicator %d out of [0, 100] range", val); rfcomm_write_response(fd, "ERROR"); return false; } pa_bluetooth_device_report_battery_level(t->device, val, "HFP 1.7 HF indicator"); break; default: pa_log_error("Unknown HF indicator %u", indicator); rfcomm_write_response(fd, "ERROR"); return false; } return true; } if (c->state == 4) { /* the ack for the codec setting may take a while. we need * to reply OK to everything else until then */ return true; } /* if we get here, negotiation should be complete */ if (c->state != 5) { pa_log_error("HFP negotiation failed in state %d with inbound %s\n", c->state, buf); rfcomm_write_response(fd, "ERROR"); return false; } /* * once we're fully connected, just reply OK to everything * it will just be the headset sending the occasional status * update, but we process only the ones we care about */ return true; } static int get_rfcomm_fd (pa_bluetooth_discovery *discovery) { struct pa_bluetooth_transport *t; struct transport_data *trd = NULL; void *state = NULL; /* Find RFCOMM transport by checking if a HSP or HFP profile transport is available */ while ((t = pa_hashmap_iterate(discovery->transports, &state, NULL))) { /* Skip non-connected transports */ if (!t || t->state == PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED) { pa_log_debug("Profile disconnected or unavailable"); continue; } /* Break when an RFCOMM capable transport profile is available */ if (t->profile == PA_BLUETOOTH_PROFILE_HFP_HF) { trd = t->userdata; break; } } /* Skip if RFCOMM channel is not available yet */ if (!trd) { pa_log_info("RFCOMM not available yet, skipping notification"); return -1; } return trd->rfcomm_fd; } static pa_hook_result_t host_battery_level_changed_cb(pa_bluetooth_discovery *y, const pa_upower_backend *u, pa_bluetooth_backend *b) { int rfcomm_fd; pa_assert(y); pa_assert(u); pa_assert(b); /* Get RFCOMM channel if available */ rfcomm_fd = get_rfcomm_fd (y); if (rfcomm_fd < 0) return PA_HOOK_OK; /* Notify HF about AG battery level change over RFCOMM */ if (b->cmer_indicator_reporting_enabled && (b->cind_enabled_indicators & (1 << CIND_BATT_CHG_INDICATOR))) { rfcomm_write_response(rfcomm_fd, "+CIEV: %d,%d", CIND_BATT_CHG_INDICATOR, u->battery_level); pa_log_debug("HG notified of AG's battery level change"); /* Skip notification if indicator is disabled or event reporting is completely disabled */ } else pa_log_debug("Battery level change indicator disabled, skipping notification"); return PA_HOOK_OK; } static void rfcomm_io_callback(pa_mainloop_api *io, pa_io_event *e, int fd, pa_io_event_flags_t events, void *userdata) { pa_bluetooth_transport *t = userdata; pa_bluetooth_discovery *discovery = t->device->discovery; int i; pa_assert(io); pa_assert(t); if (events & (PA_IO_EVENT_HANGUP|PA_IO_EVENT_ERROR)) { pa_log_info("Lost RFCOMM connection."); // TODO: Keep track of which profile is the current battery provider, // only deregister if it is us currently providing these levels. // (Also helpful to fill the 'Source' property) // We might also move this to Profile1::RequestDisconnection pa_bluetooth_device_deregister_battery(t->device); goto fail; } if (events & PA_IO_EVENT_INPUT) { char buf[512]; ssize_t len; int gain, dummy; bool do_reply = false; int vendor, product, version, features; int num; len = pa_read(fd, buf, 511, NULL); if (len < 0) { pa_log_error("RFCOMM read error: %s", pa_cstrerror(errno)); goto fail; } buf[len] = 0; pa_log_debug("RFCOMM << %s", buf); /* There are only four HSP AT commands: * AT+VGS=value: value between 0 and 15, sent by the HS to AG to set the speaker gain. * +VGS=value is sent by AG to HS as a response to an AT+VGS command or when the gain * is changed on the AG side. * AT+VGM=value: value between 0 and 15, sent by the HS to AG to set the microphone gain. * +VGM=value is sent by AG to HS as a response to an AT+VGM command or when the gain * is changed on the AG side. * AT+CKPD=200: Sent by HS when headset button is pressed. * RING: Sent by AG to HS to notify of an incoming call. It can safely be ignored because * it does not expect a reply. */ if (sscanf(buf, "AT+VGS=%d", &gain) == 1 || sscanf(buf, "\r\n+VGM%*[=:]%d\r\n", &gain) == 1) { if (!t->set_sink_volume) { pa_log_debug("HS/HF peer supports speaker gain control"); t->set_sink_volume = set_sink_volume; } t->sink_volume = hsp_gain_to_volume(gain); pa_hook_fire(pa_bluetooth_discovery_hook(t->device->discovery, PA_BLUETOOTH_HOOK_TRANSPORT_SINK_VOLUME_CHANGED), t); do_reply = true; } else if (sscanf(buf, "AT+VGM=%d", &gain) == 1 || sscanf(buf, "\r\n+VGS%*[=:]%d\r\n", &gain) == 1) { if (!t->set_source_volume) { pa_log_debug("HS/HF peer supports microphone gain control"); t->set_source_volume = set_source_volume; } t->source_volume = hsp_gain_to_volume(gain); pa_hook_fire(pa_bluetooth_discovery_hook(t->device->discovery, PA_BLUETOOTH_HOOK_TRANSPORT_SOURCE_VOLUME_CHANGED), t); do_reply = true; } else if (sscanf(buf, "AT+CKPD=%d", &dummy) == 1) { do_reply = true; } else if (sscanf(buf, "AT+XAPL=%04x-%04x-%04x,%d", &vendor, &product, &version, &features) == 4) { if (features & 0x2) /* claim, that we support battery status reports */ rfcomm_write_response(fd, "+XAPL=iPhone,6"); do_reply = true; } else if (sscanf(buf, "AT+IPHONEACCEV=%d", &num) == 1) { char *substr = buf, *keystr; int key, val, i; do_reply = true; for (i = 0; i < num; ++i) { keystr = strchr(substr, ','); if (!keystr) { pa_log_warn("%s misses key for argument #%d", buf, i); do_reply = false; break; } keystr++; substr = strchr(keystr, ','); if (!substr) { pa_log_warn("%s misses value for argument #%d", buf, i); do_reply = false; break; } substr++; key = atoi(keystr); val = atoi(substr); switch (key) { case 1: pa_log_notice("Battery Level: %d0%%", val + 1); pa_bluetooth_device_report_battery_level(t->device, (val + 1) * 10, "Apple accessory indication"); break; case 2: pa_log_notice("Dock Status: %s", val ? "docked" : "undocked"); break; default: pa_log_debug("Unexpected IPHONEACCEV key %#x", key); break; } } if (!do_reply) rfcomm_write_response(fd, "ERROR"); } else if (t->config) { /* t->config is only non-null for hfp profile */ do_reply = hfp_rfcomm_handle(fd, t, buf); } else { rfcomm_write_response(fd, "ERROR"); do_reply = false; } if (do_reply) rfcomm_write_response(fd, "OK"); } return; fail: /* Service Connection lost, reset indicators and event reporting to default values */ discovery->native_backend->cmer_indicator_reporting_enabled = false; for (i = 1; i < CIND_INDICATOR_MAX; i++) discovery->native_backend->cind_enabled_indicators |= (1 << i); pa_bluetooth_transport_unlink(t); pa_bluetooth_transport_free(t); } static void transport_destroy(pa_bluetooth_transport *t) { struct transport_data *trd = t->userdata; if (trd->sco_io) { trd->mainloop->io_free(trd->sco_io); shutdown(trd->sco_fd, SHUT_RDWR); close (trd->sco_fd); } trd->mainloop->io_free(trd->rfcomm_io); shutdown(trd->rfcomm_fd, SHUT_RDWR); close (trd->rfcomm_fd); pa_xfree(trd); } static pa_volume_t set_sink_volume(pa_bluetooth_transport *t, pa_volume_t volume) { struct transport_data *trd = t->userdata; uint16_t gain = volume_to_hsp_gain(volume); /* Propagate rounding and bound checks */ volume = hsp_gain_to_volume(gain); if (t->sink_volume == volume) return volume; t->sink_volume = volume; /* If we are in the AG role, we send an unsolicited result-code to the headset * to change the speaker gain. In the HS role, source and sink are swapped, * so in this case we notify the AG that the microphone gain has changed * by sending a command. */ if (is_pulseaudio_audio_gateway(t->profile)) { rfcomm_write_response(trd->rfcomm_fd, "+VGS=%d", gain); } else { rfcomm_write_command(trd->rfcomm_fd, "AT+VGM=%d", gain); } return volume; } static pa_volume_t set_source_volume(pa_bluetooth_transport *t, pa_volume_t volume) { struct transport_data *trd = t->userdata; uint16_t gain = volume_to_hsp_gain(volume); /* Propagate rounding and bound checks */ volume = hsp_gain_to_volume(gain); if (t->source_volume == volume) return volume; t->source_volume = volume; /* If we are in the AG role, we send an unsolicited result-code to the headset * to change the microphone gain. In the HS role, source and sink are swapped, * so in this case we notify the AG that the speaker gain has changed * by sending a command. */ if (is_pulseaudio_audio_gateway(t->profile)) { rfcomm_write_response(trd->rfcomm_fd, "+VGM=%d", gain); } else { rfcomm_write_command(trd->rfcomm_fd, "AT+VGS=%d", gain); } return volume; } static DBusMessage *profile_new_connection(DBusConnection *conn, DBusMessage *m, void *userdata) { pa_bluetooth_backend *b = userdata; pa_bluetooth_device *d; pa_bluetooth_transport *t; pa_bluetooth_profile_t p; DBusMessage *r; int fd; const char *sender, *path, PA_UNUSED *handler; DBusMessageIter arg_i; char *pathfd; struct transport_data *trd; if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "oha{sv}")) { pa_log_error("Invalid signature found in NewConnection"); goto fail; } handler = dbus_message_get_path(m); if (pa_streq(handler, HSP_AG_PROFILE)) { p = PA_BLUETOOTH_PROFILE_HSP_HS; } else if (pa_streq(handler, HSP_HS_PROFILE)) { p = PA_BLUETOOTH_PROFILE_HSP_AG; } else if (pa_streq(handler, HFP_AG_PROFILE)) { p = PA_BLUETOOTH_PROFILE_HFP_HF; } else { pa_log_error("Invalid handler"); goto fail; } pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_OBJECT_PATH); dbus_message_iter_get_basic(&arg_i, &path); d = pa_bluetooth_discovery_get_device_by_path(b->discovery, path); if (d == NULL) { pa_log_error("Device doesn't exist for %s", path); goto fail; } if (d->enable_hfp_hf) { if (p == PA_BLUETOOTH_PROFILE_HSP_HS && pa_hashmap_get(d->uuids, PA_BLUETOOTH_UUID_HFP_HF)) { /* If peer connecting to HSP Audio Gateway supports HFP HF profile * reject this connection to force it to connect to HSP Audio Gateway instead. */ pa_log_info("HFP HF enabled in native backend and is supported by peer, rejecting HSP HS peer connection"); goto fail; } } pa_assert_se(dbus_message_iter_next(&arg_i)); pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_UNIX_FD); dbus_message_iter_get_basic(&arg_i, &fd); pa_log_debug("dbus: NewConnection path=%s, fd=%d, profile %s", path, fd, pa_bluetooth_profile_to_string(p)); sender = dbus_message_get_sender(m); pathfd = pa_sprintf_malloc ("%s/fd%d", path, fd); t = pa_bluetooth_transport_new(d, sender, pathfd, p, NULL, p == PA_BLUETOOTH_PROFILE_HFP_HF ? sizeof(struct hfp_config) : 0); pa_xfree(pathfd); t->acquire = sco_acquire_cb; t->release = sco_release_cb; t->destroy = transport_destroy; /* If PA is the HF/HS we are in control of volume attenuation and * can always send volume commands (notifications) to keep the peer * updated on actual volume value. * * If the peer is the HF/HS it is responsible for attenuation of both * speaker and microphone gain. * On HFP speaker/microphone gain support is reported by bit 4 in the * `AT+BRSF=` command. Since it isn't explicitly documented whether this * applies to speaker or microphone gain but the peer is required to send * an initial value with `AT+VG[MS]=` either callback is hooked * independently as soon as this command is received. * On HSP this is not specified and is assumed to be dynamic for both * speaker and microphone. */ if (is_peer_audio_gateway(p)) { t->set_sink_volume = set_sink_volume; t->set_source_volume = set_source_volume; } pa_bluetooth_transport_reconfigure(t, pa_bluetooth_get_hf_codec("CVSD"), sco_transport_write, NULL); trd = pa_xnew0(struct transport_data, 1); trd->rfcomm_fd = fd; trd->mainloop = b->core->mainloop; trd->rfcomm_io = trd->mainloop->io_new(b->core->mainloop, fd, PA_IO_EVENT_INPUT, rfcomm_io_callback, t); t->userdata = trd; sco_listen(t); if (p != PA_BLUETOOTH_PROFILE_HFP_HF) transport_put(t); pa_assert_se(r = dbus_message_new_method_return(m)); return r; fail: pa_assert_se(r = dbus_message_new_error(m, BLUEZ_ERROR_INVALID_ARGUMENTS, "Unable to handle new connection")); return r; } static DBusMessage *profile_request_disconnection(DBusConnection *conn, DBusMessage *m, void *userdata) { DBusMessage *r; pa_assert_se(r = dbus_message_new_method_return(m)); return r; } static DBusHandlerResult profile_handler(DBusConnection *c, DBusMessage *m, void *userdata) { pa_bluetooth_backend *b = userdata; DBusMessage *r = NULL; const char *path, *interface, *member; pa_assert(b); path = dbus_message_get_path(m); interface = dbus_message_get_interface(m); member = dbus_message_get_member(m); pa_log_debug("dbus: path=%s, interface=%s, member=%s", path, interface, member); if (!pa_streq(path, HSP_AG_PROFILE) && !pa_streq(path, HSP_HS_PROFILE) && !pa_streq(path, HFP_AG_PROFILE)) return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; if (dbus_message_is_method_call(m, DBUS_INTERFACE_INTROSPECTABLE, "Introspect")) { const char *xml = PROFILE_INTROSPECT_XML; pa_assert_se(r = dbus_message_new_method_return(m)); pa_assert_se(dbus_message_append_args(r, DBUS_TYPE_STRING, &xml, DBUS_TYPE_INVALID)); } else if (dbus_message_is_method_call(m, BLUEZ_PROFILE_INTERFACE, "Release")) { pa_log_debug("Release not handled"); return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; } else if (dbus_message_is_method_call(m, BLUEZ_PROFILE_INTERFACE, "RequestDisconnection")) { r = profile_request_disconnection(c, m, userdata); } else if (dbus_message_is_method_call(m, BLUEZ_PROFILE_INTERFACE, "NewConnection")) r = profile_new_connection(c, m, userdata); else return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; if (r) { pa_assert_se(dbus_connection_send(pa_dbus_connection_get(b->connection), r, NULL)); dbus_message_unref(r); } return DBUS_HANDLER_RESULT_HANDLED; } static pa_hook_result_t adapter_uuids_changed_cb(pa_bluetooth_discovery *y, const pa_bluetooth_adapter *a, pa_bluetooth_backend *b) { pa_assert(y); pa_assert(a); pa_assert(b); if (profile_status_get(y, PA_BLUETOOTH_PROFILE_HSP_HS) == PA_BLUETOOTH_PROFILE_STATUS_ACTIVE && !pa_hashmap_get(a->uuids, PA_BLUETOOTH_UUID_HSP_AG)) register_profile(b, HSP_AG_PROFILE, PA_BLUETOOTH_UUID_HSP_AG, PA_BLUETOOTH_PROFILE_HSP_HS); if (profile_status_get(y, PA_BLUETOOTH_PROFILE_HSP_AG) == PA_BLUETOOTH_PROFILE_STATUS_ACTIVE && !pa_hashmap_get(a->uuids, PA_BLUETOOTH_UUID_HSP_HS)) register_profile(b, HSP_HS_PROFILE, PA_BLUETOOTH_UUID_HSP_HS, PA_BLUETOOTH_PROFILE_HSP_AG); if (profile_status_get(y, PA_BLUETOOTH_PROFILE_HFP_HF) == PA_BLUETOOTH_PROFILE_STATUS_ACTIVE && !pa_hashmap_get(a->uuids, PA_BLUETOOTH_UUID_HFP_AG)) register_profile(b, HFP_AG_PROFILE, PA_BLUETOOTH_UUID_HFP_AG, PA_BLUETOOTH_PROFILE_HFP_HF); return PA_HOOK_OK; } static void profile_init(pa_bluetooth_backend *b, pa_bluetooth_profile_t profile) { static const DBusObjectPathVTable vtable_profile = { .message_function = profile_handler, }; const char *object_name; const char *uuid; pa_assert(b); switch (profile) { case PA_BLUETOOTH_PROFILE_HSP_HS: object_name = HSP_AG_PROFILE; uuid = PA_BLUETOOTH_UUID_HSP_AG; break; case PA_BLUETOOTH_PROFILE_HSP_AG: object_name = HSP_HS_PROFILE; uuid = PA_BLUETOOTH_UUID_HSP_HS; break; case PA_BLUETOOTH_PROFILE_HFP_HF: object_name = HFP_AG_PROFILE; uuid = PA_BLUETOOTH_UUID_HFP_AG; break; default: pa_assert_not_reached(); break; } pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(b->connection), object_name, &vtable_profile, b)); profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_ACTIVE); register_profile(b, object_name, uuid, profile); } static void profile_done(pa_bluetooth_backend *b, pa_bluetooth_profile_t profile) { pa_assert(b); profile_status_set(b->discovery, profile, PA_BLUETOOTH_PROFILE_STATUS_INACTIVE); switch (profile) { case PA_BLUETOOTH_PROFILE_HSP_HS: dbus_connection_unregister_object_path(pa_dbus_connection_get(b->connection), HSP_AG_PROFILE); break; case PA_BLUETOOTH_PROFILE_HSP_AG: dbus_connection_unregister_object_path(pa_dbus_connection_get(b->connection), HSP_HS_PROFILE); break; case PA_BLUETOOTH_PROFILE_HFP_HF: dbus_connection_unregister_object_path(pa_dbus_connection_get(b->connection), HFP_AG_PROFILE); break; default: pa_assert_not_reached(); break; } } static void native_backend_apply_profile_registration_change(pa_bluetooth_backend *native_backend, bool enable_shared_profiles) { if (enable_shared_profiles) { profile_init(native_backend, PA_BLUETOOTH_PROFILE_HSP_AG); if (native_backend->enable_hfp_hf) profile_init(native_backend, PA_BLUETOOTH_PROFILE_HFP_HF); } else { profile_done(native_backend, PA_BLUETOOTH_PROFILE_HSP_AG); if (native_backend->enable_hfp_hf) profile_done(native_backend, PA_BLUETOOTH_PROFILE_HFP_HF); } } void pa_bluetooth_native_backend_enable_shared_profiles(pa_bluetooth_backend *native_backend, bool enable) { if (enable == native_backend->enable_shared_profiles) return; native_backend_apply_profile_registration_change(native_backend, enable); native_backend->enable_shared_profiles = enable; } pa_bluetooth_backend *pa_bluetooth_native_backend_new(pa_core *c, pa_bluetooth_discovery *y, bool enable_shared_profiles) { pa_bluetooth_backend *backend; DBusError err; int i; pa_log_debug("Bluetooth Headset Backend API support using the native backend"); backend = pa_xnew0(pa_bluetooth_backend, 1); backend->core = c; dbus_error_init(&err); if (!(backend->connection = pa_dbus_bus_get(c, DBUS_BUS_SYSTEM, &err))) { pa_log("Failed to get D-Bus connection: %s", err.message); dbus_error_free(&err); pa_xfree(backend); return NULL; } backend->discovery = y; backend->enable_shared_profiles = enable_shared_profiles; backend->enable_hfp_hf = pa_bluetooth_discovery_get_enable_native_hfp_hf(y); backend->enable_hsp_hs = pa_bluetooth_discovery_get_enable_native_hsp_hs(y); backend->adapter_uuids_changed_slot = pa_hook_connect(pa_bluetooth_discovery_hook(y, PA_BLUETOOTH_HOOK_ADAPTER_UUIDS_CHANGED), PA_HOOK_NORMAL, (pa_hook_cb_t) adapter_uuids_changed_cb, backend); backend->host_battery_level_changed_slot = pa_hook_connect(pa_bluetooth_discovery_hook(y, PA_BLUETOOTH_HOOK_HOST_BATTERY_LEVEL_CHANGED), PA_HOOK_NORMAL, (pa_hook_cb_t) host_battery_level_changed_cb, backend); if (!backend->enable_hsp_hs && !backend->enable_hfp_hf) pa_log_warn("Both HSP HS and HFP HF bluetooth profiles disabled in native backend. Native backend will not register for headset connections."); if (backend->enable_hsp_hs) profile_init(backend, PA_BLUETOOTH_PROFILE_HSP_HS); if (backend->enable_shared_profiles) native_backend_apply_profile_registration_change(backend, true); backend->upower = pa_upower_backend_new(c, y); /* All CIND indicators are enabled by default until overriden by AT+BIA */ for (i = 1; i < CIND_INDICATOR_MAX; i++) backend->cind_enabled_indicators |= (1 << i); /* While all CIND indicators are enabled, event reporting is not enabled by default */ backend->cmer_indicator_reporting_enabled = false; return backend; } void pa_bluetooth_native_backend_free(pa_bluetooth_backend *backend) { pa_assert(backend); pa_dbus_free_pending_list(&backend->pending); if (backend->adapter_uuids_changed_slot) pa_hook_slot_free(backend->adapter_uuids_changed_slot); if (backend->host_battery_level_changed_slot) pa_hook_slot_free(backend->host_battery_level_changed_slot); if (backend->enable_shared_profiles) native_backend_apply_profile_registration_change(backend, false); if (backend->enable_hsp_hs) profile_done(backend, PA_BLUETOOTH_PROFILE_HSP_HS); if (backend->upower) pa_upower_backend_free(backend->upower); pa_dbus_connection_unref(backend->connection); pa_xfree(backend); }