dereference
/
android_hardware_qcom_audio
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
android_hardware_qcom_audio/hal/audio_extn/qaf.c

3148 lines
119 KiB
C
Executable File
Raw Blame History

/*
* Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are
* met:
* * Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above
* copyright notice, this list of conditions and the following
* disclaimer in the documentation and/or other materials provided
* with the distribution.
* * Neither the name of The Linux Foundation nor the names of its
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#define LOG_TAG "audio_hw_qaf"
/*#define LOG_NDEBUG 0*/
/*#define VERY_VERY_VERBOSE_LOGGING*/
#ifdef VERY_VERY_VERBOSE_LOGGING
#define DEBUG_MSG_VV DEBUG_MSG
#else
#define DEBUG_MSG_VV(a...) do { } while(0)
#endif
#define DEBUG_MSG(arg,...) ALOGV("%s: %d: " arg, __func__, __LINE__, ##__VA_ARGS__)
#define ERROR_MSG(arg,...) ALOGE("%s: %d: " arg, __func__, __LINE__, ##__VA_ARGS__)
#define COMPRESS_OFFLOAD_NUM_FRAGMENTS 2
#define COMPRESS_PASSTHROUGH_DDP_FRAGMENT_SIZE 4608
#define QAF_DEFAULT_COMPR_AUDIO_HANDLE 1001
#define QAF_DEFAULT_COMPR_PASSTHROUGH_HANDLE 1002
#define QAF_DEFAULT_PASSTHROUGH_HANDLE 1003
#define COMPRESS_OFFLOAD_PLAYBACK_LATENCY 300
#define MIN_PCM_OFFLOAD_FRAGMENT_SIZE 512
#define MAX_PCM_OFFLOAD_FRAGMENT_SIZE (240 * 1024)
#define DIV_ROUND_UP(x, y) (((x) + (y) - 1)/(y))
#define ALIGN(x, y) ((y) * DIV_ROUND_UP((x), (y)))
/* Pcm input node buffer size is 6144 bytes, i.e, 32msec for 48000 samplerate */
#define QAF_MODULE_PCM_INPUT_BUFFER_LATENCY 32
#define MS12_PCM_OUT_FRAGMENT_SIZE 1536 //samples
#define MS12_PCM_IN_FRAGMENT_SIZE 1536 //samples
#define DD_FRAME_SIZE 1536
#define DDP_FRAME_SIZE DD_FRAME_SIZE
/*
* DD encoder output size for one frame.
*/
#define DD_ENCODER_OUTPUT_SIZE 2560
/*
* DDP encoder output size for one frame.
*/
#define DDP_ENCODER_OUTPUT_SIZE 4608
/*********TODO Need to get correct values.*************************/
#define DTS_PCM_OUT_FRAGMENT_SIZE 1024 //samples
#define DTS_FRAME_SIZE 1536
#define DTSHD_FRAME_SIZE DTS_FRAME_SIZE
/*
* DTS encoder output size for one frame.
*/
#define DTS_ENCODER_OUTPUT_SIZE 2560
/*
* DTSHD encoder output size for one frame.
*/
#define DTSHD_ENCODER_OUTPUT_SIZE 4608
/******************************************************************/
/*
* QAF Latency to process buffers since out_write from primary HAL
*/
#define QAF_COMPRESS_OFFLOAD_PROCESSING_LATENCY 18
#define QAF_PCM_OFFLOAD_PROCESSING_LATENCY 48
//TODO: Need to handle for DTS
#define QAF_DEEP_BUFFER_OUTPUT_PERIOD_SIZE 1536
#include <stdlib.h>
#include <pthread.h>
#include <errno.h>
#include <dlfcn.h>
#include <sys/resource.h>
#include <sys/prctl.h>
#include <cutils/properties.h>
#include <cutils/str_parms.h>
#include <cutils/log.h>
#include <cutils/atomic.h>
#include "audio_utils/primitives.h"
#include "audio_hw.h"
#include "platform_api.h"
#include <platform.h>
#include <system/thread_defs.h>
#include <cutils/sched_policy.h>
#include "audio_extn.h"
#include <qti_audio.h>
#include "sound/compress_params.h"
#include "ip_hdlr_intf.h"
#ifdef DYNAMIC_LOG_ENABLED
#include <log_xml_parser.h>
#define LOG_MASK HAL_MOD_FILE_QAF
#include <log_utils.h>
#endif
//TODO: Need to remove this.
#define QAF_OUTPUT_SAMPLING_RATE 48000
#ifdef QAF_DUMP_ENABLED
FILE *fp_output_writer_hdmi = NULL;
#endif
void set_hdmi_configuration_to_module();
void set_bt_configuration_to_module();
struct qaf_adsp_hdlr_config_state {
struct audio_adsp_event event_params;
/* For holding client audio_adsp_event payload */
uint8_t event_payload[AUDIO_MAX_ADSP_STREAM_CMD_PAYLOAD_LEN];
bool adsp_hdlr_config_valid;
};
//Types of MM module, currently supported by QAF.
typedef enum {
MS12,
DTS_M8,
MAX_MM_MODULE_TYPE,
INVALID_MM_MODULE
} mm_module_type;
typedef enum {
QAF_OUT_TRANSCODE_PASSTHROUGH = 0, /* Transcode passthrough via MM module*/
QAF_OUT_OFFLOAD_MCH, /* Multi-channel PCM offload*/
QAF_OUT_OFFLOAD, /* PCM offload */
MAX_QAF_MODULE_OUT
} mm_module_output_type;
typedef enum {
QAF_IN_MAIN = 0, /* Single PID Main/Primary or Dual-PID stream */
QAF_IN_ASSOC, /* Associated/Secondary stream */
QAF_IN_PCM, /* PCM stream. */
QAF_IN_MAIN_2, /* Single PID Main2 stream */
MAX_QAF_MODULE_IN
} mm_module_input_type;
typedef enum {
STOPPED, /*Stream is in stop state. */
STOPPING, /*Stream is stopping, waiting for EOS. */
RUN, /*Stream is in run state. */
MAX_STATES
} qaf_stream_state;
struct qaf_module {
audio_session_handle_t session_handle;
void *ip_hdlr_hdl;
void *qaf_lib;
int (*qaf_audio_session_open)(audio_session_handle_t* session_handle,
audio_session_type_t s_type,
void *p_data,
void* license_data);
int (*qaf_audio_session_close)(audio_session_handle_t session_handle);
int (*qaf_audio_stream_open)(audio_session_handle_t session_handle,
audio_stream_handle_t* stream_handle,
audio_stream_config_t input_config,
audio_devices_t devices,
stream_type_t flags);
int (*qaf_audio_stream_close)(audio_stream_handle_t stream_handle);
int (*qaf_audio_stream_set_param)(audio_stream_handle_t stream_handle, const char* kv_pairs);
int (*qaf_audio_session_set_param)(audio_session_handle_t handle, const char* kv_pairs);
char* (*qaf_audio_stream_get_param)(audio_stream_handle_t stream_handle, const char* key);
char* (*qaf_audio_session_get_param)(audio_session_handle_t handle, const char* key);
int (*qaf_audio_stream_start)(audio_stream_handle_t handle);
int (*qaf_audio_stream_stop)(audio_stream_handle_t stream_handle);
int (*qaf_audio_stream_pause)(audio_stream_handle_t stream_handle);
int (*qaf_audio_stream_flush)(audio_stream_handle_t stream_handle);
int (*qaf_audio_stream_write)(audio_stream_handle_t stream_handle, const void* buf, int size);
void (*qaf_register_event_callback)(audio_session_handle_t session_handle,
void *priv_data,
notify_event_callback_t event_callback,
audio_event_id_t event_id);
/*Input stream of MM module */
struct stream_out *stream_in[MAX_QAF_MODULE_IN];
/*Output Stream from MM module */
struct stream_out *stream_out[MAX_QAF_MODULE_OUT];
/*Media format associated with each output id raised by mm module. */
audio_qaf_media_format_t out_stream_fmt[MAX_QAF_MODULE_OUT];
/*Flag is set if media format is changed for an mm module output. */
bool is_media_fmt_changed[MAX_QAF_MODULE_OUT];
/*Index to be updated in out_stream_fmt array for a new mm module output. */
int new_out_format_index;
struct qaf_adsp_hdlr_config_state adsp_hdlr_config[MAX_QAF_MODULE_IN];
//BT session handle.
void *bt_hdl;
float vol_left;
float vol_right;
bool is_vol_set;
qaf_stream_state stream_state[MAX_QAF_MODULE_IN];
bool is_session_closing;
};
struct qaf {
struct audio_device *adev;
pthread_mutex_t lock;
bool bt_connect;
bool hdmi_connect;
int hdmi_sink_channels;
//Flag to indicate if QAF transcode output stream is enabled from any mm module.
bool passthrough_enabled;
//Flag to indicate if QAF mch pcm output stream is enabled from any mm module.
bool mch_pcm_hdmi_enabled;
//Flag to indicate if msmd is supported.
bool qaf_msmd_enabled;
//Handle of QAF input stream, which is routed as QAF passthrough.
struct stream_out *passthrough_in;
//Handle of QAF passthrough stream.
struct stream_out *passthrough_out;
struct qaf_module qaf_mod[MAX_MM_MODULE_TYPE];
};
static int qaf_out_pause(struct audio_stream_out* stream);
static int qaf_out_flush(struct audio_stream_out* stream);
static int qaf_out_drain(struct audio_stream_out* stream, audio_drain_type_t type);
static int qaf_session_close();
//Global handle of QAF. Access to this should be protected by mutex lock.
static struct qaf *p_qaf = NULL;
/* Gets the pointer to qaf module for the qaf input stream. */
static struct qaf_module* get_qaf_module_for_input_stream(struct stream_out *out)
{
struct qaf_module *qaf_mod = NULL;
int i, j;
if (!p_qaf) return NULL;
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
for (j = 0; j < MAX_QAF_MODULE_IN; j++) {
if (p_qaf->qaf_mod[i].stream_in[j] == out) {
qaf_mod = &(p_qaf->qaf_mod[i]);
break;
}
}
}
return qaf_mod;
}
/* Finds the mm module input stream index for the QAF input stream. */
static int get_input_stream_index(struct stream_out *out)
{
int index = -1, j;
struct qaf_module* qaf_mod = NULL;
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) return index;
for (j = 0; j < MAX_QAF_MODULE_IN; j++) {
if (qaf_mod->stream_in[j] == out) {
index = j;
break;
}
}
return index;
}
static void set_stream_state(struct stream_out *out, int state)
{
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
int index = get_input_stream_index(out);
if (qaf_mod && index >= 0) qaf_mod->stream_state[index] = state;
}
static bool check_stream_state(struct stream_out *out, int state)
{
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
int index = get_input_stream_index(out);
if (qaf_mod && index >= 0) return (qaf_mod->stream_state[index] == state);
return false;
}
/* Finds the right mm module for the QAF input stream format. */
static mm_module_type get_mm_module_for_format(audio_format_t format)
{
int j;
DEBUG_MSG("Format 0x%x", format);
if (format == AUDIO_FORMAT_PCM_16_BIT) {
//If dts is not supported then alway support pcm with MS12
if (!property_get_bool("vendor.audio.qaf.dts_m8", false)) { //TODO: Need to add this property for DTS.
return MS12;
}
//If QAF passthrough is active then send the PCM stream to primary HAL.
if (!p_qaf->passthrough_out) {
/* Iff any stream is active in MS12 module then route PCM stream to it. */
for (j = 0; j < MAX_QAF_MODULE_IN; j++) {
if (p_qaf->qaf_mod[MS12].stream_in[j]) {
return MS12;
}
}
}
return INVALID_MM_MODULE;
}
switch (format & AUDIO_FORMAT_MAIN_MASK) {
case AUDIO_FORMAT_AC3:
case AUDIO_FORMAT_E_AC3:
case AUDIO_FORMAT_AAC:
case AUDIO_FORMAT_AAC_ADTS:
case AUDIO_FORMAT_AC4:
return MS12;
case AUDIO_FORMAT_DTS:
case AUDIO_FORMAT_DTS_HD:
return DTS_M8;
default:
return INVALID_MM_MODULE;
}
}
static bool is_main_active(struct qaf_module* qaf_mod)
{
return (qaf_mod->stream_in[QAF_IN_MAIN] || qaf_mod->stream_in[QAF_IN_MAIN_2]);
}
static bool is_dual_main_active(struct qaf_module* qaf_mod)
{
return (qaf_mod->stream_in[QAF_IN_MAIN] && qaf_mod->stream_in[QAF_IN_MAIN_2]);
}
//Checks if any main or pcm stream is running in the session.
static bool is_any_stream_running(struct qaf_module* qaf_mod)
{
//Not checking associated stream.
struct stream_out *out = qaf_mod->stream_in[QAF_IN_MAIN];
struct stream_out *out_pcm = qaf_mod->stream_in[QAF_IN_PCM];
struct stream_out *out_main2 = qaf_mod->stream_in[QAF_IN_MAIN_2];
if ((out == NULL || (out != NULL && check_stream_state(out, STOPPED)))
&& (out_main2 == NULL || (out_main2 != NULL && check_stream_state(out_main2, STOPPED)))
&& (out_pcm == NULL || (out_pcm != NULL && check_stream_state(out_pcm, STOPPED)))) {
return false;
}
return true;
}
/* Gets the pcm output buffer size(in samples) for the mm module. */
static uint32_t get_pcm_output_buffer_size_samples(struct qaf_module *qaf_mod)
{
uint32_t pcm_output_buffer_size = 0;
if (qaf_mod == &p_qaf->qaf_mod[MS12]) {
pcm_output_buffer_size = MS12_PCM_OUT_FRAGMENT_SIZE;
} else if (qaf_mod == &p_qaf->qaf_mod[DTS_M8]) {
pcm_output_buffer_size = DTS_PCM_OUT_FRAGMENT_SIZE;
}
return pcm_output_buffer_size;
}
static int get_media_fmt_array_index_for_output_id(
struct qaf_module* qaf_mod,
uint32_t output_id)
{
int i;
for (i = 0; i < MAX_QAF_MODULE_OUT; i++) {
if (qaf_mod->out_stream_fmt[i].output_id == output_id) {
return i;
}
}
return -1;
}
/* Acquire Mutex lock on output stream */
static void lock_output_stream(struct stream_out *out)
{
pthread_mutex_lock(&out->pre_lock);
pthread_mutex_lock(&out->lock);
pthread_mutex_unlock(&out->pre_lock);
}
/* Release Mutex lock on output stream */
static void unlock_output_stream(struct stream_out *out)
{
pthread_mutex_unlock(&out->lock);
}
/* Checks if stream can be routed as QAF passthrough or not. */
static bool audio_extn_qaf_passthrough_enabled(struct stream_out *out)
{
DEBUG_MSG("Format 0x%x", out->format);
bool is_enabled = false;
if (!p_qaf) return false;
if ((!property_get_bool("vendor.audio.qaf.reencode", false))
&& property_get_bool("vendor.audio.qaf.passthrough", false)) {
if ((out->format == AUDIO_FORMAT_PCM_16_BIT) && (popcount(out->channel_mask) > 2)) {
is_enabled = true;
} else if (property_get_bool("vendor.audio.offload.passthrough", false)) {
switch (out->format) {
case AUDIO_FORMAT_AC3:
case AUDIO_FORMAT_E_AC3:
case AUDIO_FORMAT_DTS:
case AUDIO_FORMAT_DTS_HD:
case AUDIO_FORMAT_DOLBY_TRUEHD:
case AUDIO_FORMAT_IEC61937: {
is_enabled = true;
break;
}
default:
is_enabled = false;
break;
}
}
}
return is_enabled;
}
/*Closes all pcm hdmi output from QAF. */
static void close_all_pcm_hdmi_output()
{
int i;
//Closing all the PCM HDMI output stream from QAF.
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
if (p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD_MCH]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD_MCH]));
p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD_MCH] = NULL;
}
if ((p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD])
&& (p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD]->devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD]));
p_qaf->qaf_mod[i].stream_out[QAF_OUT_OFFLOAD] = NULL;
}
}
p_qaf->mch_pcm_hdmi_enabled = 0;
}
static void close_all_hdmi_output()
{
int k;
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (p_qaf->qaf_mod[k].stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->qaf_mod[k].stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]));
p_qaf->qaf_mod[k].stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH] = NULL;
}
}
p_qaf->passthrough_enabled = 0;
close_all_pcm_hdmi_output();
}
static int qaf_out_callback(stream_callback_event_t event, void *param __unused, void *cookie)
{
struct stream_out *out = (struct stream_out *)cookie;
out->client_callback(event, NULL, out->client_cookie);
return 0;
}
/* Creates the QAF passthrough output stream. */
static int create_qaf_passthrough_stream()
{
DEBUG_MSG();
int ret = 0;
struct stream_out *out = p_qaf->passthrough_in;
if (!out) return -EINVAL;
pthread_mutex_lock(&p_qaf->lock);
lock_output_stream(out);
//Creating QAF passthrough output stream.
if (NULL == p_qaf->passthrough_out) {
audio_output_flags_t flags;
struct audio_config config;
audio_devices_t devices;
config.sample_rate = config.offload_info.sample_rate = out->sample_rate;
config.offload_info.version = AUDIO_INFO_INITIALIZER.version;
config.offload_info.size = AUDIO_INFO_INITIALIZER.size;
config.offload_info.format = out->format;
config.offload_info.bit_width = out->bit_width;
config.format = out->format;
config.offload_info.channel_mask = config.channel_mask = out->channel_mask;
//Device is copied from the QAF passthrough input stream.
devices = out->devices;
flags = out->flags;
ret = adev_open_output_stream((struct audio_hw_device *)p_qaf->adev,
QAF_DEFAULT_PASSTHROUGH_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(p_qaf->passthrough_out),
NULL);
if (ret < 0) {
ERROR_MSG("adev_open_output_stream failed with ret = %d!", ret);
unlock_output_stream(out);
return ret;
}
p_qaf->passthrough_in = out;
p_qaf->passthrough_out->stream.set_callback((struct audio_stream_out *)p_qaf->passthrough_out,
(stream_callback_t) qaf_out_callback, out);
}
unlock_output_stream(out);
//Since QAF-Passthrough is created, close other HDMI outputs.
close_all_hdmi_output();
pthread_mutex_unlock(&p_qaf->lock);
return ret;
}
/* Closes the QAF passthrough output stream. */
static void close_qaf_passthrough_stream()
{
if (p_qaf->passthrough_out != NULL) { //QAF pasthroug is enabled. Close it.
pthread_mutex_lock(&p_qaf->lock);
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->passthrough_out));
p_qaf->passthrough_out = NULL;
pthread_mutex_unlock(&p_qaf->lock);
if (p_qaf->passthrough_in->qaf_stream_handle) {
qaf_out_pause((struct audio_stream_out*)p_qaf->passthrough_in);
qaf_out_flush((struct audio_stream_out*)p_qaf->passthrough_in);
qaf_out_drain((struct audio_stream_out*)p_qaf->passthrough_in,
(audio_drain_type_t)STREAM_CBK_EVENT_DRAIN_READY);
}
}
}
/* Sends a command to output stream offload thread. */
static int qaf_send_offload_cmd_l(struct stream_out* out, int command)
{
DEBUG_MSG_VV("command is %d", command);
struct offload_cmd *cmd = (struct offload_cmd *)calloc(1, sizeof(struct offload_cmd));
if (!cmd) {
ERROR_MSG("failed to allocate mem for command 0x%x", command);
return -ENOMEM;
}
cmd->cmd = command;
lock_output_stream(out);
list_add_tail(&out->qaf_offload_cmd_list, &cmd->node);
pthread_cond_signal(&out->qaf_offload_cond);
unlock_output_stream(out);
return 0;
}
/* Stops a QAF module stream.*/
static int audio_extn_qaf_stream_stop(struct stream_out *out)
{
int ret = 0;
DEBUG_MSG("Output Stream 0x%p", out);
if (!check_stream_state(out, RUN)) return ret;
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
if ((!qaf_mod) || (!qaf_mod->qaf_audio_stream_stop)) {
return ret;
}
if (out->qaf_stream_handle) {
ret = qaf_mod->qaf_audio_stream_stop(out->qaf_stream_handle);
}
return ret;
}
/* Puts a QAF module stream in standby. */
static int qaf_out_standby(struct audio_stream *stream)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
ALOGD("%s: enter: stream (%p) usecase(%d: %s)", __func__,
stream, out->usecase, use_case_table[out->usecase]);
lock_output_stream(out);
//If QAF passthrough is active then block standby on all the input streams of QAF mm modules.
if (p_qaf->passthrough_out) {
//If standby is received on QAF passthrough stream then forward it to primary HAL.
if (p_qaf->passthrough_in == out) {
status = p_qaf->passthrough_out->stream.common.standby(
(struct audio_stream *)p_qaf->passthrough_out);
}
} else if (check_stream_state(out, RUN)) {
//If QAF passthrough stream is not active then stop the QAF module stream.
status = audio_extn_qaf_stream_stop(out);
if (status == 0) {
//Setting state to stopped as client not expecting drain_ready event.
set_stream_state(out, STOPPED);
}
}
if (!out->standby) {
out->standby = true;
}
unlock_output_stream(out);
return status;
}
/* Sets the volume to PCM output stream. */
static int qaf_out_set_volume(struct audio_stream_out *stream, float left, float right)
{
int ret = 0;
struct stream_out *out = (struct stream_out *)stream;
struct qaf_module *qaf_mod = NULL;
DEBUG_MSG("Left %f, Right %f", left, right);
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) {
return -EINVAL;
}
pthread_mutex_lock(&p_qaf->lock);
qaf_mod->vol_left = left;
qaf_mod->vol_right = right;
qaf_mod->is_vol_set = true;
pthread_mutex_unlock(&p_qaf->lock);
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD] != NULL) {
ret = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.set_volume(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD], left, right);
}
return ret;
}
/* Starts a QAF module stream. */
static int qaf_stream_start(struct stream_out *out)
{
int ret = -EINVAL;
struct qaf_module *qaf_mod = NULL;
DEBUG_MSG("Output Stream = %p", out);
qaf_mod = get_qaf_module_for_input_stream(out);
if ((!qaf_mod) || (!qaf_mod->qaf_audio_stream_start)) {
return -EINVAL;
}
if (out->qaf_stream_handle) {
ret = qaf_mod->qaf_audio_stream_start(out->qaf_stream_handle);
}
return ret;
}
static int qaf_start_output_stream(struct stream_out *out)
{
int ret = 0;
struct audio_device *adev = out->dev;
if ((out->usecase < 0) || (out->usecase >= AUDIO_USECASE_MAX)) {
ret = -EINVAL;
usleep(50000);
return ret;
}
ALOGD("%s: enter: stream(%p)usecase(%d: %s) devices(%#x)",
__func__, &out->stream, out->usecase, use_case_table[out->usecase],
out->devices);
if (CARD_STATUS_OFFLINE == out->card_status ||
CARD_STATUS_OFFLINE == adev->card_status) {
ALOGE("%s: sound card is not active/SSR returning error", __func__);
ret = -EIO;
usleep(50000);
return ret;
}
return qaf_stream_start(out);
}
/* Sends input buffer to the QAF MM module. */
static int qaf_module_write_input_buffer(struct stream_out *out, const void *buffer, int bytes)
{
int ret = -EINVAL;
struct qaf_module *qaf_mod = NULL;
qaf_mod = get_qaf_module_for_input_stream(out);
if ((!qaf_mod) || (!qaf_mod->qaf_audio_stream_write)) {
return ret;
}
//If data received on associated stream when all other stream are stopped then drop the data.
if (out == qaf_mod->stream_in[QAF_IN_ASSOC] && !is_any_stream_running(qaf_mod))
return bytes;
if (out->qaf_stream_handle) {
ret = qaf_mod->qaf_audio_stream_write(out->qaf_stream_handle, buffer, bytes);
if(ret > 0) set_stream_state(out, RUN);
}
return ret;
}
/* Writes buffer to QAF input stream. */
static ssize_t qaf_out_write(struct audio_stream_out *stream, const void *buffer, size_t bytes)
{
struct stream_out *out = (struct stream_out *)stream;
struct audio_device *adev = out->dev;
ssize_t ret = 0;
DEBUG_MSG_VV("bytes = %d, usecase[%d] and flags[%x] for handle[%p]",
(int)bytes, out->usecase, out->flags, out);
lock_output_stream(out);
// If QAF passthrough is active then block writing data to QAF mm module.
if (p_qaf->passthrough_out) {
//If write is received for the QAF passthrough stream then send the buffer to primary HAL.
if (p_qaf->passthrough_in == out) {
ret = p_qaf->passthrough_out->stream.write(
(struct audio_stream_out *)(p_qaf->passthrough_out),
buffer,
bytes);
if (ret > 0) out->standby = false;
}
unlock_output_stream(out);
return ret;
} else if (out->standby) {
pthread_mutex_lock(&adev->lock);
ret = qaf_start_output_stream(out);
pthread_mutex_unlock(&adev->lock);
if (ret == 0) {
out->standby = false;
} else {
goto exit;
}
}
if ((adev->is_channel_status_set == false) && (out->devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)) {
audio_utils_set_hdmi_channel_status(out, (char *)buffer, bytes);
adev->is_channel_status_set = true;
}
ret = qaf_module_write_input_buffer(out, buffer, bytes);
DEBUG_MSG_VV("ret [%d]", (int)ret);
if (ret >= 0) {
out->written += ret / ((popcount(out->channel_mask) * sizeof(short)));
}
exit:
unlock_output_stream(out);
if (ret < 0) {
if (ret == -EAGAIN) {
DEBUG_MSG_VV("No space available in mm module, post msg to cb thread");
ret = qaf_send_offload_cmd_l(out, OFFLOAD_CMD_WAIT_FOR_BUFFER);
bytes = 0;
} else if (ret == -ENOMEM || ret == -EPERM) {
if (out->pcm)
ERROR_MSG("error %d, %s", (int)ret, pcm_get_error(out->pcm));
qaf_out_standby(&out->stream.common);
usleep(bytes * 1000000
/ audio_stream_out_frame_size(stream)
/ out->stream.common.get_sample_rate(&out->stream.common));
}
} else if (ret < (ssize_t)bytes) {
//partial buffer copied to the module.
DEBUG_MSG_VV("Not enough space available in mm module, post msg to cb thread");
(void)qaf_send_offload_cmd_l(out, OFFLOAD_CMD_WAIT_FOR_BUFFER);
bytes = ret;
}
return bytes;
}
/* Gets PCM offload buffer size for a given config. */
static uint32_t qaf_get_pcm_offload_buffer_size(audio_offload_info_t* info,
uint32_t samples_per_frame)
{
uint32_t fragment_size = 0;
fragment_size = (samples_per_frame * (info->bit_width >> 3) * popcount(info->channel_mask));
if (fragment_size < MIN_PCM_OFFLOAD_FRAGMENT_SIZE)
fragment_size = MIN_PCM_OFFLOAD_FRAGMENT_SIZE;
else if (fragment_size > MAX_PCM_OFFLOAD_FRAGMENT_SIZE)
fragment_size = MAX_PCM_OFFLOAD_FRAGMENT_SIZE;
// To have same PCM samples for all channels, the buffer size requires to
// be multiple of (number of channels * bytes per sample)
// For writes to succeed, the buffer must be written at address which is multiple of 32
fragment_size = ALIGN(fragment_size,
((info->bit_width >> 3) * popcount(info->channel_mask) * 32));
ALOGI("Qaf PCM offload Fragment size is %d bytes", fragment_size);
return fragment_size;
}
static uint32_t qaf_get_pcm_offload_input_buffer_size(audio_offload_info_t* info)
{
return qaf_get_pcm_offload_buffer_size(info, MS12_PCM_IN_FRAGMENT_SIZE);
}
static uint32_t qaf_get_pcm_offload_output_buffer_size(struct qaf_module *qaf_mod,
audio_offload_info_t* info)
{
return qaf_get_pcm_offload_buffer_size(info, get_pcm_output_buffer_size_samples(qaf_mod));
}
/* Gets buffer latency in samples. */
static int get_buffer_latency(struct stream_out *out, uint32_t buffer_size, uint32_t *latency)
{
unsigned long int samples_in_one_encoded_frame;
unsigned long int size_of_one_encoded_frame;
switch (out->format) {
case AUDIO_FORMAT_AC3:
samples_in_one_encoded_frame = DD_FRAME_SIZE;
size_of_one_encoded_frame = DD_ENCODER_OUTPUT_SIZE;
break;
case AUDIO_FORMAT_E_AC3:
samples_in_one_encoded_frame = DDP_FRAME_SIZE;
size_of_one_encoded_frame = DDP_ENCODER_OUTPUT_SIZE;
break;
case AUDIO_FORMAT_DTS:
samples_in_one_encoded_frame = DTS_FRAME_SIZE;
size_of_one_encoded_frame = DTS_ENCODER_OUTPUT_SIZE;
break;
case AUDIO_FORMAT_DTS_HD:
samples_in_one_encoded_frame = DTSHD_FRAME_SIZE;
size_of_one_encoded_frame = DTSHD_ENCODER_OUTPUT_SIZE;
break;
case AUDIO_FORMAT_PCM_16_BIT:
samples_in_one_encoded_frame = 1;
size_of_one_encoded_frame = ((out->bit_width) >> 3) * popcount(out->channel_mask);
break;
default:
*latency = 0;
return (-EINVAL);
}
*latency = ((buffer_size * samples_in_one_encoded_frame) / size_of_one_encoded_frame);
return 0;
}
/* Returns the number of frames rendered to outside observer. */
static int qaf_get_rendered_frames(struct stream_out *out, uint64_t *frames)
{
int ret = 0, i;
struct str_parms *parms;
int value = 0;
int module_latency = 0;
uint32_t kernel_latency = 0;
uint32_t dsp_latency = 0;
int signed_frames = 0;
char* kvpairs = NULL;
struct qaf_module *qaf_mod = NULL;
DEBUG_MSG("Output Format %d", out->format);
qaf_mod = get_qaf_module_for_input_stream(out);
if ((!qaf_mod) || (!qaf_mod->qaf_audio_stream_get_param)) {
return -EINVAL;
}
//Get MM module latency.
kvpairs = qaf_mod->qaf_audio_stream_get_param(out->qaf_stream_handle, "get_latency");
if (kvpairs) {
parms = str_parms_create_str(kvpairs);
ret = str_parms_get_int(parms, "get_latency", &module_latency);
if (ret >= 0) {
str_parms_destroy(parms);
parms = NULL;
}
free(kvpairs);
kvpairs = NULL;
}
//Get kernel Latency
for (i = MAX_QAF_MODULE_OUT - 1; i >= 0; i--) {
if (qaf_mod->stream_out[i] == NULL) {
continue;
} else {
unsigned int num_fragments = qaf_mod->stream_out[i]->compr_config.fragments;
uint32_t fragment_size = qaf_mod->stream_out[i]->compr_config.fragment_size;
uint32_t kernel_buffer_size = num_fragments * fragment_size;
get_buffer_latency(qaf_mod->stream_out[i], kernel_buffer_size, &kernel_latency);
break;
}
}
//Get DSP latency
if ((qaf_mod->stream_out[QAF_OUT_OFFLOAD] != NULL)
|| (qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH] != NULL)) {
unsigned int sample_rate = 0;
audio_usecase_t platform_latency = 0;
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD])
sample_rate = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->sample_rate;
else if (qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH])
sample_rate = qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->sample_rate;
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD])
platform_latency =
platform_render_latency(qaf_mod->stream_out[QAF_OUT_OFFLOAD]->usecase);
else
platform_latency =
platform_render_latency(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->usecase);
dsp_latency = (platform_latency * sample_rate) / 1000000LL;
} else if (qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH] != NULL) {
unsigned int sample_rate = 0;
sample_rate = qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]->sample_rate; //TODO: How this sample rate can be used?
dsp_latency = (COMPRESS_OFFLOAD_PLAYBACK_LATENCY * sample_rate) / 1000;
}
// MM Module Latency + Kernel Latency + DSP Latency
if ( audio_extn_bt_hal_get_output_stream(qaf_mod->bt_hdl) != NULL) {
out->platform_latency = module_latency + audio_extn_bt_hal_get_latency(qaf_mod->bt_hdl);
} else {
out->platform_latency = (uint32_t)module_latency + kernel_latency + dsp_latency;
}
if (out->format & AUDIO_FORMAT_PCM_16_BIT) {
*frames = 0;
signed_frames = out->written - out->platform_latency;
// It would be unusual for this value to be negative, but check just in case ...
if (signed_frames >= 0) {
*frames = signed_frames;
}
} else if (qaf_mod->qaf_audio_stream_get_param) {
kvpairs = qaf_mod->qaf_audio_stream_get_param(out->qaf_stream_handle, "position");
if (kvpairs) {
parms = str_parms_create_str(kvpairs);
ret = str_parms_get_int(parms, "position", &value);
if (ret >= 0) {
*frames = value;
signed_frames = value - out->platform_latency;
// It would be unusual for this value to be negative, but check just in case ...
if (signed_frames >= 0) {
*frames = signed_frames;
}
}
str_parms_destroy(parms);
}
} else {
ret = -EINVAL;
}
return ret;
}
static int qaf_out_get_render_position(const struct audio_stream_out *stream,
uint32_t *dsp_frames)
{
struct stream_out *out = (struct stream_out *)stream;
int ret = 0;
uint64_t frames=0;
struct qaf_module* qaf_mod = NULL;
ALOGV("%s, Output Stream %p,dsp frames %d",__func__, stream, (int)dsp_frames);
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) {
ret = out->stream.get_render_position(stream, dsp_frames);
ALOGV("%s, non qaf_MOD DSP FRAMES %d",__func__, (int)dsp_frames);
return ret;
}
if (p_qaf->passthrough_out) {
pthread_mutex_lock(&p_qaf->lock);
ret = p_qaf->passthrough_out->stream.get_render_position((struct audio_stream_out *)p_qaf->passthrough_out, dsp_frames);
pthread_mutex_unlock(&p_qaf->lock);
ALOGV("%s, PASS THROUGH DSP FRAMES %p",__func__, dsp_frames);
return ret;
}
frames=*dsp_frames;
ret = qaf_get_rendered_frames(out, &frames);
*dsp_frames = (uint32_t)frames;
ALOGV("%s, DSP FRAMES %d",__func__, (int)dsp_frames);
return ret;
}
static int qaf_out_get_presentation_position(const struct audio_stream_out *stream,
uint64_t *frames,
struct timespec *timestamp)
{
struct stream_out *out = (struct stream_out *)stream;
int ret = 0;
DEBUG_MSG("Output Stream %p", stream);
//If QAF passthorugh output stream is active.
if (p_qaf->passthrough_out) {
if (p_qaf->passthrough_in == out) {
//If api is called for QAF passthorugh stream then call the primary HAL api to get the position.
pthread_mutex_lock(&p_qaf->lock);
ret = p_qaf->passthrough_out->stream.get_presentation_position(
(struct audio_stream_out *)p_qaf->passthrough_out,
frames,
timestamp);
pthread_mutex_unlock(&p_qaf->lock);
} else {
//If api is called for other stream then return zero frames.
*frames = 0;
clock_gettime(CLOCK_MONOTONIC, timestamp);
}
return ret;
}
ret = qaf_get_rendered_frames(out, frames);
clock_gettime(CLOCK_MONOTONIC, timestamp);
return ret;
}
/* Pause the QAF module input stream. */
static int qaf_stream_pause(struct stream_out *out)
{
struct qaf_module *qaf_mod = NULL;
int ret = -EINVAL;
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod || !qaf_mod->qaf_audio_stream_pause) {
return -EINVAL;
}
if (out->qaf_stream_handle)
ret = qaf_mod->qaf_audio_stream_pause(out->qaf_stream_handle);
return ret;
}
/* Pause a QAF input stream. */
static int qaf_out_pause(struct audio_stream_out* stream)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
DEBUG_MSG("Output Stream %p", out);
lock_output_stream(out);
//If QAF passthrough is enabled then block the pause on module stream.
if (p_qaf->passthrough_out) {
pthread_mutex_lock(&p_qaf->lock);
//If pause is received for QAF passthorugh stream then call the primary HAL api.
if (p_qaf->passthrough_in == out) {
status = p_qaf->passthrough_out->stream.pause(
(struct audio_stream_out *)p_qaf->passthrough_out);
out->offload_state = OFFLOAD_STATE_PAUSED;
}
pthread_mutex_unlock(&p_qaf->lock);
} else {
//Pause the module input stream.
status = qaf_stream_pause(out);
}
unlock_output_stream(out);
return status;
}
/* Drains a qaf input stream. */
static int qaf_out_drain(struct audio_stream_out* stream, audio_drain_type_t type)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
struct qaf_module *qaf_mod = NULL;
qaf_mod = get_qaf_module_for_input_stream(out);
DEBUG_MSG("Output Stream %p", out);
lock_output_stream(out);
//If QAF passthrough is enabled then block the drain on module stream.
if (p_qaf->passthrough_out) {
pthread_mutex_lock(&p_qaf->lock);
//If drain is received for QAF passthorugh stream then call the primary HAL api.
if (p_qaf->passthrough_in == out) {
status = p_qaf->passthrough_out->stream.drain(
(struct audio_stream_out *)p_qaf->passthrough_out, type);
}
pthread_mutex_unlock(&p_qaf->lock);
} else if (!is_any_stream_running(qaf_mod)) {
//If stream is already stopped then send the drain ready.
out->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out->client_cookie);
set_stream_state(out, STOPPED);
} else {
//Drain the module input stream.
/* Stream stop will trigger EOS and on EOS_EVENT received
from callback DRAIN_READY command is sent */
status = audio_extn_qaf_stream_stop(out);
if (status == 0) {
//Setting state to stopping as client is expecting drain_ready event.
set_stream_state(out, STOPPING);
}
}
unlock_output_stream(out);
return status;
}
/* Flush the QAF module input stream. */
static int audio_extn_qaf_stream_flush(struct stream_out *out)
{
DEBUG_MSG("Output Stream %p", out);
int ret = -EINVAL;
struct qaf_module *qaf_mod = NULL;
qaf_mod = get_qaf_module_for_input_stream(out);
if ((!qaf_mod) || (!qaf_mod->qaf_audio_stream_flush)) {
return -EINVAL;
}
if (out->qaf_stream_handle)
ret = qaf_mod->qaf_audio_stream_flush(out->qaf_stream_handle);
return ret;
}
/* Flush the QAF input stream. */
static int qaf_out_flush(struct audio_stream_out* stream)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
DEBUG_MSG("Output Stream %p", out);
lock_output_stream(out);
if (!out->standby) {
//If QAF passthrough is active then block the flush on module input streams.
if (p_qaf->passthrough_out) {
pthread_mutex_lock(&p_qaf->lock);
//If flush is received for the QAF passthrough stream then call the primary HAL api.
if (p_qaf->passthrough_in == out) {
status = p_qaf->passthrough_out->stream.flush(
(struct audio_stream_out *)p_qaf->passthrough_out);
out->offload_state = OFFLOAD_STATE_IDLE;
}
pthread_mutex_unlock(&p_qaf->lock);
} else {
//Flush the module input stream.
status = audio_extn_qaf_stream_flush(out);
}
}
unlock_output_stream(out);
DEBUG_MSG("Exit");
return status;
}
static uint32_t qaf_out_get_latency(const struct audio_stream_out *stream)
{
struct stream_out *out = (struct stream_out *)stream;
uint32_t latency = 0;
struct qaf_module *qaf_mod = NULL;
DEBUG_MSG_VV("Output Stream %p", out);
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) {
return 0;
}
//If QAF passthrough is active then block the get latency on module input streams.
if (p_qaf->passthrough_out) {
pthread_mutex_lock(&p_qaf->lock);
//If get latency is called for the QAF passthrough stream then call the primary HAL api.
if (p_qaf->passthrough_in == out) {
latency = p_qaf->passthrough_out->stream.get_latency(
(struct audio_stream_out *)p_qaf->passthrough_out);
}
pthread_mutex_unlock(&p_qaf->lock);
} else {
if (is_offload_usecase(out->usecase)) {
latency = COMPRESS_OFFLOAD_PLAYBACK_LATENCY;
} else {
uint32_t sample_rate = 0;
latency = QAF_MODULE_PCM_INPUT_BUFFER_LATENCY; //Input latency
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD])
sample_rate = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->sample_rate;
else if (qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH])
sample_rate = qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->sample_rate;
if (sample_rate) {
latency += (get_pcm_output_buffer_size_samples(qaf_mod) * 1000) / out->sample_rate;
}
}
if ( audio_extn_bt_hal_get_output_stream(qaf_mod->bt_hdl) != NULL) {
if (is_offload_usecase(out->usecase)) {
latency = audio_extn_bt_hal_get_latency(qaf_mod->bt_hdl) +
QAF_COMPRESS_OFFLOAD_PROCESSING_LATENCY;
} else {
latency = audio_extn_bt_hal_get_latency(qaf_mod->bt_hdl) +
QAF_PCM_OFFLOAD_PROCESSING_LATENCY;
}
}
}
DEBUG_MSG_VV("Latency %d", latency);
return latency;
}
static bool check_and_get_compressed_device_format(int device, int *format)
{
switch (device) {
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | AUDIO_COMPRESSED_OUT_DD):
*format = AUDIO_FORMAT_AC3;
return true;
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | AUDIO_COMPRESSED_OUT_DDP):
*format = AUDIO_FORMAT_E_AC3;
return true;
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | AUDIO_FORMAT_DTS):
*format = AUDIO_FORMAT_DTS;
return true;
default:
return false;
}
}
static void set_out_stream_channel_map(struct stream_out *out, audio_qaf_media_format_t *media_fmt)
{
if (media_fmt == NULL || out == NULL) {
return;
}
struct audio_out_channel_map_param chmap = {0,{0}};
int i = 0;
chmap.channels = media_fmt->channels;
for (i = 0; i < chmap.channels && i < AUDIO_CHANNEL_COUNT_MAX && i < AUDIO_QAF_MAX_CHANNELS;
i++) {
chmap.channel_map[i] = media_fmt->ch_map[i];
}
audio_extn_utils_set_channel_map(out, &chmap);
}
/* Call back function for mm module. */
static void notify_event_callback(audio_session_handle_t session_handle __unused,
void *prv_data,
void *buf,
audio_event_id_t event_id,
int size,
int device) //TODO: add media format as well.
{
/*
For SPKR:
1. Open pcm device if device_id passed to it SPKR and write the data to
pcm device
For HDMI
1.Open compress device for HDMI(PCM or AC3) based on current hdmi o/p format and write
data to the HDMI device.
*/
int ret;
audio_output_flags_t flags;
struct qaf_module* qaf_mod = (struct qaf_module*)prv_data;
struct audio_stream_out *bt_stream = NULL;
int format;
int8_t *data_buffer_p = NULL;
uint32_t buffer_size = 0;
bool need_to_recreate_stream = false;
struct audio_config config;
audio_qaf_media_format_t *media_fmt = NULL;
if (qaf_mod->is_session_closing) {
DEBUG_MSG("Dropping event as session is closing."
"Device 0x%X, Event = 0x%X, Bytes to write %d", device, event_id, size);
return;
}
DEBUG_MSG_VV("Device 0x%X, Event = 0x%X, Bytes to write %d", device, event_id, size);
/* Default config initialization. */
config.sample_rate = config.offload_info.sample_rate = QAF_OUTPUT_SAMPLING_RATE;
config.offload_info.version = AUDIO_INFO_INITIALIZER.version;
config.offload_info.size = AUDIO_INFO_INITIALIZER.size;
config.format = config.offload_info.format = AUDIO_FORMAT_PCM_16_BIT;
config.offload_info.bit_width = CODEC_BACKEND_DEFAULT_BIT_WIDTH;
config.offload_info.channel_mask = config.channel_mask = AUDIO_CHANNEL_OUT_STEREO;
if (event_id == AUDIO_SEC_FAIL_EVENT) {
DEBUG_MSG("%s Security failed, closing session", __func__);
qaf_session_close(qaf_mod);
return;
}
pthread_mutex_lock(&p_qaf->lock);
if (event_id == AUDIO_DATA_EVENT) {
data_buffer_p = (int8_t*)buf;
buffer_size = size;
} else if (event_id == AUDIO_DATA_EVENT_V2) {
audio_qaf_out_buffer_t *buf_payload = (audio_qaf_out_buffer_t*)buf;
int index = -1;
if ((uint32_t)size < sizeof(audio_qaf_out_buffer_t)) {
ERROR_MSG("AUDIO_DATA_EVENT_V2 payload size is not sufficient.");
return;
}
data_buffer_p = (int8_t*)buf_payload->data + buf_payload->offset;
buffer_size = buf_payload->size - buf_payload->offset;
index = get_media_fmt_array_index_for_output_id(qaf_mod, buf_payload->output_id);
if (index < 0) {
/*If media format is not received then switch to default values.*/
event_id = AUDIO_DATA_EVENT;
} else {
media_fmt = &qaf_mod->out_stream_fmt[index];
need_to_recreate_stream = qaf_mod->is_media_fmt_changed[index];
qaf_mod->is_media_fmt_changed[index] = false;
config.sample_rate = config.offload_info.sample_rate = media_fmt->sample_rate;
config.offload_info.version = AUDIO_INFO_INITIALIZER.version;
config.offload_info.size = AUDIO_INFO_INITIALIZER.size;
config.format = config.offload_info.format = media_fmt->format;
config.offload_info.bit_width = media_fmt->bit_width;
if (media_fmt->format == AUDIO_FORMAT_PCM) {
if (media_fmt->bit_width == 16)
config.format = config.offload_info.format = AUDIO_FORMAT_PCM_16_BIT;
else if (media_fmt->bit_width == 24)
config.format = config.offload_info.format = AUDIO_FORMAT_PCM_24_BIT_PACKED;
else
config.format = config.offload_info.format = AUDIO_FORMAT_PCM_32_BIT;
}
device |= (media_fmt->format & AUDIO_FORMAT_MAIN_MASK);
config.channel_mask = audio_channel_out_mask_from_count(media_fmt->channels);
config.offload_info.channel_mask = config.channel_mask;
}
}
if (event_id == AUDIO_OUTPUT_MEDIA_FORMAT_EVENT) {
audio_qaf_media_format_t *p_fmt = (audio_qaf_media_format_t*)buf;
audio_qaf_media_format_t *p_cached_fmt = NULL;
int index = -1;
if ( (uint32_t)size < sizeof(audio_qaf_media_format_t)) {
ERROR_MSG("Size is not proper for the event AUDIO_OUTPUT_MEDIA_FORMAT_EVENT.");
return ;
}
index = get_media_fmt_array_index_for_output_id(qaf_mod, p_fmt->output_id);
if (index >= 0) {
p_cached_fmt = &qaf_mod->out_stream_fmt[index];
} else if (index < 0 && qaf_mod->new_out_format_index < MAX_QAF_MODULE_OUT) {
index = qaf_mod->new_out_format_index;
p_cached_fmt = &qaf_mod->out_stream_fmt[index];
qaf_mod->new_out_format_index++;
}
if (p_cached_fmt == NULL) {
ERROR_MSG("Maximum output from a QAF module is reached. Can not process new output.");
return ;
}
if (memcmp(p_cached_fmt, p_fmt, sizeof(audio_qaf_media_format_t)) != 0) {
memcpy(p_cached_fmt, p_fmt, sizeof(audio_qaf_media_format_t));
qaf_mod->is_media_fmt_changed[index] = true;
}
} else if (event_id == AUDIO_DATA_EVENT || event_id == AUDIO_DATA_EVENT_V2) {
if (p_qaf->passthrough_out != NULL) {
//If QAF passthrough is active then all the module output will be dropped.
pthread_mutex_unlock(&p_qaf->lock);
DEBUG_MSG("QAF-PSTH is active, DROPPING DATA!");
return;
}
if (check_and_get_compressed_device_format(device, &format)) {
/*
* CASE 1: Transcoded output of mm module.
* If HDMI is not connected then drop the data.
* Only one HDMI output can be supported from all the mm modules of QAF.
* Multi-Channel PCM HDMI output streams will be closed from all the mm modules.
* If transcoded output of other module is already enabled then this data will be dropped.
*/
if (!p_qaf->hdmi_connect) {
DEBUG_MSG("HDMI not connected, DROPPING DATA!");
pthread_mutex_unlock(&p_qaf->lock);
return;
}
//Closing all the PCM HDMI output stream from QAF.
close_all_pcm_hdmi_output();
/* If Media format was changed for this stream then need to re-create the stream. */
if (need_to_recreate_stream && qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]));
qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH] = NULL;
p_qaf->passthrough_enabled = false;
}
if (!p_qaf->passthrough_enabled
&& !(qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH])) {
audio_devices_t devices;
config.format = config.offload_info.format = format;
config.offload_info.channel_mask = config.channel_mask = AUDIO_CHANNEL_OUT_5POINT1;
flags = (AUDIO_OUTPUT_FLAG_NON_BLOCKING
| AUDIO_OUTPUT_FLAG_COMPRESS_OFFLOAD
| AUDIO_OUTPUT_FLAG_DIRECT
| AUDIO_OUTPUT_FLAG_COMPRESS_PASSTHROUGH);
devices = AUDIO_DEVICE_OUT_AUX_DIGITAL;
ret = adev_open_output_stream((struct audio_hw_device *)p_qaf->adev,
QAF_DEFAULT_COMPR_PASSTHROUGH_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]),
NULL);
if (ret < 0) {
ERROR_MSG("adev_open_output_stream failed with ret = %d!", ret);
pthread_mutex_unlock(&p_qaf->lock);
return;
}
if (format == AUDIO_FORMAT_E_AC3) {
qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]->compr_config.fragment_size =
COMPRESS_PASSTHROUGH_DDP_FRAGMENT_SIZE;
}
qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
p_qaf->passthrough_enabled = true;
}
if (qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]) {
ret = qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH]->stream.write(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_TRANSCODE_PASSTHROUGH],
data_buffer_p,
buffer_size);
}
}
else if ((device & AUDIO_DEVICE_OUT_AUX_DIGITAL)
&& (p_qaf->hdmi_connect)
&& (p_qaf->hdmi_sink_channels > 2)) {
/* CASE 2: Multi-Channel PCM output to HDMI.
* If any other HDMI output is already enabled then this has to be dropped.
*/
if (p_qaf->passthrough_enabled) {
//Closing all the multi-Channel PCM HDMI output stream from QAF.
close_all_pcm_hdmi_output();
//If passthrough is active then pcm hdmi output has to be dropped.
pthread_mutex_unlock(&p_qaf->lock);
DEBUG_MSG("Compressed passthrough enabled, DROPPING DATA!");
return;
}
/* If Media format was changed for this stream then need to re-create the stream. */
if (need_to_recreate_stream && qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]));
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH] = NULL;
p_qaf->mch_pcm_hdmi_enabled = false;
}
if (!p_qaf->mch_pcm_hdmi_enabled && !(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH])) {
audio_devices_t devices;
if (event_id == AUDIO_DATA_EVENT) {
config.offload_info.format = config.format = AUDIO_FORMAT_PCM_16_BIT;
if (p_qaf->hdmi_sink_channels == 8) {
config.offload_info.channel_mask = config.channel_mask =
AUDIO_CHANNEL_OUT_7POINT1;
} else if (p_qaf->hdmi_sink_channels == 6) {
config.offload_info.channel_mask = config.channel_mask =
AUDIO_CHANNEL_OUT_5POINT1;
} else {
config.offload_info.channel_mask = config.channel_mask =
AUDIO_CHANNEL_OUT_STEREO;
}
}
devices = AUDIO_DEVICE_OUT_AUX_DIGITAL;
flags = AUDIO_OUTPUT_FLAG_DIRECT;
ret = adev_open_output_stream((struct audio_hw_device *)p_qaf->adev,
QAF_DEFAULT_COMPR_AUDIO_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]),
NULL);
if (ret < 0) {
ERROR_MSG("adev_open_output_stream failed with ret = %d!", ret);
pthread_mutex_unlock(&p_qaf->lock);
return;
}
set_out_stream_channel_map(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH], media_fmt);
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->compr_config.fragment_size =
qaf_get_pcm_offload_output_buffer_size(qaf_mod, &config.offload_info);
p_qaf->mch_pcm_hdmi_enabled = true;
if ((qaf_mod->stream_in[QAF_IN_MAIN]
&& qaf_mod->stream_in[QAF_IN_MAIN]->client_callback != NULL) ||
(qaf_mod->stream_in[QAF_IN_MAIN_2]
&& qaf_mod->stream_in[QAF_IN_MAIN_2]->client_callback != NULL)) {
if (qaf_mod->stream_in[QAF_IN_MAIN]) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH],
qaf_mod->stream_in[QAF_IN_MAIN]->client_callback,
qaf_mod->stream_in[QAF_IN_MAIN]->client_cookie);
}
if (qaf_mod->stream_in[QAF_IN_MAIN_2]) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH],
qaf_mod->stream_in[QAF_IN_MAIN_2]->client_callback,
qaf_mod->stream_in[QAF_IN_MAIN_2]->client_cookie);
}
} else if (qaf_mod->stream_in[QAF_IN_PCM]
&& qaf_mod->stream_in[QAF_IN_PCM]->client_callback != NULL) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH],
qaf_mod->stream_in[QAF_IN_PCM]->client_callback,
qaf_mod->stream_in[QAF_IN_PCM]->client_cookie);
}
int index = -1;
if (qaf_mod->adsp_hdlr_config[QAF_IN_MAIN].adsp_hdlr_config_valid)
index = (int) QAF_IN_MAIN;
else if (qaf_mod->adsp_hdlr_config[QAF_IN_MAIN_2].adsp_hdlr_config_valid)
index = (int) QAF_IN_MAIN_2;
else if (qaf_mod->adsp_hdlr_config[QAF_IN_PCM].adsp_hdlr_config_valid)
index = (int) QAF_IN_PCM;
if (index >= 0) {
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->standby)
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->stream.write(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH], NULL, 0);
lock_output_stream(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]);
ret = audio_extn_out_set_param_data(
qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH],
AUDIO_EXTN_PARAM_ADSP_STREAM_CMD,
(audio_extn_param_payload *)&qaf_mod->adsp_hdlr_config[index].event_params);
unlock_output_stream(qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]);
}
}
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]) {
ret = qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH]->stream.write(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD_MCH],
data_buffer_p,
buffer_size);
}
}
else {
/* CASE 3: PCM output.
*/
/* If Media format was changed for this stream then need to re-create the stream. */
if (need_to_recreate_stream && qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(qaf_mod->stream_out[QAF_OUT_OFFLOAD]));
qaf_mod->stream_out[QAF_OUT_OFFLOAD] = NULL;
}
bt_stream = audio_extn_bt_hal_get_output_stream(qaf_mod->bt_hdl);
if (bt_stream != NULL) {
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(qaf_mod->stream_out[QAF_OUT_OFFLOAD]));
qaf_mod->stream_out[QAF_OUT_OFFLOAD] = NULL;
}
audio_extn_bt_hal_out_write(p_qaf->bt_hdl, data_buffer_p, buffer_size);
} else if (NULL == qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
audio_devices_t devices;
if (qaf_mod->stream_in[QAF_IN_MAIN])
devices = qaf_mod->stream_in[QAF_IN_MAIN]->devices;
else
devices = qaf_mod->stream_in[QAF_IN_PCM]->devices;
//If multi channel pcm or passthrough is already enabled then remove the hdmi flag from device.
if (p_qaf->mch_pcm_hdmi_enabled || p_qaf->passthrough_enabled) {
if (devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)
devices ^= AUDIO_DEVICE_OUT_AUX_DIGITAL;
}
if (devices == 0) {
devices = device;
}
flags = AUDIO_OUTPUT_FLAG_DIRECT;
/* TODO:: Need to Propagate errors to framework */
ret = adev_open_output_stream((struct audio_hw_device *)p_qaf->adev,
QAF_DEFAULT_COMPR_AUDIO_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qaf_mod->stream_out[QAF_OUT_OFFLOAD]),
NULL);
if (ret < 0) {
ERROR_MSG("adev_open_output_stream failed with ret = %d!", ret);
pthread_mutex_unlock(&p_qaf->lock);
return;
}
set_out_stream_channel_map(qaf_mod->stream_out[QAF_OUT_OFFLOAD], media_fmt);
if ((qaf_mod->stream_in[QAF_IN_MAIN]
&& qaf_mod->stream_in[QAF_IN_MAIN]->client_callback != NULL) ||
(qaf_mod->stream_in[QAF_IN_MAIN_2]
&& qaf_mod->stream_in[QAF_IN_MAIN_2]->client_callback != NULL)) {
if (qaf_mod->stream_in[QAF_IN_MAIN]) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD],
qaf_mod->stream_in[QAF_IN_MAIN]->client_callback,
qaf_mod->stream_in[QAF_IN_MAIN]->client_cookie);
}
if (qaf_mod->stream_in[QAF_IN_MAIN_2]) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD],
qaf_mod->stream_in[QAF_IN_MAIN_2]->client_callback,
qaf_mod->stream_in[QAF_IN_MAIN_2]->client_cookie);
}
} else if (qaf_mod->stream_in[QAF_IN_PCM]
&& qaf_mod->stream_in[QAF_IN_PCM]->client_callback != NULL) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD],
qaf_mod->stream_in[QAF_IN_PCM]->client_callback,
qaf_mod->stream_in[QAF_IN_PCM]->client_cookie);
}
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->compr_config.fragment_size =
qaf_get_pcm_offload_output_buffer_size(qaf_mod, &config.offload_info);
if (qaf_mod->is_vol_set) {
DEBUG_MSG("Setting Volume Left[%f], Right[%f]", qaf_mod->vol_left, qaf_mod->vol_right);
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.set_volume(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD],
qaf_mod->vol_left,
qaf_mod->vol_right);
}
int index = -1;
if (qaf_mod->adsp_hdlr_config[QAF_IN_MAIN].adsp_hdlr_config_valid)
index = (int) QAF_IN_MAIN;
else if (qaf_mod->adsp_hdlr_config[QAF_IN_MAIN_2].adsp_hdlr_config_valid)
index = (int) QAF_IN_MAIN_2;
else if (qaf_mod->adsp_hdlr_config[QAF_IN_PCM].adsp_hdlr_config_valid)
index = (int) QAF_IN_PCM;
if (index >= 0) {
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD]->standby) {
qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.write(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD], NULL, 0);
}
lock_output_stream(qaf_mod->stream_out[QAF_OUT_OFFLOAD]);
ret = audio_extn_out_set_param_data(
qaf_mod->stream_out[QAF_OUT_OFFLOAD],
AUDIO_EXTN_PARAM_ADSP_STREAM_CMD,
(audio_extn_param_payload *)&qaf_mod->adsp_hdlr_config[index].event_params);
unlock_output_stream(qaf_mod->stream_out[QAF_OUT_OFFLOAD]);
}
}
/*
* TODO:: Since this is mixed data,
* need to identify to which stream the error should be sent
*/
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
ret = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.write(
(struct audio_stream_out *)qaf_mod->stream_out[QAF_OUT_OFFLOAD],
data_buffer_p,
buffer_size);
}
}
DEBUG_MSG_VV("Bytes written = %d", ret);
}
else if (event_id == AUDIO_EOS_EVENT
|| event_id == AUDIO_EOS_MAIN_DD_DDP_EVENT
|| event_id == AUDIO_EOS_MAIN_2_DD_DDP_EVENT
|| event_id == AUDIO_EOS_MAIN_AAC_EVENT
|| event_id == AUDIO_EOS_MAIN_AC4_EVENT
|| event_id == AUDIO_EOS_ASSOC_DD_DDP_EVENT
|| event_id == AUDIO_EOS_ASSOC_AAC_EVENT
|| event_id == AUDIO_EOS_ASSOC_AC4_EVENT) {
struct stream_out *out = qaf_mod->stream_in[QAF_IN_MAIN];
struct stream_out *out_pcm = qaf_mod->stream_in[QAF_IN_PCM];
struct stream_out *out_main2 = qaf_mod->stream_in[QAF_IN_MAIN_2];
struct stream_out *out_assoc = qaf_mod->stream_in[QAF_IN_ASSOC];
/**
* TODO:: Only DD/DDP Associate Eos is handled, need to add support
* for other formats.
*/
if (event_id == AUDIO_EOS_EVENT
&& (out_pcm != NULL)
&& (check_stream_state(out_pcm, STOPPING))) {
lock_output_stream(out_pcm);
out_pcm->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_pcm->client_cookie);
set_stream_state(out_pcm, STOPPED);
unlock_output_stream(out_pcm);
DEBUG_MSG("sent pcm DRAIN_READY");
} else if ( (event_id == AUDIO_EOS_ASSOC_DD_DDP_EVENT
|| event_id == AUDIO_EOS_ASSOC_AAC_EVENT
|| event_id == AUDIO_EOS_ASSOC_AC4_EVENT)
&& (out_assoc != NULL)
&& (check_stream_state(out_assoc, STOPPING))) {
lock_output_stream(out_assoc);
out_assoc->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_assoc->client_cookie);
set_stream_state(out_assoc, STOPPED);
unlock_output_stream(out_assoc);
DEBUG_MSG("sent associated DRAIN_READY");
} else if (event_id == AUDIO_EOS_MAIN_2_DD_DDP_EVENT
&& (out_main2 != NULL)
&& (check_stream_state(out_main2, STOPPING))) {
lock_output_stream(out_main2);
out_main2->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_main2->client_cookie);
set_stream_state(out_main2, STOPPED);
unlock_output_stream(out_main2);
DEBUG_MSG("sent main2 DRAIN_READY");
} else if ((out != NULL) && (check_stream_state(out, STOPPING))) {
lock_output_stream(out);
out->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out->client_cookie);
set_stream_state(out, STOPPED);
unlock_output_stream(out);
DEBUG_MSG("sent main DRAIN_READY");
}
}
else if (event_id == AUDIO_MAIN_EOS_EVENT || event_id == AUDIO_ASSOC_EOS_EVENT) {
struct stream_out *out = NULL;
if (event_id == AUDIO_MAIN_EOS_EVENT) {
out = qaf_mod->stream_in[QAF_IN_MAIN];
} else {
out = qaf_mod->stream_in[QAF_IN_ASSOC];
}
if ((out != NULL) && (check_stream_state(out, STOPPING))) {
lock_output_stream(out);
out->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out->client_cookie);
set_stream_state(out, STOPPED);
unlock_output_stream(out);
DEBUG_MSG("sent DRAIN_READY");
}
}
pthread_mutex_unlock(&p_qaf->lock);
return;
}
/* Close the mm module session. */
static int qaf_session_close(struct qaf_module* qaf_mod)
{
int j;
DEBUG_MSG("Closing Session.");
//Check if all streams are closed or not.
for (j = 0; j < MAX_QAF_MODULE_IN; j++) {
if (qaf_mod->stream_in[j] != NULL) {
break;
}
}
if (j != MAX_QAF_MODULE_IN) {
return 0; //Some stream is already active, Can not close session.
}
qaf_mod->is_session_closing = true;
pthread_mutex_lock(&p_qaf->lock);
if (qaf_mod->session_handle != NULL && qaf_mod->qaf_audio_session_close) {
#ifdef AUDIO_EXTN_IP_HDLR_ENABLED
if (qaf_mod == &p_qaf->qaf_mod[MS12]) {
audio_extn_ip_hdlr_intf_close(qaf_mod->ip_hdlr_hdl, false, qaf_mod->session_handle);
}
#endif
qaf_mod->qaf_audio_session_close(qaf_mod->session_handle);
qaf_mod->session_handle = NULL;
qaf_mod->is_vol_set = false;
memset(qaf_mod->stream_state, 0, sizeof(qaf_mod->stream_state));
}
for (j = 0; j < MAX_QAF_MODULE_OUT; j++) {
if (qaf_mod->stream_out[j]) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(qaf_mod->stream_out[j]));
qaf_mod->stream_out[j] = NULL;
}
memset(&qaf_mod->out_stream_fmt[j], 0, sizeof(audio_qaf_media_format_t));
qaf_mod->is_media_fmt_changed[j] = false;
}
qaf_mod->new_out_format_index = 0;
pthread_mutex_unlock(&p_qaf->lock);
qaf_mod->is_session_closing = false;
DEBUG_MSG("Session Closed.");
return 0;
}
/* Close the stream of QAF module. */
static int qaf_stream_close(struct stream_out *out)
{
int ret = -EINVAL;
struct qaf_module *qaf_mod = NULL;
int index = -1;
DEBUG_MSG("Flag [0x%x], Stream handle [%p]", out->flags, out->qaf_stream_handle);
qaf_mod = get_qaf_module_for_input_stream(out);
index = get_input_stream_index(out);
if (!qaf_mod || !qaf_mod->qaf_audio_stream_close || index < 0) {
return -EINVAL;
}
pthread_mutex_lock(&p_qaf->lock);
set_stream_state(out,STOPPED);
qaf_mod->stream_in[index] = NULL;
memset(&qaf_mod->adsp_hdlr_config[index], 0, sizeof(struct qaf_adsp_hdlr_config_state));
lock_output_stream(out);
if (out->qaf_stream_handle) {
ret = qaf_mod->qaf_audio_stream_close(out->qaf_stream_handle);
out->qaf_stream_handle = NULL;
}
unlock_output_stream(out);
pthread_mutex_unlock(&p_qaf->lock);
//If all streams are closed then close the session.
qaf_session_close(qaf_mod);
DEBUG_MSG();
return ret;
}
/* Open a MM module session with QAF. */
static int audio_extn_qaf_session_open(mm_module_type mod_type, struct stream_out *out)
{
ALOGV("%s %d", __func__, __LINE__);
unsigned char* license_data = NULL;
device_license_config_t lic_config = {NULL, 0, 0};
int ret = -ENOSYS;
struct qaf_module *qaf_mod = NULL;
if (mod_type >= MAX_MM_MODULE_TYPE || !(p_qaf->qaf_mod[mod_type].qaf_audio_session_open))
return -ENOTSUP; //Not supported by QAF module.
pthread_mutex_lock(&p_qaf->lock);
qaf_mod = &(p_qaf->qaf_mod[mod_type]);
//If session is already opened then return.
if (qaf_mod->session_handle) {
DEBUG_MSG("Session is already opened.");
pthread_mutex_unlock(&p_qaf->lock);
return 0;
}
#ifndef AUDIO_EXTN_IP_HDLR_ENABLED
{
int size=0;
char value[PROPERTY_VALUE_MAX] = {0};
if (mod_type == MS12) {
//Getting the license
license_data = platform_get_license((struct audio_hw_device *)(p_qaf->adev->platform),
&size);
if (!license_data) {
ERROR_MSG("License data is not present.");
pthread_mutex_unlock(&p_qaf->lock);
return -EINVAL;
}
lic_config.p_license = (unsigned char*)calloc(1, size);
if (lic_config.p_license == NULL) {
ERROR_MSG("Out of Memory");
ret = -ENOMEM;
goto exit;
}
lic_config.l_size = size;
memcpy(lic_config.p_license, license_data, size);
if (property_get("vendor.audio.qaf.manufacturer", value, "") && atoi(value)) {
lic_config.manufacturer_id = (unsigned long)atoi(value);
} else {
ERROR_MSG("vendor.audio.qaf.manufacturer id is not set");
ret = -EINVAL;
goto exit;
}
}
}
#endif
ret = qaf_mod->qaf_audio_session_open(&qaf_mod->session_handle,
AUDIO_SESSION_BROADCAST,
(void *)(qaf_mod),
(void *)&lic_config);
if (ret < 0) {
ERROR_MSG("Error in session open %d", ret);
goto exit;
}
if (qaf_mod->session_handle == NULL) {
ERROR_MSG("Session handle is NULL.");
ret = -ENOMEM;
goto exit;
}
if (qaf_mod->qaf_register_event_callback)
qaf_mod->qaf_register_event_callback(qaf_mod->session_handle,
qaf_mod,
&notify_event_callback,
AUDIO_DATA_EVENT_V2);
if(p_qaf->bt_connect)
set_bt_configuration_to_module();
else
set_hdmi_configuration_to_module();
#ifdef AUDIO_EXTN_IP_HDLR_ENABLED
if (mod_type == MS12) {
ret = audio_extn_ip_hdlr_intf_open(qaf_mod->ip_hdlr_hdl, false, qaf_mod->session_handle, out->usecase);
if (ret < 0) {
ERROR_MSG("%s audio_extn_ip_hdlr_intf_open failed, ret = %d", __func__, ret);
goto exit;
}
}
#endif
exit:
if (license_data != NULL) {
free(license_data);
license_data = NULL;
}
if (lic_config.p_license != NULL) {
free(lic_config.p_license);
lic_config.p_license = NULL;
}
pthread_mutex_unlock(&p_qaf->lock);
return ret;
}
/* opens a stream in QAF module. */
static int qaf_stream_open(struct stream_out *out,
struct audio_config *config,
audio_output_flags_t flags,
audio_devices_t devices)
{
int status = -EINVAL;
mm_module_type mmtype = get_mm_module_for_format(config->format);
struct qaf_module* qaf_mod = NULL;
DEBUG_MSG("Flags 0x%x, Device 0x%x", flags, devices);
if (mmtype >= MAX_MM_MODULE_TYPE) {
ERROR_MSG("Unsupported Stream");
return -ENOTSUP;
}
if (p_qaf->qaf_mod[mmtype].qaf_audio_session_open == NULL ||
p_qaf->qaf_mod[mmtype].qaf_audio_stream_open == NULL) {
ERROR_MSG("Session or Stream is NULL");
return -ENOTSUP;
}
//Open the module session, if not opened already.
status = audio_extn_qaf_session_open(mmtype, out);
qaf_mod = &(p_qaf->qaf_mod[mmtype]);
if ((status != 0) || (qaf_mod->session_handle == NULL)) {
ERROR_MSG("Failed to open session.");
return status;
}
audio_stream_config_t input_config;
input_config.sample_rate = config->sample_rate;
input_config.channels = popcount(config->channel_mask);
input_config.format = config->format;
if (input_config.format != AUDIO_FORMAT_PCM_16_BIT) {
input_config.format &= AUDIO_FORMAT_MAIN_MASK;
}
DEBUG_MSG("stream_open sample_rate(%d) channels(%d) devices(%#x) flags(%#x) format(%#x)",
input_config.sample_rate, input_config.channels, devices, flags, input_config.format);
if (input_config.format == AUDIO_FORMAT_PCM_16_BIT) {
//If PCM stream is already opened then fail this stream open.
if (qaf_mod->stream_in[QAF_IN_PCM]) {
ERROR_MSG("PCM input is already active.");
return -ENOTSUP;
}
//TODO: Flag can be system tone or external associated PCM.
status = qaf_mod->qaf_audio_stream_open(qaf_mod->session_handle,
&out->qaf_stream_handle,
input_config,
devices,
AUDIO_STREAM_SYSTEM_TONE);
if (status == 0) {
qaf_mod->stream_in[QAF_IN_PCM] = out;
} else {
ERROR_MSG("System tone stream open failed with QAF module !!!");
}
} else if ((flags & AUDIO_OUTPUT_FLAG_MAIN) && (flags & AUDIO_OUTPUT_FLAG_ASSOCIATED)) {
if (is_main_active(qaf_mod) || is_dual_main_active(qaf_mod)) {
ERROR_MSG("Dual Main or Main already active. So, Cannot open main and associated stream");
return -EINVAL;
} else {
status = qaf_mod->qaf_audio_stream_open(qaf_mod->session_handle, &out->qaf_stream_handle, input_config, devices, /*flags*/AUDIO_STREAM_MAIN);
if (status == 0) {
DEBUG_MSG("Open stream for Input with both Main and Associated stream contents with flag(%x) and stream_handle(%p)", flags, out->qaf_stream_handle);
qaf_mod->stream_in[QAF_IN_MAIN] = out;
} else {
ERROR_MSG("Stream Open FAILED !!!");
}
}
} else if ((flags & AUDIO_OUTPUT_FLAG_MAIN) || ((!(flags & AUDIO_OUTPUT_FLAG_MAIN)) && (!(flags & AUDIO_OUTPUT_FLAG_ASSOCIATED)))) {
/* Assume Main if no flag is set */
if (is_dual_main_active(qaf_mod)) {
ERROR_MSG("Dual Main already active. So, Cannot open main stream");
return -EINVAL;
} else if (is_main_active(qaf_mod) && qaf_mod->stream_in[QAF_IN_ASSOC]) {
ERROR_MSG("Main and Associated already active. So, Cannot open main stream");
return -EINVAL;
} else if (is_main_active(qaf_mod) && (mmtype != MS12)) {
ERROR_MSG("Main already active and Not an MS12 format. So, Cannot open another main stream");
return -EINVAL;
} else {
status = qaf_mod->qaf_audio_stream_open(qaf_mod->session_handle, &out->qaf_stream_handle, input_config, devices, /*flags*/AUDIO_STREAM_MAIN);
if (status == 0) {
DEBUG_MSG("Open stream for Input with only Main flag(%x) stream_handle(%p)", flags, out->qaf_stream_handle);
if(qaf_mod->stream_in[QAF_IN_MAIN]) {
qaf_mod->stream_in[QAF_IN_MAIN_2] = out;
} else {
qaf_mod->stream_in[QAF_IN_MAIN] = out;
}
} else {
ERROR_MSG("Stream Open FAILED !!!");
}
}
} else if ((flags & AUDIO_OUTPUT_FLAG_ASSOCIATED)) {
if (is_dual_main_active(qaf_mod)) {
ERROR_MSG("Dual Main already active. So, Cannot open associated stream");
return -EINVAL;
} else if (!is_main_active(qaf_mod)) {
ERROR_MSG("Main not active. So, Cannot open associated stream");
return -EINVAL;
} else if (qaf_mod->stream_in[QAF_IN_ASSOC]) {
ERROR_MSG("Associated already active. So, Cannot open associated stream");
return -EINVAL;
}
status = qaf_mod->qaf_audio_stream_open(qaf_mod->session_handle, &out->qaf_stream_handle, input_config, devices, /*flags*/AUDIO_STREAM_ASSOCIATED);
if (status == 0) {
DEBUG_MSG("Open stream for Input with only Associated flag(%x) stream handle(%p)", flags, out->qaf_stream_handle);
qaf_mod->stream_in[QAF_IN_ASSOC] = out;
} else {
ERROR_MSG("Stream Open FAILED !!!");
}
}
if (status != 0) {
//If no stream is active then close the session.
qaf_session_close(qaf_mod);
return 0;
}
//If Device is HDMI, QAF passthrough is enabled and there is no previous QAF passthrough input stream.
if ((!p_qaf->passthrough_in)
&& (devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)
&& audio_extn_qaf_passthrough_enabled(out)) {
//Assign the QAF passthrough input stream.
p_qaf->passthrough_in = out;
//If HDMI is connected and format is supported by HDMI then create QAF passthrough output stream.
if (p_qaf->hdmi_connect
&& platform_is_edid_supported_format(p_qaf->adev->platform, out->format)) {
status = create_qaf_passthrough_stream();
if (status < 0) {
qaf_stream_close(out);
ERROR_MSG("QAF passthrough stream creation failed with error %d", status);
return status;
}
}
/*Else: since QAF passthrough input stream is already initialized,
* when hdmi is connected
* then qaf passthrough output stream will be created.
*/
}
DEBUG_MSG();
return status;
}
/* Resume a QAF stream. */
static int qaf_out_resume(struct audio_stream_out* stream)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
DEBUG_MSG("Output Stream %p", out);
lock_output_stream(out);
//If QAF passthrough is active then block the resume on module input streams.
if (p_qaf->passthrough_out) {
//If resume is received for the QAF passthrough stream then call the primary HAL api.
pthread_mutex_lock(&p_qaf->lock);
if (p_qaf->passthrough_in == out) {
status = p_qaf->passthrough_out->stream.resume(
(struct audio_stream_out*)p_qaf->passthrough_out);
if (!status) out->offload_state = OFFLOAD_STATE_PLAYING;
}
pthread_mutex_unlock(&p_qaf->lock);
} else {
//Flush the module input stream.
status = qaf_stream_start(out);
}
unlock_output_stream(out);
DEBUG_MSG();
return status;
}
/* Offload thread for QAF output streams. */
static void *qaf_offload_thread_loop(void *context)
{
struct stream_out *out = (struct stream_out *)context;
struct listnode *item;
int ret = 0;
struct str_parms *parms = NULL;
int value = 0;
char* kvpairs = NULL;
struct qaf_module *qaf_mod = NULL;
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) return NULL;
setpriority(PRIO_PROCESS, 0, ANDROID_PRIORITY_AUDIO);
set_sched_policy(0, SP_FOREGROUND);
prctl(PR_SET_NAME, (unsigned long)"Offload Callback", 0, 0, 0);
lock_output_stream(out);
DEBUG_MSG();
for (;;) {
struct offload_cmd *cmd = NULL;
stream_callback_event_t event;
bool send_callback = false;
DEBUG_MSG_VV("List Empty %d (1:TRUE, 0:FALSE)", list_empty(&out->qaf_offload_cmd_list));
if (list_empty(&out->qaf_offload_cmd_list)) {
DEBUG_MSG_VV("SLEEPING");
pthread_cond_wait(&out->qaf_offload_cond, &out->lock);
DEBUG_MSG_VV("RUNNING");
continue;
}
item = list_head(&out->qaf_offload_cmd_list);
cmd = node_to_item(item, struct offload_cmd, node);
list_remove(item);
if (cmd->cmd == OFFLOAD_CMD_EXIT) {
free(cmd);
break;
}
unlock_output_stream(out);
send_callback = false;
switch (cmd->cmd) {
case OFFLOAD_CMD_WAIT_FOR_BUFFER: {
DEBUG_MSG_VV("wait for buffer availability");
while (1) {
kvpairs = qaf_mod->qaf_audio_stream_get_param(out->qaf_stream_handle,
"buf_available");
if (kvpairs) {
parms = str_parms_create_str(kvpairs);
ret = str_parms_get_int(parms, "buf_available", &value);
if (ret >= 0) {
if (value > 0) {
DEBUG_MSG_VV("buffer available");
str_parms_destroy(parms);
parms = NULL;
break;
} else {
DEBUG_MSG_VV("sleep");
str_parms_destroy(parms);
parms = NULL;
usleep(10000);
}
}
free(kvpairs);
kvpairs = NULL;
}
}
send_callback = true;
event = STREAM_CBK_EVENT_WRITE_READY;
break;
}
default:
DEBUG_MSG("unknown command received: %d", cmd->cmd);
break;
}
lock_output_stream(out);
if (send_callback && out->client_callback) {
out->client_callback(event, NULL, out->client_cookie);
}
free(cmd);
}
while (!list_empty(&out->qaf_offload_cmd_list)) {
item = list_head(&out->qaf_offload_cmd_list);
list_remove(item);
free (node_to_item( item, struct offload_cmd, node));
}
unlock_output_stream(out);
return NULL;
}
/* Create the offload callback thread for QAF output stream. */
static int qaf_create_offload_callback_thread(struct stream_out *out)
{
DEBUG_MSG("Output Stream %p", out);
lock_output_stream(out);
pthread_cond_init(&out->qaf_offload_cond, (const pthread_condattr_t *)NULL);
list_init(&out->qaf_offload_cmd_list);
pthread_create(&out->qaf_offload_thread,
(const pthread_attr_t *)NULL,
qaf_offload_thread_loop,
out);
unlock_output_stream(out);
return 0;
}
/* Destroy the offload callback thread of QAF output stream. */
static int qaf_destroy_offload_callback_thread(struct stream_out *out)
{
DEBUG_MSG("Output Stream %p", out);
qaf_send_offload_cmd_l(out, OFFLOAD_CMD_EXIT);
pthread_join(out->qaf_offload_thread, (void **)NULL);
pthread_cond_destroy(&out->qaf_offload_cond);
return 0;
}
/* Sets the stream set parameters (device routing information). */
static int qaf_out_set_parameters(struct audio_stream *stream, const char *kvpairs)
{
struct str_parms *parms;
char value[32];
int val = 0;
struct stream_out *out = (struct stream_out *)stream;
int ret = 0;
int err = 0;
struct qaf_module *qaf_mod = NULL;
DEBUG_MSG("usecase(%d: %s) kvpairs: %s", out->usecase, use_case_table[out->usecase], kvpairs);
parms = str_parms_create_str(kvpairs);
err = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_ROUTING, value, sizeof(value));
if (err < 0)
return err;
val = atoi(value);
qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) return (-EINVAL);
//TODO: HDMI is connected but user doesn't want HDMI output, close both HDMI outputs.
/* Setting new device information to the mm module input streams.
* This is needed if QAF module output streams are not created yet.
*/
out->devices = val;
#ifndef SPLIT_A2DP_ENABLED
if (val == AUDIO_DEVICE_OUT_BLUETOOTH_A2DP) {
//If device is BT then open the BT stream if not already opened.
if ( audio_extn_bt_hal_get_output_stream(qaf_mod->bt_hdl) == NULL
&& audio_extn_bt_hal_get_device(qaf_mod->bt_hdl) != NULL) {
ret = audio_extn_bt_hal_open_output_stream(qaf_mod->bt_hdl,
QAF_OUTPUT_SAMPLING_RATE,
AUDIO_CHANNEL_OUT_STEREO,
CODEC_BACKEND_DEFAULT_BIT_WIDTH);
if (ret != 0) {
ERROR_MSG("BT Output stream open failure!");
}
}
} else if (val != 0) {
//If device is not BT then close the BT stream if already opened.
if ( audio_extn_bt_hal_get_output_stream(qaf_mod->bt_hdl) != NULL) {
audio_extn_bt_hal_close_output_stream(qaf_mod->bt_hdl);
}
}
#endif
if (p_qaf->passthrough_in == out) { //Device routing is received for QAF passthrough stream.
if (!(val & AUDIO_DEVICE_OUT_AUX_DIGITAL)) { //HDMI route is disabled.
//If QAF pasthrough output is enabled. Close it.
close_qaf_passthrough_stream();
//Send the routing information to mm module pcm output.
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
ret = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.common.set_parameters(
(struct audio_stream *)qaf_mod->stream_out[QAF_OUT_OFFLOAD], kvpairs);
}
//else: device info is updated in the input streams.
} else { //HDMI route is enabled.
//create the QAf passthrough stream, if not created already.
ret = create_qaf_passthrough_stream();
if (p_qaf->passthrough_out != NULL) { //If QAF passthrough out is enabled then send routing information.
ret = p_qaf->passthrough_out->stream.common.set_parameters(
(struct audio_stream *)p_qaf->passthrough_out, kvpairs);
}
}
} else {
//Send the routing information to mm module pcm output.
if (qaf_mod->stream_out[QAF_OUT_OFFLOAD]) {
ret = qaf_mod->stream_out[QAF_OUT_OFFLOAD]->stream.common.set_parameters(
(struct audio_stream *)qaf_mod->stream_out[QAF_OUT_OFFLOAD], kvpairs);
}
//else: device info is updated in the input streams.
}
str_parms_destroy(parms);
return ret;
}
/* Checks if a stream is QAF stream or not. */
bool audio_extn_is_qaf_stream(struct stream_out *out)
{
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
if (qaf_mod) {
return true;
}
return false;
}
/* API to send playback stream specific config parameters */
int audio_extn_qaf_out_set_param_data(struct stream_out *out,
audio_extn_param_id param_id,
audio_extn_param_payload *payload)
{
int ret = -EINVAL;
int index;
struct stream_out *new_out = NULL;
struct audio_adsp_event *adsp_event;
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
if (!out || !qaf_mod || !payload) {
ERROR_MSG("Invalid Param");
return ret;
}
/* In qaf output render session may not be opened at this time.
to handle it store adsp_hdlr param info so that it can be
applied later after opening render session from ms12 callback
*/
if (param_id == AUDIO_EXTN_PARAM_ADSP_STREAM_CMD) {
index = get_input_stream_index(out);
if (index < 0) {
ERROR_MSG("Invalid stream");
return ret;
}
adsp_event = (struct audio_adsp_event *)payload;
if (payload->adsp_event_params.payload_length <= AUDIO_MAX_ADSP_STREAM_CMD_PAYLOAD_LEN) {
pthread_mutex_lock(&p_qaf->lock);
memcpy(qaf_mod->adsp_hdlr_config[index].event_payload,
adsp_event->payload,
adsp_event->payload_length);
qaf_mod->adsp_hdlr_config[index].event_params.payload =
qaf_mod->adsp_hdlr_config[index].event_payload;
qaf_mod->adsp_hdlr_config[index].event_params.payload_length =
adsp_event->payload_length;
qaf_mod->adsp_hdlr_config[index].adsp_hdlr_config_valid = true;
pthread_mutex_unlock(&p_qaf->lock);
} else {
ERROR_MSG("Invalid adsp event length %d", adsp_event->payload_length);
return ret;
}
ret = 0;
}
/* apply param for all active out sessions */
for (index = 0; index < MAX_QAF_MODULE_OUT; index++) {
new_out = qaf_mod->stream_out[index];
if (!new_out) continue;
/*ADSP event is not supported for passthrough*/
if ((param_id == AUDIO_EXTN_PARAM_ADSP_STREAM_CMD)
&& !(new_out->flags == AUDIO_OUTPUT_FLAG_DIRECT)) continue;
if (new_out->standby)
new_out->stream.write((struct audio_stream_out *)new_out, NULL, 0);
lock_output_stream(new_out);
ret = audio_extn_out_set_param_data(new_out, param_id, payload);
if (ret)
ERROR_MSG("audio_extn_out_set_param_data error %d", ret);
unlock_output_stream(new_out);
}
return ret;
}
int audio_extn_qaf_out_get_param_data(struct stream_out *out,
audio_extn_param_id param_id,
audio_extn_param_payload *payload)
{
int ret = -EINVAL, i;
struct stream_out *new_out = NULL;
struct qaf_module *qaf_mod = get_qaf_module_for_input_stream(out);
if (!out || !qaf_mod || !payload) {
ERROR_MSG("Invalid Param");
return ret;
}
if (!p_qaf->hdmi_connect) {
ERROR_MSG("hdmi not connected");
return ret;
}
/* get session which is routed to hdmi*/
if (p_qaf->passthrough_out)
new_out = p_qaf->passthrough_out;
else {
for (i = 0; i < MAX_QAF_MODULE_OUT; i++) {
if (qaf_mod->stream_out[i]) {
new_out = qaf_mod->stream_out[i];
break;
}
}
}
if (!new_out) {
ERROR_MSG("No stream active.");
return ret;
}
if (new_out->standby)
new_out->stream.write((struct audio_stream_out *)new_out, NULL, 0);
lock_output_stream(new_out);
ret = audio_extn_out_get_param_data(new_out, param_id, payload);
if (ret)
ERROR_MSG("audio_extn_out_get_param_data error %d", ret);
unlock_output_stream(new_out);
return ret;
}
/* To open a stream with QAF. */
int audio_extn_qaf_open_output_stream(struct audio_hw_device *dev,
audio_io_handle_t handle,
audio_devices_t devices,
audio_output_flags_t flags,
struct audio_config *config,
struct audio_stream_out **stream_out,
const char *address)
{
int ret = 0;
struct stream_out *out;
ret = adev_open_output_stream(dev, handle, devices, flags, config, stream_out, address);
if (*stream_out == NULL) {
ERROR_MSG("Stream open failed %d", ret);
return ret;
}
#ifndef LINUX_ENABLED
//Bypass QAF for dummy PCM session opened by APM during boot time
if(flags == 0) {
ALOGD("bypassing QAF for flags is equal to none");
return ret;
}
#endif
out = (struct stream_out *)*stream_out;
ret = qaf_stream_open(out, config, flags, devices);
if (ret < 0) {
ERROR_MSG("Error opening QAF stream err[%d]! QAF bypassed.", ret);
//Stream not supported by QAF, Bypass QAF.
return 0;
}
/* Override function pointers based on qaf definitions */
out->stream.set_volume = qaf_out_set_volume;
out->stream.pause = qaf_out_pause;
out->stream.resume = qaf_out_resume;
out->stream.drain = qaf_out_drain;
out->stream.flush = qaf_out_flush;
out->stream.common.standby = qaf_out_standby;
out->stream.common.set_parameters = qaf_out_set_parameters;
out->stream.get_latency = qaf_out_get_latency;
out->stream.get_render_position = qaf_out_get_render_position;
out->stream.write = qaf_out_write;
out->stream.get_presentation_position = qaf_out_get_presentation_position;
out->platform_latency = 0;
/*TODO: Need to handle this for DTS*/
if (out->usecase == USECASE_AUDIO_PLAYBACK_LOW_LATENCY) {
out->usecase = USECASE_AUDIO_PLAYBACK_DEEP_BUFFER;
out->config.period_size = QAF_DEEP_BUFFER_OUTPUT_PERIOD_SIZE;
out->config.period_count = DEEP_BUFFER_OUTPUT_PERIOD_COUNT;
out->config.start_threshold = QAF_DEEP_BUFFER_OUTPUT_PERIOD_SIZE / 4;
out->config.avail_min = QAF_DEEP_BUFFER_OUTPUT_PERIOD_SIZE / 4;
} else if(out->flags == AUDIO_OUTPUT_FLAG_DIRECT) {
out->compr_config.fragment_size = qaf_get_pcm_offload_input_buffer_size(&(config->offload_info));
}
*stream_out = &out->stream;
if (out->flags & AUDIO_OUTPUT_FLAG_COMPRESS_OFFLOAD) {
qaf_create_offload_callback_thread(out);
}
DEBUG_MSG("Exit");
return 0;
}
/* Close a QAF stream. */
void audio_extn_qaf_close_output_stream(struct audio_hw_device *dev,
struct audio_stream_out *stream)
{
struct stream_out *out = (struct stream_out *)stream;
struct qaf_module* qaf_mod = get_qaf_module_for_input_stream(out);
if (!qaf_mod) {
DEBUG_MSG("qaf module is NULL, bypassing qaf on close output stream");
/*closing non-MS12/default output stream opened with qaf */
adev_close_output_stream(dev, stream);
return;
}
DEBUG_MSG("stream_handle(%p) format = %x", out, out->format);
//If close is received for QAF passthrough stream then close the QAF passthrough output.
if (p_qaf->passthrough_in == out) {
if (p_qaf->passthrough_out) {
ALOGD("%s %d closing stream handle %p", __func__, __LINE__, p_qaf->passthrough_out);
pthread_mutex_lock(&p_qaf->lock);
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->passthrough_out));
pthread_mutex_unlock(&p_qaf->lock);
p_qaf->passthrough_out = NULL;
}
p_qaf->passthrough_in = NULL;
}
if (out->flags & AUDIO_OUTPUT_FLAG_COMPRESS_OFFLOAD) {
qaf_destroy_offload_callback_thread(out);
}
qaf_stream_close(out);
adev_close_output_stream(dev, stream);
DEBUG_MSG("Exit");
}
/* Check if QAF is supported or not. */
bool audio_extn_qaf_is_enabled()
{
bool prop_enabled = false;
char value[PROPERTY_VALUE_MAX] = {0};
property_get("vendor.audio.qaf.enabled", value, NULL);
prop_enabled = atoi(value) || !strncmp("true", value, 4);
return (prop_enabled);
}
void set_bt_configuration_to_module()
{
if (!p_qaf) {
return;
}
if (!p_qaf->bt_connect) {
DEBUG_MSG("BT is not connected.");
return;
}
struct str_parms *qaf_params;
char *format_params = NULL;
qaf_params = str_parms_create();
if (qaf_params) {
//ms12 wrapper don't support bt, treat this as speaker and routign to bt
//will take care as a part of data callback notifier
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_SPEAKER);
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_PCM);
format_params = str_parms_to_str(qaf_params);
if (p_qaf->qaf_mod[MS12].session_handle && p_qaf->qaf_mod[MS12].qaf_audio_session_set_param) {
ALOGE(" Configuring BT/speaker for MS12 wrapper");
p_qaf->qaf_mod[MS12].qaf_audio_session_set_param(p_qaf->qaf_mod[MS12].session_handle,
format_params);
}
if (p_qaf->qaf_mod[DTS_M8].session_handle
&& p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param) {
ALOGE(" Configuring BT/speaker for MS12 wrapper");
p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param(p_qaf->qaf_mod[DTS_M8].session_handle,
format_params);
}
}
str_parms_destroy(qaf_params);
}
/* Query HDMI EDID and sets module output accordingly.*/
void set_hdmi_configuration_to_module()
{
int channels = 0;
char *format_params;
struct str_parms *qaf_params;
char prop_value[PROPERTY_VALUE_MAX];
bool passth_support = false;
DEBUG_MSG("Entry");
if (!p_qaf) {
return;
}
if (!p_qaf->hdmi_connect) {
DEBUG_MSG("HDMI is not connected.");
return;
}
p_qaf->hdmi_sink_channels = 0;
//QAF re-encoding and DSP offload passthrough is supported.
if (property_get_bool("vendor.audio.offload.passthrough", false)
&& property_get_bool("vendor.audio.qaf.reencode", false)) {
//If MS12 session is active.
if (p_qaf->qaf_mod[MS12].session_handle && p_qaf->qaf_mod[MS12].qaf_audio_session_set_param) {
bool do_setparam = false;
qaf_params = str_parms_create();
property_get("vendor.audio.qaf.hdmi.out", prop_value, NULL);
if (platform_is_edid_supported_format(p_qaf->adev->platform, AUDIO_FORMAT_E_AC3)
&& (strncmp(prop_value, "ddp", 3) == 0)) {
do_setparam = true;
if (qaf_params) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_REENCODE_EAC3);
}
} else if (platform_is_edid_supported_format(p_qaf->adev->platform, AUDIO_FORMAT_AC3)) {
do_setparam = true;
if (qaf_params) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_REENCODE_AC3);
}
}
if (do_setparam) {
if (p_qaf->qaf_msmd_enabled) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI_AND_SPK); //TODO: Need enhancement.
} else {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI);
}
format_params = str_parms_to_str(qaf_params);
p_qaf->qaf_mod[MS12].qaf_audio_session_set_param(p_qaf->qaf_mod[MS12].session_handle,
format_params);
passth_support = true;
}
str_parms_destroy(qaf_params);
}
//DTS_M8 session is active.
if (p_qaf->qaf_mod[DTS_M8].session_handle
&& p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param) {
bool do_setparam = false;
qaf_params = str_parms_create();
if (platform_is_edid_supported_format(p_qaf->adev->platform, AUDIO_FORMAT_DTS)) {
do_setparam = true;
if (qaf_params) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_REENCODE_DTS);
}
}
if (do_setparam) {
if (p_qaf->qaf_msmd_enabled) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI_AND_SPK); //TODO: Need enhancement.
} else {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI);
}
format_params = str_parms_to_str(qaf_params);
p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param(p_qaf->qaf_mod[DTS_M8].session_handle,
format_params);
passth_support = true;
}
str_parms_destroy(qaf_params);
}
}
//Compressed passthrough is not enabled.
if (!passth_support) {
channels = platform_edid_get_max_channels(p_qaf->adev->platform);
qaf_params = str_parms_create();
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_PCM);
switch (channels) {
case 8:
DEBUG_MSG("Switching Qaf output to 7.1 channels");
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_CHANNELS,
AUDIO_QAF_PARAMETER_VALUE_8_CHANNELS);
if (p_qaf->qaf_msmd_enabled) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI_AND_SPK);
} else {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI);
}
p_qaf->hdmi_sink_channels = channels;
break;
case 6:
DEBUG_MSG("Switching Qaf output to 5.1 channels");
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_CHANNELS,
AUDIO_QAF_PARAMETER_VALUE_6_CHANNELS);
if (p_qaf->qaf_msmd_enabled) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI_AND_SPK);
} else {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI);
}
p_qaf->hdmi_sink_channels = channels;
break;
default:
DEBUG_MSG("Switching Qaf output to default channels");
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_CHANNELS,
AUDIO_QAF_PARAMETER_VALUE_DEFAULT_CHANNELS);
if (p_qaf->qaf_msmd_enabled) {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_HDMI_AND_SPK);
} else {
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_SPEAKER);
}
p_qaf->hdmi_sink_channels = 2;
break;
}
format_params = str_parms_to_str(qaf_params);
if (p_qaf->qaf_mod[MS12].session_handle && p_qaf->qaf_mod[MS12].qaf_audio_session_set_param) {
p_qaf->qaf_mod[MS12].qaf_audio_session_set_param(p_qaf->qaf_mod[MS12].session_handle,
format_params);
}
if (p_qaf->qaf_mod[DTS_M8].session_handle
&& p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param) {
p_qaf->qaf_mod[DTS_M8].qaf_audio_session_set_param(p_qaf->qaf_mod[DTS_M8].session_handle,
format_params);
}
str_parms_destroy(qaf_params);
}
DEBUG_MSG("Exit");
}
/* QAF set parameter function. For Device connect and disconnect. */
int audio_extn_qaf_set_parameters(struct audio_device *adev, struct str_parms *parms)
{
int status = 0, val = 0, k;
char *format_params, *kv_parirs;
struct str_parms *qaf_params;
DEBUG_MSG("Entry");
if (!p_qaf) {
return -EINVAL;
}
status = str_parms_get_int(parms, AUDIO_PARAMETER_DEVICE_CONNECT, &val);
if ((status >= 0) && audio_is_output_device(val)) {
if (val & AUDIO_DEVICE_OUT_AUX_DIGITAL) { //HDMI is connected.
p_qaf->hdmi_connect = 1;
p_qaf->hdmi_sink_channels = 0;
if (p_qaf->passthrough_in) { //If QAF passthrough is already initialized.
lock_output_stream(p_qaf->passthrough_in);
if (platform_is_edid_supported_format(adev->platform,
p_qaf->passthrough_in->format)) {
//If passthrough format is supported by HDMI then create the QAF passthrough output if not created already.
create_qaf_passthrough_stream();
//Ignoring the returned error, If error then QAF passthrough is disabled.
} else {
//If passthrough format is not supported by HDMI then close the QAF passthrough output if already created.
close_qaf_passthrough_stream();
}
unlock_output_stream(p_qaf->passthrough_in);
}
set_hdmi_configuration_to_module();
} else if (val & AUDIO_DEVICE_OUT_BLUETOOTH_A2DP) {
p_qaf->bt_connect = 1;
set_bt_configuration_to_module();
#ifndef SPLIT_A2DP_ENABLED
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (!p_qaf->qaf_mod[k].bt_hdl) {
DEBUG_MSG("Opening a2dp output...");
status = audio_extn_bt_hal_load(&p_qaf->qaf_mod[k].bt_hdl);
if (status != 0) {
ERROR_MSG("Error opening BT module");
return status;
}
}
}
#endif
}
//TODO else if: Need to consider other devices.
}
status = str_parms_get_int(parms, AUDIO_PARAMETER_DEVICE_DISCONNECT, &val);
if ((status >= 0) && audio_is_output_device(val)) {
if (val & AUDIO_DEVICE_OUT_AUX_DIGITAL) { //HDMI is disconnected.
qaf_params = str_parms_create();
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_DEVICE,
AUDIO_QAF_PARAMETER_VALUE_DEVICE_SPEAKER);
str_parms_add_str(qaf_params,
AUDIO_QAF_PARAMETER_KEY_RENDER_FORMAT,
AUDIO_QAF_PARAMETER_VALUE_PCM);
p_qaf->hdmi_sink_channels = 0;
p_qaf->passthrough_enabled = 0;
p_qaf->mch_pcm_hdmi_enabled = 0;
p_qaf->hdmi_connect = 0;
format_params = str_parms_to_str(qaf_params);
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (p_qaf->qaf_mod[k].session_handle
&& p_qaf->qaf_mod[k].qaf_audio_session_set_param) {
p_qaf->qaf_mod[k].qaf_audio_session_set_param(
p_qaf->qaf_mod[k].session_handle, format_params);
}
}
close_all_hdmi_output();
str_parms_destroy(qaf_params);
close_qaf_passthrough_stream();
} else if (val & AUDIO_DEVICE_OUT_BLUETOOTH_A2DP) {
p_qaf->bt_connect = 0;
//reconfig HDMI as end device (if connected)
if(p_qaf->hdmi_connect)
set_hdmi_configuration_to_module();
#ifndef SPLIT_A2DP_ENABLED
DEBUG_MSG("Closing a2dp output...");
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (p_qaf->qaf_mod[k].bt_hdl) {
audio_extn_bt_hal_unload(p_qaf->qaf_mod[k].bt_hdl);
p_qaf->qaf_mod[k].bt_hdl = NULL;
}
}
#endif
}
//TODO else if: Need to consider other devices.
}
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
kv_parirs = str_parms_to_str(parms);
if (p_qaf->qaf_mod[k].session_handle && p_qaf->qaf_mod[k].qaf_audio_session_set_param) {
p_qaf->qaf_mod[k].qaf_audio_session_set_param(
p_qaf->qaf_mod[k].session_handle, kv_parirs);
}
}
DEBUG_MSG("Exit");
return status;
}
/* Create the QAF. */
int audio_extn_qaf_init(struct audio_device *adev)
{
DEBUG_MSG("Entry");
p_qaf = calloc(1, sizeof(struct qaf));
if (p_qaf == NULL) {
ERROR_MSG("Out of memory");
return -ENOMEM;
}
p_qaf->adev = adev;
if (property_get_bool("vendor.audio.qaf.msmd", false)) {
p_qaf->qaf_msmd_enabled = 1;
}
pthread_mutex_init(&p_qaf->lock, (const pthread_mutexattr_t *) NULL);
int i = 0;
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
char value[PROPERTY_VALUE_MAX] = {0};
char lib_name[PROPERTY_VALUE_MAX] = {0};
struct qaf_module *qaf_mod = &(p_qaf->qaf_mod[i]);
if (i == MS12) {
property_get("vendor.audio.qaf.library", value, NULL);
snprintf(lib_name, PROPERTY_VALUE_MAX, "%s", value);
#ifdef AUDIO_EXTN_IP_HDLR_ENABLED
{
int ret = 0;
ret = audio_extn_ip_hdlr_intf_init(&qaf_mod->ip_hdlr_hdl, lib_name, &qaf_mod->qaf_lib,
adev, USECASE_AUDIO_PLAYBACK_OFFLOAD);
if (ret < 0) {
ERROR_MSG("audio_extn_ip_hdlr_intf_init failed, ret = %d", ret);
continue;
}
if (qaf_mod->qaf_lib == NULL) {
ERROR_MSG("failed to get library handle");
continue;
}
}
#else
qaf_mod->qaf_lib = dlopen(lib_name, RTLD_NOW);
if (qaf_mod->qaf_lib == NULL) {
ERROR_MSG("DLOPEN failed for %s", lib_name);
continue;
}
DEBUG_MSG("DLOPEN successful for %s", lib_name);
#endif
} else if (i == DTS_M8) {
property_get("vendor.audio.qaf.m8.library", value, NULL);
snprintf(lib_name, PROPERTY_VALUE_MAX, "%s", value);
qaf_mod->qaf_lib = dlopen(lib_name, RTLD_NOW);
if (qaf_mod->qaf_lib == NULL) {
ERROR_MSG("DLOPEN failed for %s", lib_name);
continue;
}
DEBUG_MSG("DLOPEN successful for %s", lib_name);
} else {
continue;
}
qaf_mod->qaf_audio_session_open =
(int (*)(audio_session_handle_t* session_handle, audio_session_type_t s_type,
void *p_data, void* license_data))dlsym(qaf_mod->qaf_lib,
"audio_session_open");
qaf_mod->qaf_audio_session_close =
(int (*)(audio_session_handle_t session_handle))dlsym(qaf_mod->qaf_lib,
"audio_session_close");
qaf_mod->qaf_audio_stream_open =
(int (*)(audio_session_handle_t session_handle, audio_stream_handle_t* stream_handle,
audio_stream_config_t input_config, audio_devices_t devices, stream_type_t flags))dlsym(qaf_mod->qaf_lib,
"audio_stream_open");
qaf_mod->qaf_audio_stream_close =
(int (*)(audio_stream_handle_t stream_handle))dlsym(qaf_mod->qaf_lib,
"audio_stream_close");
qaf_mod->qaf_audio_stream_set_param =
(int (*)(audio_stream_handle_t stream_handle, const char* kv_pairs))dlsym(qaf_mod->qaf_lib,
"audio_stream_set_param");
qaf_mod->qaf_audio_session_set_param =
(int (*)(audio_session_handle_t handle, const char* kv_pairs))dlsym(qaf_mod->qaf_lib,
"audio_session_set_param");
qaf_mod->qaf_audio_stream_get_param =
(char* (*)(audio_stream_handle_t stream_handle, const char* key))dlsym(qaf_mod->qaf_lib,
"audio_stream_get_param");
qaf_mod->qaf_audio_session_get_param =
(char* (*)(audio_session_handle_t handle, const char* key))dlsym(qaf_mod->qaf_lib,
"audio_session_get_param");
qaf_mod->qaf_audio_stream_start =
(int (*)(audio_stream_handle_t stream_handle))dlsym(qaf_mod->qaf_lib,
"audio_stream_start");
qaf_mod->qaf_audio_stream_stop =
(int (*)(audio_stream_handle_t stream_handle))dlsym(qaf_mod->qaf_lib,
"audio_stream_stop");
qaf_mod->qaf_audio_stream_pause =
(int (*)(audio_stream_handle_t stream_handle))dlsym(qaf_mod->qaf_lib,
"audio_stream_pause");
qaf_mod->qaf_audio_stream_flush =
(int (*)(audio_stream_handle_t stream_handle))dlsym(qaf_mod->qaf_lib,
"audio_stream_flush");
qaf_mod->qaf_audio_stream_write =
(int (*)(audio_stream_handle_t stream_handle, const void* buf, int size))dlsym(qaf_mod->qaf_lib,
"audio_stream_write");
qaf_mod->qaf_register_event_callback =
(void (*)(audio_session_handle_t session_handle, void *priv_data, notify_event_callback_t event_callback,
audio_event_id_t event_id))dlsym(qaf_mod->qaf_lib,
"register_event_callback");
}
DEBUG_MSG("Exit");
return 0;
}
/* Tear down the qaf extension. */
void audio_extn_qaf_deinit()
{
int i;
DEBUG_MSG("Entry");
if (p_qaf != NULL) {
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
qaf_session_close(&p_qaf->qaf_mod[i]);
if (p_qaf->qaf_mod[i].qaf_lib != NULL) {
if (i == MS12) {
#ifdef AUDIO_EXTN_IP_HDLR_ENABLED
audio_extn_ip_hdlr_intf_deinit(p_qaf->qaf_mod[i].ip_hdlr_hdl);
#else
dlclose(p_qaf->qaf_mod[i].qaf_lib);
#endif
p_qaf->qaf_mod[i].qaf_lib = NULL;
} else {
dlclose(p_qaf->qaf_mod[i].qaf_lib);
p_qaf->qaf_mod[i].qaf_lib = NULL;
}
}
}
if (p_qaf->passthrough_out) {
adev_close_output_stream((struct audio_hw_device *)p_qaf->adev,
(struct audio_stream_out *)(p_qaf->passthrough_out));
p_qaf->passthrough_out = NULL;
}
pthread_mutex_destroy(&p_qaf->lock);
free(p_qaf);
p_qaf = NULL;
}
DEBUG_MSG("Exit");
}
Reference in New Issue View Git Blame Copy Permalink