blob: b6077fc66d0c1a47d7b28e711f7db9ee7da919e2 [file] [log] [blame]
/******************************************************************************
*
* Copyright (C) 2016 The Android Open Source Project
* Copyright (C) 2009-2012 Broadcom Corporation
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
******************************************************************************/
#define LOG_TAG "bt_btif_a2dp_source"
#include <base/logging.h>
#include <limits.h>
#include <string.h>
#include "audio_a2dp_hw.h"
#include "bt_common.h"
#include "bta_av_ci.h"
#include "btcore/include/bdaddr.h"
#include "btif_a2dp.h"
#include "btif_a2dp_control.h"
#include "btif_a2dp_source.h"
#include "btif_av.h"
#include "btif_av_co.h"
#include "btif_util.h"
#include "osi/include/fixed_queue.h"
#include "osi/include/log.h"
#include "osi/include/metrics.h"
#include "osi/include/mutex.h"
#include "osi/include/osi.h"
#include "osi/include/thread.h"
#include "osi/include/time.h"
#include "uipc.h"
/**
* The typical runlevel of the tx queue size is ~1 buffer
* but due to link flow control or thread preemption in lower
* layers we might need to temporarily buffer up data.
*/
#define MAX_OUTPUT_A2DP_FRAME_QUEUE_SZ (MAX_PCM_FRAME_NUM_PER_TICK * 2)
enum {
BTIF_A2DP_SOURCE_STATE_OFF,
BTIF_A2DP_SOURCE_STATE_STARTING_UP,
BTIF_A2DP_SOURCE_STATE_RUNNING,
BTIF_A2DP_SOURCE_STATE_SHUTTING_DOWN
};
/* BTIF Media Source event definition */
enum {
BTIF_MEDIA_AUDIO_TX_START = 1,
BTIF_MEDIA_AUDIO_TX_STOP,
BTIF_MEDIA_AUDIO_TX_FLUSH,
BTIF_MEDIA_SOURCE_ENCODER_INIT,
BTIF_MEDIA_SOURCE_ENCODER_USER_CONFIG_UPDATE,
BTIF_MEDIA_AUDIO_FEEDING_UPDATE
};
/* tBTIF_A2DP_SOURCE_ENCODER_INIT msg structure */
typedef struct {
BT_HDR hdr;
tA2DP_ENCODER_INIT_PEER_PARAMS peer_params;
} tBTIF_A2DP_SOURCE_ENCODER_INIT;
/* tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE msg structure */
typedef struct {
BT_HDR hdr;
btav_a2dp_codec_config_t user_config;
} tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE;
/* tBTIF_A2DP_AUDIO_FEEDING_UPDATE msg structure */
typedef struct {
BT_HDR hdr;
btav_a2dp_codec_config_t feeding_params;
} tBTIF_A2DP_AUDIO_FEEDING_UPDATE;
typedef struct {
// Counter for total updates
size_t total_updates;
// Last update timestamp (in us)
uint64_t last_update_us;
// Counter for overdue scheduling
size_t overdue_scheduling_count;
// Accumulated overdue scheduling deviations (in us)
uint64_t total_overdue_scheduling_delta_us;
// Max. overdue scheduling delta time (in us)
uint64_t max_overdue_scheduling_delta_us;
// Counter for premature scheduling
size_t premature_scheduling_count;
// Accumulated premature scheduling deviations (in us)
uint64_t total_premature_scheduling_delta_us;
// Max. premature scheduling delta time (in us)
uint64_t max_premature_scheduling_delta_us;
// Counter for exact scheduling
size_t exact_scheduling_count;
// Accumulated and counted scheduling time (in us)
uint64_t total_scheduling_time_us;
} scheduling_stats_t;
typedef struct {
uint64_t session_start_us;
scheduling_stats_t tx_queue_enqueue_stats;
scheduling_stats_t tx_queue_dequeue_stats;
size_t tx_queue_total_frames;
size_t tx_queue_max_frames_per_packet;
uint64_t tx_queue_total_queueing_time_us;
uint64_t tx_queue_max_queueing_time_us;
size_t tx_queue_total_readbuf_calls;
uint64_t tx_queue_last_readbuf_us;
size_t tx_queue_total_flushed_messages;
uint64_t tx_queue_last_flushed_us;
size_t tx_queue_total_dropped_messages;
size_t tx_queue_max_dropped_messages;
size_t tx_queue_dropouts;
uint64_t tx_queue_last_dropouts_us;
size_t media_read_total_underflow_bytes;
size_t media_read_total_underflow_count;
uint64_t media_read_last_underflow_us;
} btif_media_stats_t;
typedef struct {
thread_t* worker_thread;
fixed_queue_t* cmd_msg_queue;
fixed_queue_t* tx_audio_queue;
bool tx_flush; /* Discards any outgoing data when true */
alarm_t* media_alarm;
const tA2DP_ENCODER_INTERFACE* encoder_interface;
period_ms_t encoder_interval_ms; /* Local copy of the encoder interval */
btif_media_stats_t stats;
} tBTIF_A2DP_SOURCE_CB;
static tBTIF_A2DP_SOURCE_CB btif_a2dp_source_cb;
static int btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_OFF;
static void btif_a2dp_source_command_ready(fixed_queue_t* queue, void* context);
static void btif_a2dp_source_startup_delayed(void* context);
static void btif_a2dp_source_shutdown_delayed(void* context);
static void btif_a2dp_source_audio_tx_start_event(void);
static void btif_a2dp_source_audio_tx_stop_event(void);
static void btif_a2dp_source_audio_tx_flush_event(BT_HDR* p_msg);
static void btif_a2dp_source_encoder_init_event(BT_HDR* p_msg);
static void btif_a2dp_source_encoder_user_config_update_event(BT_HDR* p_msg);
static void btif_a2dp_source_audio_feeding_update_event(BT_HDR* p_msg);
static void btif_a2dp_source_encoder_init(void);
static void btif_a2dp_source_encoder_init_req(
tBTIF_A2DP_SOURCE_ENCODER_INIT* p_msg);
static bool btif_a2dp_source_audio_tx_flush_req(void);
static void btif_a2dp_source_alarm_cb(void* context);
static void btif_a2dp_source_audio_handle_timer(void* context);
static uint32_t btif_a2dp_source_read_callback(uint8_t* p_buf, uint32_t len);
static bool btif_a2dp_source_enqueue_callback(BT_HDR* p_buf, size_t frames_n);
static void log_tstamps_us(const char* comment, uint64_t timestamp_us);
static void update_scheduling_stats(scheduling_stats_t* stats, uint64_t now_us,
uint64_t expected_delta);
static void btm_read_rssi_cb(void* data);
UNUSED_ATTR static const char* dump_media_event(uint16_t event) {
switch (event) {
CASE_RETURN_STR(BTIF_MEDIA_AUDIO_TX_START)
CASE_RETURN_STR(BTIF_MEDIA_AUDIO_TX_STOP)
CASE_RETURN_STR(BTIF_MEDIA_AUDIO_TX_FLUSH)
CASE_RETURN_STR(BTIF_MEDIA_SOURCE_ENCODER_INIT)
CASE_RETURN_STR(BTIF_MEDIA_SOURCE_ENCODER_USER_CONFIG_UPDATE)
CASE_RETURN_STR(BTIF_MEDIA_AUDIO_FEEDING_UPDATE)
default:
break;
}
return "UNKNOWN A2DP SOURCE EVENT";
}
bool btif_a2dp_source_startup(void) {
if (btif_a2dp_source_state != BTIF_A2DP_SOURCE_STATE_OFF) {
APPL_TRACE_ERROR("%s: A2DP Source media task already running", __func__);
return false;
}
memset(&btif_a2dp_source_cb, 0, sizeof(btif_a2dp_source_cb));
btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_STARTING_UP;
APPL_TRACE_EVENT("## A2DP SOURCE START MEDIA THREAD ##");
/* Start A2DP Source media task */
btif_a2dp_source_cb.worker_thread =
thread_new("btif_a2dp_source_worker_thread");
if (btif_a2dp_source_cb.worker_thread == NULL) {
APPL_TRACE_ERROR("%s: unable to start up media thread", __func__);
btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_OFF;
return false;
}
btif_a2dp_source_cb.stats.session_start_us = time_get_os_boottime_us();
btif_a2dp_source_cb.tx_audio_queue = fixed_queue_new(SIZE_MAX);
btif_a2dp_source_cb.cmd_msg_queue = fixed_queue_new(SIZE_MAX);
fixed_queue_register_dequeue(
btif_a2dp_source_cb.cmd_msg_queue,
thread_get_reactor(btif_a2dp_source_cb.worker_thread),
btif_a2dp_source_command_ready, NULL);
APPL_TRACE_EVENT("## A2DP SOURCE MEDIA THREAD STARTED ##");
/* Schedule the rest of the startup operations */
thread_post(btif_a2dp_source_cb.worker_thread,
btif_a2dp_source_startup_delayed, NULL);
return true;
}
static void btif_a2dp_source_startup_delayed(UNUSED_ATTR void* context) {
raise_priority_a2dp(TASK_HIGH_MEDIA);
btif_a2dp_control_init();
btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_RUNNING;
}
void btif_a2dp_source_shutdown(void) {
if ((btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_OFF) ||
(btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_SHUTTING_DOWN)) {
return;
}
/* Make sure no channels are restarted while shutting down */
btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_SHUTTING_DOWN;
APPL_TRACE_EVENT("## A2DP SOURCE STOP MEDIA THREAD ##");
// Stop the timer
alarm_free(btif_a2dp_source_cb.media_alarm);
btif_a2dp_source_cb.media_alarm = NULL;
// Exit the thread
fixed_queue_free(btif_a2dp_source_cb.cmd_msg_queue, NULL);
btif_a2dp_source_cb.cmd_msg_queue = NULL;
thread_post(btif_a2dp_source_cb.worker_thread,
btif_a2dp_source_shutdown_delayed, NULL);
thread_free(btif_a2dp_source_cb.worker_thread);
btif_a2dp_source_cb.worker_thread = NULL;
}
static void btif_a2dp_source_shutdown_delayed(UNUSED_ATTR void* context) {
btif_a2dp_control_cleanup();
fixed_queue_free(btif_a2dp_source_cb.tx_audio_queue, NULL);
btif_a2dp_source_cb.tx_audio_queue = NULL;
btif_a2dp_source_state = BTIF_A2DP_SOURCE_STATE_OFF;
}
bool btif_a2dp_source_media_task_is_running(void) {
return (btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_RUNNING);
}
bool btif_a2dp_source_media_task_is_shutting_down(void) {
return (btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_SHUTTING_DOWN);
}
bool btif_a2dp_source_is_streaming(void) {
return alarm_is_scheduled(btif_a2dp_source_cb.media_alarm);
}
static void btif_a2dp_source_command_ready(fixed_queue_t* queue,
UNUSED_ATTR void* context) {
BT_HDR* p_msg = (BT_HDR*)fixed_queue_dequeue(queue);
LOG_VERBOSE(LOG_TAG, "%s: event %d %s", __func__, p_msg->event,
dump_media_event(p_msg->event));
switch (p_msg->event) {
case BTIF_MEDIA_AUDIO_TX_START:
btif_a2dp_source_audio_tx_start_event();
break;
case BTIF_MEDIA_AUDIO_TX_STOP:
btif_a2dp_source_audio_tx_stop_event();
break;
case BTIF_MEDIA_AUDIO_TX_FLUSH:
btif_a2dp_source_audio_tx_flush_event(p_msg);
break;
case BTIF_MEDIA_SOURCE_ENCODER_INIT:
btif_a2dp_source_encoder_init_event(p_msg);
break;
case BTIF_MEDIA_SOURCE_ENCODER_USER_CONFIG_UPDATE:
btif_a2dp_source_encoder_user_config_update_event(p_msg);
break;
case BTIF_MEDIA_AUDIO_FEEDING_UPDATE:
btif_a2dp_source_audio_feeding_update_event(p_msg);
break;
default:
APPL_TRACE_ERROR("ERROR in %s unknown event %d", __func__, p_msg->event);
break;
}
osi_free(p_msg);
LOG_VERBOSE(LOG_TAG, "%s: %s DONE", __func__, dump_media_event(p_msg->event));
}
void btif_a2dp_source_setup_codec(void) {
APPL_TRACE_EVENT("## A2DP SOURCE SETUP CODEC ##");
mutex_global_lock();
/* Init the encoding task */
btif_a2dp_source_encoder_init();
mutex_global_unlock();
}
void btif_a2dp_source_start_audio_req(void) {
BT_HDR* p_buf = (BT_HDR*)osi_malloc(sizeof(BT_HDR));
p_buf->event = BTIF_MEDIA_AUDIO_TX_START;
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
}
void btif_a2dp_source_stop_audio_req(void) {
BT_HDR* p_buf = (BT_HDR*)osi_malloc(sizeof(BT_HDR));
p_buf->event = BTIF_MEDIA_AUDIO_TX_STOP;
/*
* Explicitly check whether btif_a2dp_source_cb.cmd_msg_queue is not NULL
* to avoid a race condition during shutdown of the Bluetooth stack.
* This race condition is triggered when A2DP audio is streaming on
* shutdown:
* "btif_a2dp_source_on_stopped() -> btif_a2dp_source_stop_audio_req()"
* is called to stop the particular audio stream, and this happens right
* after the "BTIF_AV_CLEANUP_REQ_EVT -> btif_a2dp_source_shutdown()"
* processing during the shutdown of the Bluetooth stack.
*/
if (btif_a2dp_source_cb.cmd_msg_queue != NULL)
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
}
static void btif_a2dp_source_encoder_init(void) {
tBTIF_A2DP_SOURCE_ENCODER_INIT msg;
// Check to make sure the platform has 8 bits/byte since
// we're using that in frame size calculations now.
CHECK(CHAR_BIT == 8);
APPL_TRACE_DEBUG("%s", __func__);
bta_av_co_get_peer_params(&msg.peer_params);
btif_a2dp_source_encoder_init_req(&msg);
}
static void btif_a2dp_source_encoder_init_req(
tBTIF_A2DP_SOURCE_ENCODER_INIT* p_msg) {
tBTIF_A2DP_SOURCE_ENCODER_INIT* p_buf =
(tBTIF_A2DP_SOURCE_ENCODER_INIT*)osi_malloc(
sizeof(tBTIF_A2DP_SOURCE_ENCODER_INIT));
memcpy(p_buf, p_msg, sizeof(tBTIF_A2DP_SOURCE_ENCODER_INIT));
p_buf->hdr.event = BTIF_MEDIA_SOURCE_ENCODER_INIT;
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
}
static void btif_a2dp_source_encoder_init_event(BT_HDR* p_msg) {
tBTIF_A2DP_SOURCE_ENCODER_INIT* p_encoder_init =
(tBTIF_A2DP_SOURCE_ENCODER_INIT*)p_msg;
APPL_TRACE_DEBUG("%s", __func__);
btif_a2dp_source_cb.encoder_interface = bta_av_co_get_encoder_interface();
if (btif_a2dp_source_cb.encoder_interface == NULL) {
APPL_TRACE_ERROR("%s: Cannot stream audio: no source encoder interface",
__func__);
return;
}
A2dpCodecConfig* a2dp_codec_config = bta_av_get_a2dp_current_codec();
if (a2dp_codec_config == nullptr) {
APPL_TRACE_ERROR("%s: Cannot stream audio: current codec is not set",
__func__);
return;
}
btif_a2dp_source_cb.encoder_interface->encoder_init(
&p_encoder_init->peer_params, a2dp_codec_config,
btif_a2dp_source_read_callback, btif_a2dp_source_enqueue_callback);
// Save a local copy of the encoder_interval_ms
btif_a2dp_source_cb.encoder_interval_ms =
btif_a2dp_source_cb.encoder_interface->get_encoder_interval_ms();
}
void btif_a2dp_source_encoder_user_config_update_req(
const btav_a2dp_codec_config_t& codec_user_config) {
tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE* p_buf =
(tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE*)osi_malloc(
sizeof(tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE));
p_buf->user_config = codec_user_config;
p_buf->hdr.event = BTIF_MEDIA_SOURCE_ENCODER_USER_CONFIG_UPDATE;
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
}
static void btif_a2dp_source_encoder_user_config_update_event(BT_HDR* p_msg) {
tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE* p_user_config =
(tBTIF_A2DP_SOURCE_ENCODER_USER_CONFIG_UPDATE*)p_msg;
APPL_TRACE_DEBUG("%s", __func__);
if (!bta_av_co_set_codec_user_config(p_user_config->user_config)) {
APPL_TRACE_ERROR("%s: cannot update codec user configuration", __func__);
}
}
void btif_a2dp_source_feeding_update_req(
const btav_a2dp_codec_config_t& codec_audio_config) {
tBTIF_A2DP_AUDIO_FEEDING_UPDATE* p_buf =
(tBTIF_A2DP_AUDIO_FEEDING_UPDATE*)osi_malloc(
sizeof(tBTIF_A2DP_AUDIO_FEEDING_UPDATE));
p_buf->feeding_params = codec_audio_config;
p_buf->hdr.event = BTIF_MEDIA_AUDIO_FEEDING_UPDATE;
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
}
static void btif_a2dp_source_audio_feeding_update_event(BT_HDR* p_msg) {
tBTIF_A2DP_AUDIO_FEEDING_UPDATE* p_feeding =
(tBTIF_A2DP_AUDIO_FEEDING_UPDATE*)p_msg;
APPL_TRACE_DEBUG("%s", __func__);
if (!bta_av_co_set_codec_audio_config(p_feeding->feeding_params)) {
APPL_TRACE_ERROR("%s: cannot update codec audio feeding parameters",
__func__);
}
}
void btif_a2dp_source_on_idle(void) {
if (btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_OFF) return;
/* Make sure media task is stopped */
btif_a2dp_source_stop_audio_req();
}
void btif_a2dp_source_on_stopped(tBTA_AV_SUSPEND* p_av_suspend) {
APPL_TRACE_EVENT("## ON A2DP SOURCE STOPPED ##");
if (btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_OFF) return;
/* allow using this api for other than suspend */
if (p_av_suspend != NULL) {
if (p_av_suspend->status != BTA_AV_SUCCESS) {
APPL_TRACE_EVENT("AV STOP FAILED (%d)", p_av_suspend->status);
if (p_av_suspend->initiator) {
APPL_TRACE_WARNING("%s: A2DP stop request failed: status = %d",
__func__, p_av_suspend->status);
btif_a2dp_command_ack(A2DP_CTRL_ACK_FAILURE);
}
return;
}
}
/* ensure tx frames are immediately suspended */
btif_a2dp_source_cb.tx_flush = true;
/* request to stop media task */
btif_a2dp_source_audio_tx_flush_req();
btif_a2dp_source_stop_audio_req();
/* once stream is fully stopped we will ack back */
}
void btif_a2dp_source_on_suspended(tBTA_AV_SUSPEND* p_av_suspend) {
APPL_TRACE_EVENT("## ON A2DP SOURCE SUSPENDED ##");
if (btif_a2dp_source_state == BTIF_A2DP_SOURCE_STATE_OFF) return;
/* check for status failures */
if (p_av_suspend->status != BTA_AV_SUCCESS) {
if (p_av_suspend->initiator) {
APPL_TRACE_WARNING("%s: A2DP suspend request failed: status = %d",
__func__, p_av_suspend->status);
btif_a2dp_command_ack(A2DP_CTRL_ACK_FAILURE);
}
}
/* once stream is fully stopped we will ack back */
/* ensure tx frames are immediately flushed */
btif_a2dp_source_cb.tx_flush = true;
/* stop timer tick */
btif_a2dp_source_stop_audio_req();
}
/* when true media task discards any tx frames */
void btif_a2dp_source_set_tx_flush(bool enable) {
APPL_TRACE_EVENT("## DROP TX %d ##", enable);
btif_a2dp_source_cb.tx_flush = enable;
}
static void btif_a2dp_source_audio_tx_start_event(void) {
APPL_TRACE_DEBUG(
"%s media_alarm is %srunning, streaming %s", __func__,
alarm_is_scheduled(btif_a2dp_source_cb.media_alarm) ? "" : "not ",
btif_a2dp_source_is_streaming() ? "true" : "false");
/* Reset the media feeding state */
CHECK(btif_a2dp_source_cb.encoder_interface != NULL);
btif_a2dp_source_cb.encoder_interface->feeding_reset();
APPL_TRACE_EVENT(
"starting timer %dms",
btif_a2dp_source_cb.encoder_interface->get_encoder_interval_ms());
alarm_free(btif_a2dp_source_cb.media_alarm);
btif_a2dp_source_cb.media_alarm =
alarm_new_periodic("btif.a2dp_source_media_alarm");
if (btif_a2dp_source_cb.media_alarm == NULL) {
LOG_ERROR(LOG_TAG, "%s unable to allocate media alarm", __func__);
return;
}
alarm_set(btif_a2dp_source_cb.media_alarm,
btif_a2dp_source_cb.encoder_interface->get_encoder_interval_ms(),
btif_a2dp_source_alarm_cb, NULL);
}
static void btif_a2dp_source_audio_tx_stop_event(void) {
APPL_TRACE_DEBUG(
"%s media_alarm is %srunning, streaming %s", __func__,
alarm_is_scheduled(btif_a2dp_source_cb.media_alarm) ? "" : "not ",
btif_a2dp_source_is_streaming() ? "true" : "false");
const bool send_ack = btif_a2dp_source_is_streaming();
/* Stop the timer first */
alarm_free(btif_a2dp_source_cb.media_alarm);
btif_a2dp_source_cb.media_alarm = NULL;
UIPC_Close(UIPC_CH_ID_AV_AUDIO);
/*
* Try to send acknowldegment once the media stream is
* stopped. This will make sure that the A2DP HAL layer is
* un-blocked on wait for acknowledgment for the sent command.
* This resolves a corner cases AVDTP SUSPEND collision
* when the DUT and the remote device issue SUSPEND simultaneously
* and due to the processing of the SUSPEND request from the remote,
* the media path is torn down. If the A2DP HAL happens to wait
* for ACK for the initiated SUSPEND, it would never receive it casuing
* a block/wait. Due to this acknowledgement, the A2DP HAL is guranteed
* to get the ACK for any pending command in such cases.
*/
if (send_ack) btif_a2dp_command_ack(A2DP_CTRL_ACK_SUCCESS);
/* audio engine stopped, reset tx suspended flag */
btif_a2dp_source_cb.tx_flush = false;
/* Reset the media feeding state */
if (btif_a2dp_source_cb.encoder_interface != NULL)
btif_a2dp_source_cb.encoder_interface->feeding_reset();
}
static void btif_a2dp_source_alarm_cb(UNUSED_ATTR void* context) {
thread_post(btif_a2dp_source_cb.worker_thread,
btif_a2dp_source_audio_handle_timer, NULL);
}
static void btif_a2dp_source_audio_handle_timer(UNUSED_ATTR void* context) {
uint64_t timestamp_us = time_get_os_boottime_us();
log_tstamps_us("A2DP Source tx timer", timestamp_us);
if (alarm_is_scheduled(btif_a2dp_source_cb.media_alarm)) {
CHECK(btif_a2dp_source_cb.encoder_interface != NULL);
btif_a2dp_source_cb.encoder_interface->send_frames(timestamp_us);
bta_av_ci_src_data_ready(BTA_AV_CHNL_AUDIO);
} else {
APPL_TRACE_ERROR("ERROR Media task Scheduled after Suspend");
}
}
static uint32_t btif_a2dp_source_read_callback(uint8_t* p_buf, uint32_t len) {
uint16_t event;
uint32_t bytes_read = UIPC_Read(UIPC_CH_ID_AV_AUDIO, &event, p_buf, len);
if (bytes_read < len) {
LOG_WARN(LOG_TAG, "%s: UNDERFLOW: ONLY READ %d BYTES OUT OF %d", __func__,
bytes_read, len);
btif_a2dp_source_cb.stats.media_read_total_underflow_bytes +=
(len - bytes_read);
btif_a2dp_source_cb.stats.media_read_total_underflow_count++;
btif_a2dp_source_cb.stats.media_read_last_underflow_us =
time_get_os_boottime_us();
}
return bytes_read;
}
static bool btif_a2dp_source_enqueue_callback(BT_HDR* p_buf, size_t frames_n) {
uint64_t now_us = time_get_os_boottime_us();
/* Check if timer was stopped (media task stopped) */
if (!alarm_is_scheduled(btif_a2dp_source_cb.media_alarm)) {
osi_free(p_buf);
return false;
}
/* Check if the transmission queue has been flushed */
if (btif_a2dp_source_cb.tx_flush) {
LOG_VERBOSE(LOG_TAG, "%s: tx suspended, discarded frame", __func__);
btif_a2dp_source_cb.stats.tx_queue_total_flushed_messages +=
fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue);
btif_a2dp_source_cb.stats.tx_queue_last_flushed_us = now_us;
fixed_queue_flush(btif_a2dp_source_cb.tx_audio_queue, osi_free);
osi_free(p_buf);
return false;
}
// Check for TX queue overflow
// TODO: Using frames_n here is probably wrong: should be "+ 1" instead.
if (fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue) + frames_n >
MAX_OUTPUT_A2DP_FRAME_QUEUE_SZ) {
LOG_WARN(LOG_TAG, "%s: TX queue buffer size now=%u adding=%u max=%d",
__func__,
(uint32_t)fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue),
(uint32_t)frames_n, MAX_OUTPUT_A2DP_FRAME_QUEUE_SZ);
// Keep track of drop-outs
btif_a2dp_source_cb.stats.tx_queue_dropouts++;
btif_a2dp_source_cb.stats.tx_queue_last_dropouts_us = now_us;
// Flush all queued buffers
size_t drop_n = fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue);
if (btif_a2dp_source_cb.stats.tx_queue_max_dropped_messages < drop_n)
btif_a2dp_source_cb.stats.tx_queue_max_dropped_messages = drop_n;
while (fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue)) {
btif_a2dp_source_cb.stats.tx_queue_total_dropped_messages++;
osi_free(fixed_queue_try_dequeue(btif_a2dp_source_cb.tx_audio_queue));
}
// Request RSSI for log purposes if we had to flush buffers
bt_bdaddr_t peer_bda = btif_av_get_addr();
BTM_ReadRSSI(peer_bda.address, btm_read_rssi_cb);
}
/* Update the statistics */
btif_a2dp_source_cb.stats.tx_queue_total_frames += frames_n;
if (frames_n > btif_a2dp_source_cb.stats.tx_queue_max_frames_per_packet)
btif_a2dp_source_cb.stats.tx_queue_max_frames_per_packet = frames_n;
CHECK(btif_a2dp_source_cb.encoder_interface != NULL);
update_scheduling_stats(&btif_a2dp_source_cb.stats.tx_queue_enqueue_stats,
now_us,
btif_a2dp_source_cb.encoder_interval_ms * 1000);
fixed_queue_enqueue(btif_a2dp_source_cb.tx_audio_queue, p_buf);
return true;
}
static void btif_a2dp_source_audio_tx_flush_event(UNUSED_ATTR BT_HDR* p_msg) {
/* Flush all enqueued audio buffers (encoded) */
APPL_TRACE_DEBUG("%s", __func__);
if (btif_a2dp_source_cb.encoder_interface != NULL)
btif_a2dp_source_cb.encoder_interface->feeding_flush();
btif_a2dp_source_cb.stats.tx_queue_total_flushed_messages +=
fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue);
btif_a2dp_source_cb.stats.tx_queue_last_flushed_us =
time_get_os_boottime_us();
fixed_queue_flush(btif_a2dp_source_cb.tx_audio_queue, osi_free);
UIPC_Ioctl(UIPC_CH_ID_AV_AUDIO, UIPC_REQ_RX_FLUSH, NULL);
}
static bool btif_a2dp_source_audio_tx_flush_req(void) {
BT_HDR* p_buf = (BT_HDR*)osi_malloc(sizeof(BT_HDR));
p_buf->event = BTIF_MEDIA_AUDIO_TX_FLUSH;
/*
* Explicitly check whether the btif_a2dp_source_cb.cmd_msg_queue is not
* NULL to avoid a race condition during shutdown of the Bluetooth stack.
* This race condition is triggered when A2DP audio is streaming on
* shutdown:
* "btif_a2dp_source_on_stopped() -> btif_a2dp_source_audio_tx_flush_req()"
* is called to stop the particular audio stream, and this happens right
* after the "BTIF_AV_CLEANUP_REQ_EVT -> btif_a2dp_source_shutdown()"
* processing during the shutdown of the Bluetooth stack.
*/
if (btif_a2dp_source_cb.cmd_msg_queue != NULL)
fixed_queue_enqueue(btif_a2dp_source_cb.cmd_msg_queue, p_buf);
return true;
}
BT_HDR* btif_a2dp_source_audio_readbuf(void) {
uint64_t now_us = time_get_os_boottime_us();
BT_HDR* p_buf =
(BT_HDR*)fixed_queue_try_dequeue(btif_a2dp_source_cb.tx_audio_queue);
btif_a2dp_source_cb.stats.tx_queue_total_readbuf_calls++;
btif_a2dp_source_cb.stats.tx_queue_last_readbuf_us = now_us;
if (p_buf != NULL) {
// Update the statistics
update_scheduling_stats(&btif_a2dp_source_cb.stats.tx_queue_dequeue_stats,
now_us,
btif_a2dp_source_cb.encoder_interval_ms * 1000);
}
return p_buf;
}
static void log_tstamps_us(const char* comment, uint64_t timestamp_us) {
static uint64_t prev_us = 0;
APPL_TRACE_DEBUG("[%s] ts %08llu, diff : %08llu, queue sz %d", comment,
timestamp_us, timestamp_us - prev_us,
fixed_queue_length(btif_a2dp_source_cb.tx_audio_queue));
prev_us = timestamp_us;
}
static void update_scheduling_stats(scheduling_stats_t* stats, uint64_t now_us,
uint64_t expected_delta) {
uint64_t last_us = stats->last_update_us;
stats->total_updates++;
stats->last_update_us = now_us;
if (last_us == 0) return; // First update: expected delta doesn't apply
uint64_t deadline_us = last_us + expected_delta;
if (deadline_us < now_us) {
// Overdue scheduling
uint64_t delta_us = now_us - deadline_us;
// Ignore extreme outliers
if (delta_us < 10 * expected_delta) {
if (stats->max_overdue_scheduling_delta_us < delta_us)
stats->max_overdue_scheduling_delta_us = delta_us;
stats->total_overdue_scheduling_delta_us += delta_us;
stats->overdue_scheduling_count++;
stats->total_scheduling_time_us += now_us - last_us;
}
} else if (deadline_us > now_us) {
// Premature scheduling
uint64_t delta_us = deadline_us - now_us;
// Ignore extreme outliers
if (delta_us < 10 * expected_delta) {
if (stats->max_premature_scheduling_delta_us < delta_us)
stats->max_premature_scheduling_delta_us = delta_us;
stats->total_premature_scheduling_delta_us += delta_us;
stats->premature_scheduling_count++;
stats->total_scheduling_time_us += now_us - last_us;
}
} else {
// On-time scheduling
stats->exact_scheduling_count++;
stats->total_scheduling_time_us += now_us - last_us;
}
}
void btif_a2dp_source_debug_dump(int fd) {
uint64_t now_us = time_get_os_boottime_us();
btif_media_stats_t* stats = &btif_a2dp_source_cb.stats;
scheduling_stats_t* enqueue_stats = &stats->tx_queue_enqueue_stats;
scheduling_stats_t* dequeue_stats = &stats->tx_queue_dequeue_stats;
size_t ave_size;
uint64_t ave_time_us;
dprintf(fd, "\nA2DP State:\n");
dprintf(fd, " TxQueue:\n");
dprintf(fd,
" Counts (enqueue/dequeue/readbuf) : %zu / "
"%zu / %zu\n",
enqueue_stats->total_updates, dequeue_stats->total_updates,
stats->tx_queue_total_readbuf_calls);
dprintf(
fd,
" Last update time ago in ms (enqueue/dequeue/readbuf) : %llu / %llu "
"/ %llu\n",
(enqueue_stats->last_update_us > 0)
? (unsigned long long)(now_us - enqueue_stats->last_update_us) / 1000
: 0,
(dequeue_stats->last_update_us > 0)
? (unsigned long long)(now_us - dequeue_stats->last_update_us) / 1000
: 0,
(stats->tx_queue_last_readbuf_us > 0)
? (unsigned long long)(now_us - stats->tx_queue_last_readbuf_us) /
1000
: 0);
ave_size = 0;
if (enqueue_stats->total_updates != 0)
ave_size = stats->tx_queue_total_frames / enqueue_stats->total_updates;
dprintf(fd,
" Frames per packet (total/max/ave) : %zu / "
"%zu / %zu\n",
stats->tx_queue_total_frames, stats->tx_queue_max_frames_per_packet,
ave_size);
dprintf(fd,
" Counts (flushed/dropped/dropouts) : %zu / "
"%zu / %zu\n",
stats->tx_queue_total_flushed_messages,
stats->tx_queue_total_dropped_messages, stats->tx_queue_dropouts);
dprintf(fd,
" Counts (max dropped) : %zu\n",
stats->tx_queue_max_dropped_messages);
dprintf(
fd,
" Last update time ago in ms (flushed/dropped) : %llu / "
"%llu\n",
(stats->tx_queue_last_flushed_us > 0)
? (unsigned long long)(now_us - stats->tx_queue_last_flushed_us) /
1000
: 0,
(stats->tx_queue_last_dropouts_us > 0)
? (unsigned long long)(now_us - stats->tx_queue_last_dropouts_us) /
1000
: 0);
dprintf(fd,
" Counts (underflow) : %zu\n",
stats->media_read_total_underflow_count);
dprintf(fd,
" Bytes (underflow) : %zu\n",
stats->media_read_total_underflow_bytes);
dprintf(
fd, " Last update time ago in ms (underflow) : %llu\n",
(stats->media_read_last_underflow_us > 0)
? (unsigned long long)(now_us - stats->media_read_last_underflow_us) /
1000
: 0);
//
// TxQueue enqueue stats
//
dprintf(
fd,
" Enqueue deviation counts (overdue/premature) : %zu / %zu\n",
enqueue_stats->overdue_scheduling_count,
enqueue_stats->premature_scheduling_count);
ave_time_us = 0;
if (enqueue_stats->overdue_scheduling_count != 0) {
ave_time_us = enqueue_stats->total_overdue_scheduling_delta_us /
enqueue_stats->overdue_scheduling_count;
}
dprintf(
fd,
" Enqueue overdue scheduling time in ms (total/max/ave) : %llu / %llu "
"/ %llu\n",
(unsigned long long)enqueue_stats->total_overdue_scheduling_delta_us /
1000,
(unsigned long long)enqueue_stats->max_overdue_scheduling_delta_us / 1000,
(unsigned long long)ave_time_us / 1000);
ave_time_us = 0;
if (enqueue_stats->premature_scheduling_count != 0) {
ave_time_us = enqueue_stats->total_premature_scheduling_delta_us /
enqueue_stats->premature_scheduling_count;
}
dprintf(
fd,
" Enqueue premature scheduling time in ms (total/max/ave) : %llu / %llu "
"/ %llu\n",
(unsigned long long)enqueue_stats->total_premature_scheduling_delta_us /
1000,
(unsigned long long)enqueue_stats->max_premature_scheduling_delta_us /
1000,
(unsigned long long)ave_time_us / 1000);
//
// TxQueue dequeue stats
//
dprintf(
fd,
" Dequeue deviation counts (overdue/premature) : %zu / %zu\n",
dequeue_stats->overdue_scheduling_count,
dequeue_stats->premature_scheduling_count);
ave_time_us = 0;
if (dequeue_stats->overdue_scheduling_count != 0) {
ave_time_us = dequeue_stats->total_overdue_scheduling_delta_us /
dequeue_stats->overdue_scheduling_count;
}
dprintf(
fd,
" Dequeue overdue scheduling time in ms (total/max/ave) : %llu / %llu "
"/ %llu\n",
(unsigned long long)dequeue_stats->total_overdue_scheduling_delta_us /
1000,
(unsigned long long)dequeue_stats->max_overdue_scheduling_delta_us / 1000,
(unsigned long long)ave_time_us / 1000);
ave_time_us = 0;
if (dequeue_stats->premature_scheduling_count != 0) {
ave_time_us = dequeue_stats->total_premature_scheduling_delta_us /
dequeue_stats->premature_scheduling_count;
}
dprintf(
fd,
" Dequeue premature scheduling time in ms (total/max/ave) : %llu / %llu "
"/ %llu\n",
(unsigned long long)dequeue_stats->total_premature_scheduling_delta_us /
1000,
(unsigned long long)dequeue_stats->max_premature_scheduling_delta_us /
1000,
(unsigned long long)ave_time_us / 1000);
//
// Codec-specific stats
//
if (btif_a2dp_source_cb.encoder_interface != NULL)
btif_a2dp_source_cb.encoder_interface->debug_codec_dump(fd);
}
void btif_a2dp_source_update_metrics(void) {
uint64_t now_us = time_get_os_boottime_us();
btif_media_stats_t* stats = &btif_a2dp_source_cb.stats;
scheduling_stats_t* dequeue_stats = &stats->tx_queue_dequeue_stats;
int32_t media_timer_min_ms = 0;
int32_t media_timer_max_ms = 0;
int32_t media_timer_avg_ms = 0;
int32_t buffer_overruns_max_count = 0;
int32_t buffer_overruns_total = 0;
float buffer_underruns_average = 0.0;
int32_t buffer_underruns_count = 0;
int64_t session_duration_sec =
(now_us - stats->session_start_us) / (1000 * 1000);
/* NOTE: Disconnect reason is unused */
const char* disconnect_reason = NULL;
uint32_t device_class = BTM_COD_MAJOR_AUDIO;
if (dequeue_stats->total_updates > 1) {
media_timer_min_ms =
btif_a2dp_source_cb.encoder_interval_ms -
(dequeue_stats->max_premature_scheduling_delta_us / 1000);
media_timer_max_ms =
btif_a2dp_source_cb.encoder_interval_ms +
(dequeue_stats->max_overdue_scheduling_delta_us / 1000);
uint64_t total_scheduling_count =
dequeue_stats->overdue_scheduling_count +
dequeue_stats->premature_scheduling_count +
dequeue_stats->exact_scheduling_count;
if (total_scheduling_count > 0) {
media_timer_avg_ms = dequeue_stats->total_scheduling_time_us /
(1000 * total_scheduling_count);
}
buffer_overruns_max_count = stats->tx_queue_max_dropped_messages;
buffer_overruns_total = stats->tx_queue_total_dropped_messages;
buffer_underruns_count = stats->media_read_total_underflow_count;
if (buffer_underruns_count > 0) {
buffer_underruns_average =
stats->media_read_total_underflow_bytes / buffer_underruns_count;
}
}
metrics_a2dp_session(
session_duration_sec, disconnect_reason, device_class, media_timer_min_ms,
media_timer_max_ms, media_timer_avg_ms, buffer_overruns_max_count,
buffer_overruns_total, buffer_underruns_average, buffer_underruns_count);
}
static void btm_read_rssi_cb(void* data) {
if (data == nullptr) {
LOG_ERROR(LOG_TAG, "%s RSSI request timed out", __func__);
return;
}
tBTM_RSSI_RESULTS* result = (tBTM_RSSI_RESULTS*)data;
if (result->status != BTM_SUCCESS) {
LOG_ERROR(LOG_TAG, "%s unable to read remote RSSI (status %d)", __func__,
result->status);
return;
}
char temp_buffer[20] = {0};
LOG_WARN(LOG_TAG, "%s device: %s, rssi: %d", __func__,
bdaddr_to_string((bt_bdaddr_t*)result->rem_bda, temp_buffer,
sizeof(temp_buffer)),
result->rssi);
}