blob: 062573729b9eadd92c96d9ba350d1b6cd2287f89 [file] [log] [blame]
/*
* Copyright (c) 2016-2019, 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_qap"
#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,...) ALOGE("%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 QAP_DEFAULT_COMPR_AUDIO_HANDLE 1001
#define QAP_DEFAULT_COMPR_PASSTHROUGH_HANDLE 1002
#define QAP_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 QAP_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
/******************************************************************/
/*
* QAP Latency to process buffers since out_write from primary HAL
*/
#define QAP_COMPRESS_OFFLOAD_PROCESSING_LATENCY 18
#define QAP_PCM_OFFLOAD_PROCESSING_LATENCY 48
//TODO: Need to handle for DTS
#define QAP_DEEP_BUFFER_OUTPUT_PERIOD_SIZE 1536
#include <stdlib.h>
#include <pthread.h>
#include <errno.h>
#include <dlfcn.h>
#include <unistd.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 <qap_api.h>
#include "sound/compress_params.h"
#include "ip_hdlr_intf.h"
#include "dolby_ms12.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 QAP_OUTPUT_SAMPLING_RATE 48000
#ifdef QAP_DUMP_ENABLED
FILE *fp_output_writer_hdmi = NULL;
#endif
//Types of MM module, currently supported by QAP.
typedef enum {
MS12,
DTS_M8,
MAX_MM_MODULE_TYPE,
INVALID_MM_MODULE
} mm_module_type;
typedef enum {
QAP_OUT_TRANSCODE_PASSTHROUGH = 0, /* Transcode passthrough via MM module*/
QAP_OUT_OFFLOAD_MCH, /* Multi-channel PCM offload*/
QAP_OUT_OFFLOAD, /* PCM offload */
MAX_QAP_MODULE_OUT
} mm_module_output_type;
typedef enum {
QAP_IN_MAIN = 0, /* Single PID Main/Primary or Dual-PID stream */
QAP_IN_ASSOC, /* Associated/Secondary stream */
QAP_IN_PCM, /* PCM stream. */
QAP_IN_MAIN_2, /* Single PID Main2 stream */
MAX_QAP_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
} qap_stream_state;
struct qap_module {
audio_session_handle_t session_handle;
void *qap_lib;
void *qap_handle;
/*Input stream of MM module */
struct stream_out *stream_in[MAX_QAP_MODULE_IN];
/*Output Stream from MM module */
struct stream_out *stream_out[MAX_QAP_MODULE_OUT];
/*Media format associated with each output id raised by mm module. */
qap_session_outputs_config_t session_outputs_config;
/*Flag is set if media format is changed for an mm module output. */
bool is_media_fmt_changed[MAX_QAP_MODULE_OUT];
/*Index to be updated in session_outputs_config array for a new mm module output. */
int new_out_format_index;
//BT session handle.
void *bt_hdl;
float vol_left;
float vol_right;
bool is_vol_set;
qap_stream_state stream_state[MAX_QAP_MODULE_IN];
bool is_session_closing;
bool is_session_output_active;
pthread_cond_t session_output_cond;
pthread_mutex_t session_output_lock;
};
struct qap {
struct audio_device *adev;
pthread_mutex_t lock;
bool bt_connect;
bool hdmi_connect;
int hdmi_sink_channels;
//Flag to indicate if QAP transcode output stream is enabled from any mm module.
bool passthrough_enabled;
//Flag to indicate if QAP mch pcm output stream is enabled from any mm module.
bool mch_pcm_hdmi_enabled;
//Flag to indicate if msmd is supported.
bool qap_msmd_enabled;
bool qap_output_block_handling;
//Handle of QAP input stream, which is routed as QAP passthrough.
struct stream_out *passthrough_in;
//Handle of QAP passthrough stream.
struct stream_out *passthrough_out;
struct qap_module qap_mod[MAX_MM_MODULE_TYPE];
};
//Global handle of QAP. Access to this should be protected by mutex lock.
static struct qap *p_qap = NULL;
/* Gets the pointer to qap module for the qap input stream. */
static struct qap_module* get_qap_module_for_input_stream_l(struct stream_out *out)
{
struct qap_module *qap_mod = NULL;
int i, j;
if (!p_qap) return NULL;
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
for (j = 0; j < MAX_QAP_MODULE_IN; j++) {
if (p_qap->qap_mod[i].stream_in[j] == out) {
qap_mod = &(p_qap->qap_mod[i]);
break;
}
}
}
return qap_mod;
}
/* Finds the mm module input stream index for the QAP input stream. */
static int get_input_stream_index_l(struct stream_out *out)
{
int index = -1, j;
struct qap_module* qap_mod = NULL;
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod) return index;
for (j = 0; j < MAX_QAP_MODULE_IN; j++) {
if (qap_mod->stream_in[j] == out) {
index = j;
break;
}
}
return index;
}
static void set_stream_state_l(struct stream_out *out, int state)
{
struct qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
int index = get_input_stream_index_l(out);
if (qap_mod && index >= 0) qap_mod->stream_state[index] = state;
}
static bool check_stream_state_l(struct stream_out *out, int state)
{
struct qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
int index = get_input_stream_index_l(out);
if (qap_mod && index >= 0) return ((int)qap_mod->stream_state[index] == state);
return false;
}
/* Finds the right mm module for the QAP input stream format. */
static mm_module_type get_mm_module_for_format_l(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.qap.dts_m8", false)) { //TODO: Need to add this property for DTS.
return MS12;
}
//If QAP passthrough is active then send the PCM stream to primary HAL.
if (!p_qap->passthrough_out) {
/* Iff any stream is active in MS12 module then route PCM stream to it. */
for (j = 0; j < MAX_QAP_MODULE_IN; j++) {
if (p_qap->qap_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_l(struct qap_module* qap_mod)
{
return (qap_mod->stream_in[QAP_IN_MAIN] || qap_mod->stream_in[QAP_IN_MAIN_2]);
}
static bool is_dual_main_active_l(struct qap_module* qap_mod)
{
return (qap_mod->stream_in[QAP_IN_MAIN] && qap_mod->stream_in[QAP_IN_MAIN_2]);
}
//Checks if any main or pcm stream is running in the session.
static bool is_any_stream_running_l(struct qap_module* qap_mod)
{
//Not checking associated stream.
struct stream_out *out = qap_mod->stream_in[QAP_IN_MAIN];
struct stream_out *out_pcm = qap_mod->stream_in[QAP_IN_PCM];
struct stream_out *out_main2 = qap_mod->stream_in[QAP_IN_MAIN_2];
if ((out == NULL || (out != NULL && check_stream_state_l(out, STOPPED)))
&& (out_main2 == NULL || (out_main2 != NULL && check_stream_state_l(out_main2, STOPPED)))
&& (out_pcm == NULL || (out_pcm != NULL && check_stream_state_l(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_l(struct qap_module *qap_mod)
{
uint32_t pcm_output_buffer_size = 0;
if (qap_mod == &p_qap->qap_mod[MS12]) {
pcm_output_buffer_size = MS12_PCM_OUT_FRAGMENT_SIZE;
} else if (qap_mod == &p_qap->qap_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_l(
struct qap_module* qap_mod,
uint32_t output_id)
{
int i;
for (i = 0; i < MAX_SUPPORTED_OUTPUTS; i++) {
if (qap_mod->session_outputs_config.output_config[i].id == output_id) {
return i;
}
}
return -1;
}
/* Acquire Mutex lock on output stream */
static void lock_output_stream_l(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_l(struct stream_out *out)
{
pthread_mutex_unlock(&out->lock);
}
/* Checks if stream can be routed as QAP passthrough or not. */
static bool audio_extn_qap_passthrough_enabled(struct stream_out *out)
{
DEBUG_MSG("Format 0x%x", out->format);
bool is_enabled = false;
if (!p_qap) return false;
if ((!property_get_bool("vendor.audio.qap.reencode", false))
&& property_get_bool("vendor.audio.qap.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 QAP. */
static void close_all_pcm_hdmi_output_l()
{
int i;
//Closing all the PCM HDMI output stream from QAP.
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
if (p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD_MCH]) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD_MCH]));
p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD_MCH] = NULL;
}
if ((p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD])
&& (p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD]->devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD]));
p_qap->qap_mod[i].stream_out[QAP_OUT_OFFLOAD] = NULL;
}
}
p_qap->mch_pcm_hdmi_enabled = 0;
}
static void close_all_hdmi_output_l()
{
int k;
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (p_qap->qap_mod[k].stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->qap_mod[k].stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]));
p_qap->qap_mod[k].stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH] = NULL;
}
}
p_qap->passthrough_enabled = 0;
close_all_pcm_hdmi_output_l();
}
static int qap_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 QAP passthrough output stream. */
static int create_qap_passthrough_stream_l()
{
DEBUG_MSG("Entry");
int ret = 0;
struct stream_out *out = p_qap->passthrough_in;
if (!out) return -EINVAL;
pthread_mutex_lock(&p_qap->lock);
lock_output_stream_l(out);
//Creating QAP passthrough output stream.
if (NULL == p_qap->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 QAP passthrough input stream.
devices = out->devices;
flags = out->flags;
ret = adev_open_output_stream((struct audio_hw_device *)p_qap->adev,
QAP_DEFAULT_PASSTHROUGH_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(p_qap->passthrough_out),
NULL);
if (ret < 0) {
ERROR_MSG("adev_open_output_stream failed with ret = %d!", ret);
unlock_output_stream_l(out);
return ret;
}
p_qap->passthrough_in = out;
p_qap->passthrough_out->stream.set_callback((struct audio_stream_out *)p_qap->passthrough_out,
(stream_callback_t) qap_out_callback, out);
}
unlock_output_stream_l(out);
//Since QAP-Passthrough is created, close other HDMI outputs.
close_all_hdmi_output_l();
pthread_mutex_unlock(&p_qap->lock);
return ret;
}
/* Stops a QAP module stream.*/
static int audio_extn_qap_stream_stop(struct stream_out *out)
{
int ret = 0;
DEBUG_MSG("Output Stream 0x%x", (int)out);
if (!check_stream_state_l(out, RUN)) return ret;
struct qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod || !qap_mod->session_handle|| !out->qap_stream_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p) strm hndl(%p)",
qap_mod, qap_mod->session_handle, out->qap_stream_handle);
return -EINVAL;
}
ret = qap_module_cmd(out->qap_stream_handle,
QAP_MODULE_CMD_STOP,
sizeof(QAP_MODULE_CMD_STOP),
NULL,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("stop failed %d", ret);
return -EINVAL;
}
return ret;
}
static int qap_out_drain(struct audio_stream_out* stream, audio_drain_type_t type)
{
struct stream_out *out = (struct stream_out *)stream;
int status = 0;
struct qap_module *qap_mod = NULL;
qap_mod = get_qap_module_for_input_stream_l(out);
DEBUG_MSG("Output Stream %p", out);
lock_output_stream_l(out);
//If QAP passthrough is enabled then block the drain on module stream.
if (p_qap->passthrough_out) {
pthread_mutex_lock(&p_qap->lock);
//If drain is received for QAP passthorugh stream then call the primary HAL api.
if (p_qap->passthrough_in == out) {
status = p_qap->passthrough_out->stream.drain(
(struct audio_stream_out *)p_qap->passthrough_out, type);
}
pthread_mutex_unlock(&p_qap->lock);
} else if (!is_any_stream_running_l(qap_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_l(out, STOPPED);
} else {
qap_audio_buffer_t *buffer;
buffer = (qap_audio_buffer_t *) calloc(1, sizeof(qap_audio_buffer_t));
buffer->common_params.offset = 0;
buffer->common_params.data = buffer;
buffer->common_params.size = 0;
buffer->buffer_parms.input_buf_params.flags = QAP_BUFFER_EOS;
DEBUG_MSG("Queing EOS buffer %p flags %d size %d", buffer, buffer->buffer_parms.input_buf_params.flags, buffer->common_params.size);
status = qap_module_process(out->qap_stream_handle, buffer);
if (QAP_STATUS_OK != status) {
ERROR_MSG("EOS buffer queing failed%d", status);
return -EINVAL;
}
//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_qap_stream_stop(out);
if (status == 0) {
//Setting state to stopping as client is expecting drain_ready event.
set_stream_state_l(out, STOPPING);
}
}
unlock_output_stream_l(out);
return status;
}
/* Flush the QAP module input stream. */
static int audio_extn_qap_stream_flush(struct stream_out *out)
{
DEBUG_MSG("Output Stream %p", out);
int ret = -EINVAL;
struct qap_module *qap_mod = NULL;
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod || !qap_mod->session_handle|| !out->qap_stream_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p) strm hndl(%p)",
qap_mod, qap_mod->session_handle, out->qap_stream_handle);
return -EINVAL;
}
ret = qap_module_cmd(out->qap_stream_handle,
QAP_MODULE_CMD_FLUSH,
sizeof(QAP_MODULE_CMD_FLUSH),
NULL,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("flush failed %d", ret);
return -EINVAL;
}
return ret;
}
/* Pause the QAP module input stream. */
static int qap_stream_pause_l(struct stream_out *out)
{
struct qap_module *qap_mod = NULL;
int ret = -EINVAL;
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod || !qap_mod->session_handle|| !out->qap_stream_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p) strm hndl(%p)",
qap_mod, qap_mod->session_handle, out->qap_stream_handle);
return -EINVAL;
}
ret = qap_module_cmd(out->qap_stream_handle,
QAP_MODULE_CMD_PAUSE,
sizeof(QAP_MODULE_CMD_PAUSE),
NULL,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("pause failed %d", ret);
return -EINVAL;
}
return ret;
}
/* Flush the QAP input stream. */
static int qap_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_l(out);
if (!out->standby) {
//If QAP passthrough is active then block the flush on module input streams.
if (p_qap->passthrough_out) {
pthread_mutex_lock(&p_qap->lock);
//If flush is received for the QAP passthrough stream then call the primary HAL api.
if (p_qap->passthrough_in == out) {
status = p_qap->passthrough_out->stream.flush(
(struct audio_stream_out *)p_qap->passthrough_out);
out->offload_state = OFFLOAD_STATE_IDLE;
}
pthread_mutex_unlock(&p_qap->lock);
} else {
//Flush the module input stream.
status = audio_extn_qap_stream_flush(out);
}
}
unlock_output_stream_l(out);
DEBUG_MSG("Exit");
return status;
}
/* Pause a QAP input stream. */
static int qap_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_l(out);
//If QAP passthrough is enabled then block the pause on module stream.
if (p_qap->passthrough_out) {
pthread_mutex_lock(&p_qap->lock);
//If pause is received for QAP passthorugh stream then call the primary HAL api.
if (p_qap->passthrough_in == out) {
status = p_qap->passthrough_out->stream.pause(
(struct audio_stream_out *)p_qap->passthrough_out);
out->offload_state = OFFLOAD_STATE_PAUSED;
}
pthread_mutex_unlock(&p_qap->lock);
} else {
//Pause the module input stream.
status = qap_stream_pause_l(out);
}
unlock_output_stream_l(out);
return status;
}
static void close_qap_passthrough_stream_l()
{
if (p_qap->passthrough_out != NULL) { //QAP pasthroug is enabled. Close it.
pthread_mutex_lock(&p_qap->lock);
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->passthrough_out));
p_qap->passthrough_out = NULL;
pthread_mutex_unlock(&p_qap->lock);
if (p_qap->passthrough_in->qap_stream_handle) {
qap_out_pause((struct audio_stream_out*)p_qap->passthrough_in);
qap_out_flush((struct audio_stream_out*)p_qap->passthrough_in);
qap_out_drain((struct audio_stream_out*)p_qap->passthrough_in,
(audio_drain_type_t)STREAM_CBK_EVENT_DRAIN_READY);
}
}
}
static int qap_out_standby(struct audio_stream *stream)
{
struct stream_out *out = (struct stream_out *)stream;
struct qap_module *qap_mod = NULL;
int status = 0;
int i;
ALOGD("%s: enter: stream (%p) usecase(%d: %s)", __func__,
stream, out->usecase, use_case_table[out->usecase]);
lock_output_stream_l(out);
//If QAP passthrough is active then block standby on all the input streams of QAP mm modules.
if (p_qap->passthrough_out) {
//If standby is received on QAP passthrough stream then forward it to primary HAL.
if (p_qap->passthrough_in == out) {
status = p_qap->passthrough_out->stream.common.standby(
(struct audio_stream *)p_qap->passthrough_out);
}
} else if (check_stream_state_l(out, RUN)) {
//If QAP passthrough stream is not active then stop the QAP module stream.
status = audio_extn_qap_stream_stop(out);
if (status == 0) {
//Setting state to stopped as client not expecting drain_ready event.
set_stream_state_l(out, STOPPED);
}
if(p_qap->qap_output_block_handling) {
qap_mod = get_qap_module_for_input_stream_l(out);
for (i = 0; i < MAX_QAP_MODULE_IN; i++) {
if (qap_mod->stream_in[i] != NULL &&
check_stream_state_l(qap_mod->stream_in[i], RUN)) {
break;
}
}
if (i != MAX_QAP_MODULE_IN) {
DEBUG_MSG("[%s] stream is still active.", use_case_table[qap_mod->stream_in[i]->usecase]);
} else {
pthread_mutex_lock(&qap_mod->session_output_lock);
qap_mod->is_session_output_active = false;
pthread_mutex_unlock(&qap_mod->session_output_lock);
DEBUG_MSG(" all the input streams are either closed or stopped(standby) block the MM module output");
}
}
}
if (!out->standby) {
out->standby = true;
}
unlock_output_stream_l(out);
return status;
}
/* Sets the volume to PCM output stream. */
static int qap_out_set_volume(struct audio_stream_out *stream, float left, float right)
{
int ret = 0;
struct stream_out *out = (struct stream_out *)stream;
struct qap_module *qap_mod = NULL;
DEBUG_MSG("Left %f, Right %f", left, right);
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod) {
return -EINVAL;
}
pthread_mutex_lock(&p_qap->lock);
qap_mod->vol_left = left;
qap_mod->vol_right = right;
qap_mod->is_vol_set = true;
pthread_mutex_unlock(&p_qap->lock);
if (qap_mod->stream_out[QAP_OUT_OFFLOAD] != NULL) {
ret = qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.set_volume(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD], left, right);
}
return ret;
}
/* Starts a QAP module stream. */
static int qap_stream_start_l(struct stream_out *out)
{
int ret = 0;
struct qap_module *qap_mod = NULL;
DEBUG_MSG("Output Stream = %p", out);
qap_mod = get_qap_module_for_input_stream_l(out);
if ((!qap_mod) || (!qap_mod->session_handle)) {
ERROR_MSG("QAP mod is not inited (%p) or session is not yet opened (%p) ",
qap_mod, qap_mod->session_handle);
return -EINVAL;
}
if (out->qap_stream_handle) {
ret = qap_module_cmd(out->qap_stream_handle,
QAP_MODULE_CMD_START,
sizeof(QAP_MODULE_CMD_START),
NULL,
NULL,
NULL);
if (ret != QAP_STATUS_OK) {
ERROR_MSG("start failed");
ret = -EINVAL;
}
} else
ERROR_MSG("QAP stream not yet opened, drop this cmd");
DEBUG_MSG("exit");
return ret;
}
static int qap_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;
DEBUG_MSG("Use case out of bounds sleeping for 500ms");
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 qap_stream_start_l(out);
}
/* Sends input buffer to the QAP MM module. */
static int qap_module_write_input_buffer(struct stream_out *out, const void *buffer, int bytes)
{
int ret = -EINVAL;
struct qap_module *qap_mod = NULL;
qap_audio_buffer_t buff;
qap_mod = get_qap_module_for_input_stream_l(out);
if ((!qap_mod) || (!qap_mod->session_handle) || (!out->qap_stream_handle)) {
return ret;
}
//If data received on associated stream when all other stream are stopped then drop the data.
if (out == qap_mod->stream_in[QAP_IN_ASSOC] && !is_any_stream_running_l(qap_mod))
return bytes;
memset(&buff, 0, sizeof(buff));
buff.common_params.offset = 0;
buff.common_params.size = bytes;
buff.common_params.data = (void *) buffer;
buff.common_params.timestamp = QAP_BUFFER_NO_TSTAMP;
buff.buffer_parms.input_buf_params.flags = QAP_BUFFER_NO_TSTAMP;
DEBUG_MSG("calling module process with bytes %d %p", bytes, buffer);
ret = qap_module_process(out->qap_stream_handle, &buff);
if(ret > 0) set_stream_state_l(out, RUN);
return ret;
}
static ssize_t qap_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;
struct qap_module *qap_mod = NULL;
DEBUG_MSG_VV("bytes = %d, usecase[%s] and flags[%x] for handle[%p]",
(int)bytes, use_case_table[out->usecase], out->flags, out);
lock_output_stream_l(out);
// If QAP passthrough is active then block writing data to QAP mm module.
if (p_qap->passthrough_out) {
//If write is received for the QAP passthrough stream then send the buffer to primary HAL.
if (p_qap->passthrough_in == out) {
ret = p_qap->passthrough_out->stream.write(
(struct audio_stream_out *)(p_qap->passthrough_out),
buffer,
bytes);
if (ret > 0) out->standby = false;
}
unlock_output_stream_l(out);
return ret;
} else if (out->standby) {
pthread_mutex_lock(&adev->lock);
ret = qap_start_output_stream(out);
pthread_mutex_unlock(&adev->lock);
if (ret == 0) {
out->standby = false;
if(p_qap->qap_output_block_handling) {
qap_mod = get_qap_module_for_input_stream_l(out);
pthread_mutex_lock(&qap_mod->session_output_lock);
if (qap_mod->is_session_output_active == false) {
qap_mod->is_session_output_active = true;
pthread_cond_signal(&qap_mod->session_output_cond);
DEBUG_MSG("Wake up MM module output thread");
}
pthread_mutex_unlock(&qap_mod->session_output_lock);
}
} 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 = qap_module_write_input_buffer(out, buffer, bytes);
DEBUG_MSG_VV("Bytes consumed [%d] by MM Module", (int)ret);
if (ret >= 0) {
out->written += ret / ((popcount(out->channel_mask) * sizeof(short)));
}
exit:
unlock_output_stream_l(out);
if (ret < 0) {
if (ret == -EAGAIN) {
DEBUG_MSG_VV("No space available to consume bytes, post msg to cb thread");
bytes = 0;
} else if (ret == -ENOMEM || ret == -EPERM) {
if (out->pcm)
ERROR_MSG("error %d, %s", (int)ret, pcm_get_error(out->pcm));
qap_out_standby(&out->stream.common);
DEBUG_MSG("SLEEP for 100sec");
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 to consume all the bytes");
bytes = ret;
}
return bytes;
}
/* Gets PCM offload buffer size for a given config. */
static uint32_t qap_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("Qap PCM offload Fragment size is %d bytes", fragment_size);
return fragment_size;
}
static uint32_t qap_get_pcm_offload_input_buffer_size(audio_offload_info_t* info)
{
return qap_get_pcm_offload_buffer_size(info, MS12_PCM_IN_FRAGMENT_SIZE);
}
static uint32_t qap_get_pcm_offload_output_buffer_size(struct qap_module *qap_mod,
audio_offload_info_t* info)
{
return qap_get_pcm_offload_buffer_size(info, get_pcm_output_buffer_size_samples_l(qap_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 qap_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 qap_module *qap_mod = NULL;
DEBUG_MSG("Output Format %d", out->format);
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod || !qap_mod->session_handle|| !out->qap_stream_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p) strm hndl(%p)",
qap_mod, qap_mod->session_handle, out->qap_stream_handle);
return -EINVAL;
}
//Get MM module latency.
/* Tobeported
kvpairs = qap_mod->qap_audio_stream_get_param(out->qap_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_QAP_MODULE_OUT - 1; i >= 0; i--) {
if (qap_mod->stream_out[i] == NULL) {
continue;
} else {
unsigned int num_fragments = qap_mod->stream_out[i]->compr_config.fragments;
uint32_t fragment_size = qap_mod->stream_out[i]->compr_config.fragment_size;
uint32_t kernel_buffer_size = num_fragments * fragment_size;
get_buffer_latency(qap_mod->stream_out[i], kernel_buffer_size, &kernel_latency);
break;
}
}
//Get DSP latency
if ((qap_mod->stream_out[QAP_OUT_OFFLOAD] != NULL)
|| (qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH] != NULL)) {
unsigned int sample_rate = 0;
audio_usecase_t platform_latency = 0;
if (qap_mod->stream_out[QAP_OUT_OFFLOAD])
sample_rate = qap_mod->stream_out[QAP_OUT_OFFLOAD]->sample_rate;
else if (qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH])
sample_rate = qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->sample_rate;
if (qap_mod->stream_out[QAP_OUT_OFFLOAD])
platform_latency =
platform_render_latency(qap_mod->stream_out[QAP_OUT_OFFLOAD]->usecase);
else
platform_latency =
platform_render_latency(qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->usecase);
dsp_latency = (platform_latency * sample_rate) / 1000000LL;
} else if (qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH] != NULL) {
unsigned int sample_rate = 0;
sample_rate = qap_mod->stream_out[QAP_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(qap_mod->bt_hdl) != NULL) {
out->platform_latency = module_latency + audio_extn_bt_hal_get_latency(qap_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;
}
/* Tobeported
}
else {
kvpairs = qap_mod->qap_audio_stream_get_param(out->qap_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 qap_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 qap_module* qap_mod = NULL;
ALOGV("%s, Output Stream %p,dsp frames %d",__func__, stream, (int)dsp_frames);
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod) {
ret = out->stream.get_render_position(stream, dsp_frames);
ALOGV("%s, non qap_MOD DSP FRAMES %d",__func__, (int)dsp_frames);
return ret;
}
if (p_qap->passthrough_out) {
pthread_mutex_lock(&p_qap->lock);
ret = p_qap->passthrough_out->stream.get_render_position((struct audio_stream_out *)p_qap->passthrough_out, dsp_frames);
pthread_mutex_unlock(&p_qap->lock);
ALOGV("%s, PASS THROUGH DSP FRAMES %p",__func__, dsp_frames);
return ret;
}
frames=*dsp_frames;
ret = qap_get_rendered_frames(out, &frames);
*dsp_frames = (uint32_t)frames;
ALOGV("%s, DSP FRAMES %d",__func__, (int)dsp_frames);
return ret;
}
static int qap_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_VV("Output Stream %p", stream);
//If QAP passthorugh output stream is active.
if (p_qap->passthrough_out) {
if (p_qap->passthrough_in == out) {
//If api is called for QAP passthorugh stream then call the primary HAL api to get the position.
pthread_mutex_lock(&p_qap->lock);
ret = p_qap->passthrough_out->stream.get_presentation_position(
(struct audio_stream_out *)p_qap->passthrough_out,
frames,
timestamp);
pthread_mutex_unlock(&p_qap->lock);
} else {
//If api is called for other stream then return zero frames.
*frames = 0;
clock_gettime(CLOCK_MONOTONIC, timestamp);
}
return ret;
}
ret = qap_get_rendered_frames(out, frames);
clock_gettime(CLOCK_MONOTONIC, timestamp);
return ret;
}
static uint32_t qap_out_get_latency(const struct audio_stream_out *stream)
{
struct stream_out *out = (struct stream_out *)stream;
uint32_t latency = 0;
struct qap_module *qap_mod = NULL;
DEBUG_MSG_VV("Output Stream %p", out);
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_mod) {
return 0;
}
//If QAP passthrough is active then block the get latency on module input streams.
if (p_qap->passthrough_out) {
pthread_mutex_lock(&p_qap->lock);
//If get latency is called for the QAP passthrough stream then call the primary HAL api.
if (p_qap->passthrough_in == out) {
latency = p_qap->passthrough_out->stream.get_latency(
(struct audio_stream_out *)p_qap->passthrough_out);
}
pthread_mutex_unlock(&p_qap->lock);
} else {
if (is_offload_usecase(out->usecase)) {
latency = COMPRESS_OFFLOAD_PLAYBACK_LATENCY;
} else {
uint32_t sample_rate = 0;
latency = QAP_MODULE_PCM_INPUT_BUFFER_LATENCY; //Input latency
if (qap_mod->stream_out[QAP_OUT_OFFLOAD])
sample_rate = qap_mod->stream_out[QAP_OUT_OFFLOAD]->sample_rate;
else if (qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH])
sample_rate = qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->sample_rate;
if (sample_rate) {
latency += (get_pcm_output_buffer_size_samples_l(qap_mod) * 1000) / out->sample_rate;
}
}
if ( audio_extn_bt_hal_get_output_stream(qap_mod->bt_hdl) != NULL) {
if (is_offload_usecase(out->usecase)) {
latency = audio_extn_bt_hal_get_latency(qap_mod->bt_hdl) +
QAP_COMPRESS_OFFLOAD_PROCESSING_LATENCY;
} else {
latency = audio_extn_bt_hal_get_latency(qap_mod->bt_hdl) +
QAP_PCM_OFFLOAD_PROCESSING_LATENCY;
}
}
}
DEBUG_MSG_VV("Latency %d", latency);
return latency;
}
static bool qap_check_and_get_compressed_device_format(int device, int *format)
{
switch (device) {
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | QAP_AUDIO_FORMAT_AC3):
*format = AUDIO_FORMAT_AC3;
return true;
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | QAP_AUDIO_FORMAT_EAC3):
*format = AUDIO_FORMAT_E_AC3;
return true;
case (AUDIO_DEVICE_OUT_AUX_DIGITAL | QAP_AUDIO_FORMAT_DTS):
*format = AUDIO_FORMAT_DTS;
return true;
default:
return false;
}
}
static void set_out_stream_channel_map(struct stream_out *out, qap_output_config_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);
}
bool audio_extn_is_qap_enabled()
{
bool prop_enabled = false;
char value[PROPERTY_VALUE_MAX] = {0};
property_get("vendor.audio.qap.enabled", value, NULL);
prop_enabled = atoi(value) || !strncmp("true", value, 4);
DEBUG_MSG("%d", prop_enabled);
return (prop_enabled);
}
void static qap_close_all_output_streams(struct qap_module *qap_mod)
{
int i =0;
struct stream_out *stream_out = NULL;
DEBUG_MSG("Entry");
for (i = 0; i < MAX_QAP_MODULE_OUT; i++) {
stream_out = qap_mod->stream_out[i];
if (stream_out != NULL) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev, (struct audio_stream_out *)stream_out);
DEBUG_MSG("Closed outputenum=%d session 0x%x %s",
i, (int)stream_out, use_case_table[stream_out->usecase]);
qap_mod->stream_out[i] = NULL;
}
memset(&qap_mod->session_outputs_config.output_config[i], 0, sizeof(qap_session_outputs_config_t));
qap_mod->is_media_fmt_changed[i] = false;
}
DEBUG_MSG("exit");
}
/* Call back function for mm module. */
static void qap_session_callback(qap_session_handle_t session_handle __unused,
void *prv_data,
qap_callback_event_t event_id,
int size,
void *data)
{
/*
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 qap_module* qap_mod = (struct qap_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;
qap_output_config_t *new_conf = NULL;
qap_audio_buffer_t *buffer = (qap_audio_buffer_t *) data;
uint32_t device = 0;
if (qap_mod->is_session_closing) {
DEBUG_MSG("Dropping event as session is closing."
"Event = 0x%X, Bytes to write %d", event_id, size);
return;
}
if(p_qap->qap_output_block_handling) {
pthread_mutex_lock(&qap_mod->session_output_lock);
if (!qap_mod->is_session_output_active) {
qap_close_all_output_streams(qap_mod);
DEBUG_MSG("disabling MM module output by blocking the output thread");
pthread_cond_wait(&qap_mod->session_output_cond, &qap_mod->session_output_lock);
DEBUG_MSG("MM module output Enabled, output thread active");
}
pthread_mutex_unlock(&qap_mod->session_output_lock);
}
/* Default config initialization. */
config.sample_rate = config.offload_info.sample_rate = QAP_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;
pthread_mutex_lock(&p_qap->lock);
if (event_id == QAP_CALLBACK_EVENT_OUTPUT_CFG_CHANGE) {
new_conf = &buffer->buffer_parms.output_buf_params.output_config;
qap_output_config_t *cached_conf = NULL;
int index = -1;
DEBUG_MSG("Received QAP_CALLBACK_EVENT_OUTPUT_CFG_CHANGE event for output id=0x%x",
buffer->buffer_parms.output_buf_params.output_id);
DEBUG_MSG("sample rate=%d bitwidth=%d format = %d channels =0x%x",
new_conf->sample_rate,
new_conf->bit_width,
new_conf->format,
new_conf->channels);
if ( (uint32_t)size < sizeof(qap_output_config_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_l(qap_mod, buffer->buffer_parms.output_buf_params.output_id);
DEBUG_MSG("index = %d", index);
if (index >= 0) {
cached_conf = &qap_mod->session_outputs_config.output_config[index];
} else if (index < 0 && qap_mod->new_out_format_index < MAX_QAP_MODULE_OUT) {
index = qap_mod->new_out_format_index;
cached_conf = &qap_mod->session_outputs_config.output_config[index];
qap_mod->new_out_format_index++;
}
if (cached_conf == NULL) {
ERROR_MSG("Maximum output from a QAP module is reached. Can not process new output.");
return ;
}
if (memcmp(cached_conf, new_conf, sizeof(qap_output_config_t)) != 0) {
memcpy(cached_conf, new_conf, sizeof(qap_output_config_t));
qap_mod->is_media_fmt_changed[index] = true;
}
} else if (event_id == QAP_CALLBACK_EVENT_DATA) {
data_buffer_p = (int8_t*)buffer->common_params.data+buffer->common_params.offset;
buffer_size = buffer->common_params.size;
device = buffer->buffer_parms.output_buf_params.output_id;
DEBUG_MSG_VV("Received QAP_CALLBACK_EVENT_DATA event buff size(%d) for outputid=0x%x",
buffer_size, buffer->buffer_parms.output_buf_params.output_id);
if (buffer && buffer->common_params.data) {
int index = -1;
index = get_media_fmt_array_index_for_output_id_l(qap_mod, buffer->buffer_parms.output_buf_params.output_id);
DEBUG_MSG("index = %d", index);
if (index > -1 && qap_mod->is_media_fmt_changed[index]) {
DEBUG_MSG("FORMAT changed, recreate stream");
need_to_recreate_stream = true;
qap_mod->is_media_fmt_changed[index] = false;
qap_output_config_t *new_config = &qap_mod->session_outputs_config.output_config[index];
config.sample_rate = config.offload_info.sample_rate = new_config->sample_rate;
config.offload_info.version = AUDIO_INFO_INITIALIZER.version;
config.offload_info.size = AUDIO_INFO_INITIALIZER.size;
config.offload_info.bit_width = new_config->bit_width;
if (new_config->format == QAP_AUDIO_FORMAT_PCM_16_BIT) {
if (new_config->bit_width == 16)
config.format = config.offload_info.format = AUDIO_FORMAT_PCM_16_BIT;
else if (new_config->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;
} else if (new_config->format == QAP_AUDIO_FORMAT_AC3)
config.format = config.offload_info.format = AUDIO_FORMAT_AC3;
else if (new_config->format == QAP_AUDIO_FORMAT_EAC3)
config.format = config.offload_info.format = AUDIO_FORMAT_E_AC3;
else if (new_config->format == QAP_AUDIO_FORMAT_DTS)
config.format = config.offload_info.format = AUDIO_FORMAT_DTS;
device |= (new_config->format & AUDIO_FORMAT_MAIN_MASK);
config.channel_mask = audio_channel_out_mask_from_count(new_config->channels);
config.offload_info.channel_mask = config.channel_mask;
DEBUG_MSG("sample rate=%d bitwidth=%d format = %d channels=%d channel_mask=%d device =0x%x",
config.sample_rate,
config.offload_info.bit_width,
config.offload_info.format,
new_config->channels,
config.channel_mask,
device);
}
}
if (p_qap->passthrough_out != NULL) {
//If QAP passthrough is active then all the module output will be dropped.
pthread_mutex_unlock(&p_qap->lock);
DEBUG_MSG("QAP-PSTH is active, DROPPING DATA!");
return;
}
if (qap_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 QAP.
* 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_qap->hdmi_connect) {
DEBUG_MSG("HDMI not connected, DROPPING DATA!");
pthread_mutex_unlock(&p_qap->lock);
return;
}
//Closing all the PCM HDMI output stream from QAP.
close_all_pcm_hdmi_output_l();
/* If Media format was changed for this stream then need to re-create the stream. */
if (need_to_recreate_stream && qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]) {
DEBUG_MSG("closing Transcode Passthrough session ox%x",
(int)qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]);
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]));
qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH] = NULL;
p_qap->passthrough_enabled = false;
}
if (!p_qap->passthrough_enabled
&& !(qap_mod->stream_out[QAP_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;
DEBUG_MSG("Opening Transcode Passthrough out(outputenum=%d) session 0x%x with below params",
QAP_OUT_TRANSCODE_PASSTHROUGH,
(int)qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]);
DEBUG_MSG("sample rate=%d bitwidth=%d format = 0x%x channel mask=0x%x flags=0x%x device =0x%x",
config.sample_rate,
config.offload_info.bit_width,
config.offload_info.format,
config.offload_info.channel_mask,
flags,
devices);
ret = adev_open_output_stream((struct audio_hw_device *)p_qap->adev,
QAP_DEFAULT_COMPR_PASSTHROUGH_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]),
NULL);
if (ret < 0) {
ERROR_MSG("Failed opening Transcode Passthrough out(outputenum=%d) session 0x%x",
QAP_OUT_TRANSCODE_PASSTHROUGH,
(int)qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]);
pthread_mutex_unlock(&p_qap->lock);
return;
} else
DEBUG_MSG("Opened Transcode Passthrough out(outputenum=%d) session 0x%x",
QAP_OUT_TRANSCODE_PASSTHROUGH,
(int)qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]);
if (format == AUDIO_FORMAT_E_AC3) {
qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]->compr_config.fragment_size =
COMPRESS_PASSTHROUGH_DDP_FRAGMENT_SIZE;
}
qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
p_qap->passthrough_enabled = true;
}
if (qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]) {
DEBUG_MSG_VV("Writing Bytes(%d) to QAP_OUT_TRANSCODE_PASSTHROUGH output(%p) buff ptr(%p)",
buffer_size, qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH],
data_buffer_p);
ret = qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH]->stream.write(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_TRANSCODE_PASSTHROUGH],
data_buffer_p,
buffer_size);
}
}
else if ((device & AUDIO_DEVICE_OUT_AUX_DIGITAL)
&& (p_qap->hdmi_connect)
&& (p_qap->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_qap->passthrough_enabled) {
//Closing all the multi-Channel PCM HDMI output stream from QAP.
close_all_pcm_hdmi_output_l();
//If passthrough is active then pcm hdmi output has to be dropped.
pthread_mutex_unlock(&p_qap->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 && qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]) {
DEBUG_MSG("closing MCH PCM session ox%x", (int)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]);
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]));
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH] = NULL;
p_qap->mch_pcm_hdmi_enabled = false;
}
if (!p_qap->mch_pcm_hdmi_enabled && !(qap_mod->stream_out[QAP_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_qap->hdmi_sink_channels == 8) {
config.offload_info.channel_mask = config.channel_mask =
AUDIO_CHANNEL_OUT_7POINT1;
} else if (p_qap->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;
DEBUG_MSG("Opening MCH PCM out(outputenum=%d) session ox%x with below params",
QAP_OUT_OFFLOAD_MCH,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]);
DEBUG_MSG("sample rate=%d bitwidth=%d format = 0x%x channel mask=0x%x flags=0x%x device =0x%x",
config.sample_rate,
config.offload_info.bit_width,
config.offload_info.format,
config.offload_info.channel_mask,
flags,
devices);
ret = adev_open_output_stream((struct audio_hw_device *)p_qap->adev,
QAP_DEFAULT_COMPR_AUDIO_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]),
NULL);
if (ret < 0) {
ERROR_MSG("Failed opening MCH PCM out(outputenum=%d) session ox%x",
QAP_OUT_OFFLOAD_MCH,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]);
pthread_mutex_unlock(&p_qap->lock);
return;
} else
DEBUG_MSG("Opened MCH PCM out(outputenum=%d) session ox%x",
QAP_OUT_OFFLOAD_MCH,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]);
set_out_stream_channel_map(qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH], new_conf);
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->compr_config.fragment_size =
qap_get_pcm_offload_output_buffer_size(qap_mod, &config.offload_info);
p_qap->mch_pcm_hdmi_enabled = true;
if ((qap_mod->stream_in[QAP_IN_MAIN]
&& qap_mod->stream_in[QAP_IN_MAIN]->client_callback != NULL) ||
(qap_mod->stream_in[QAP_IN_MAIN_2]
&& qap_mod->stream_in[QAP_IN_MAIN_2]->client_callback != NULL)) {
if (qap_mod->stream_in[QAP_IN_MAIN]) {
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH],
qap_mod->stream_in[QAP_IN_MAIN]->client_callback,
qap_mod->stream_in[QAP_IN_MAIN]->client_cookie);
}
if (qap_mod->stream_in[QAP_IN_MAIN_2]) {
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH],
qap_mod->stream_in[QAP_IN_MAIN_2]->client_callback,
qap_mod->stream_in[QAP_IN_MAIN_2]->client_cookie);
}
} else if (qap_mod->stream_in[QAP_IN_PCM]
&& qap_mod->stream_in[QAP_IN_PCM]->client_callback != NULL) {
qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH],
qap_mod->stream_in[QAP_IN_PCM]->client_callback,
qap_mod->stream_in[QAP_IN_PCM]->client_cookie);
}
}
if (qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]) {
DEBUG_MSG_VV("Writing Bytes(%d) to QAP_OUT_OFFLOAD_MCH output(%p) buff ptr(%p)",
buffer_size, qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH],
data_buffer_p);
ret = qap_mod->stream_out[QAP_OUT_OFFLOAD_MCH]->stream.write(
(struct audio_stream_out *)qap_mod->stream_out[QAP_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 && qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
DEBUG_MSG("closing PCM session ox%x", (int)qap_mod->stream_out[QAP_OUT_OFFLOAD]);
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(qap_mod->stream_out[QAP_OUT_OFFLOAD]));
qap_mod->stream_out[QAP_OUT_OFFLOAD] = NULL;
}
bt_stream = audio_extn_bt_hal_get_output_stream(qap_mod->bt_hdl);
if (bt_stream != NULL) {
if (qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(qap_mod->stream_out[QAP_OUT_OFFLOAD]));
qap_mod->stream_out[QAP_OUT_OFFLOAD] = NULL;
}
audio_extn_bt_hal_out_write(p_qap->bt_hdl, data_buffer_p, buffer_size);
} else if (NULL == qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
audio_devices_t devices;
if (qap_mod->stream_in[QAP_IN_MAIN])
devices = qap_mod->stream_in[QAP_IN_MAIN]->devices;
else
devices = qap_mod->stream_in[QAP_IN_PCM]->devices;
//If multi channel pcm or passthrough is already enabled then remove the hdmi flag from device.
if (p_qap->mch_pcm_hdmi_enabled || p_qap->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;
DEBUG_MSG("Opening Stereo PCM out(outputenum=%d) session ox%x with below params",
QAP_OUT_OFFLOAD,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD]);
DEBUG_MSG("sample rate=%d bitwidth=%d format = 0x%x channel mask=0x%x flags=0x%x device =0x%x",
config.sample_rate,
config.offload_info.bit_width,
config.offload_info.format,
config.offload_info.channel_mask,
flags,
devices);
/* TODO:: Need to Propagate errors to framework */
ret = adev_open_output_stream((struct audio_hw_device *)p_qap->adev,
QAP_DEFAULT_COMPR_AUDIO_HANDLE,
devices,
flags,
&config,
(struct audio_stream_out **)&(qap_mod->stream_out[QAP_OUT_OFFLOAD]),
NULL);
if (ret < 0) {
ERROR_MSG("Failed opening Stereo PCM out(outputenum=%d) session ox%x",
QAP_OUT_OFFLOAD,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD]);
pthread_mutex_unlock(&p_qap->lock);
return;
} else
DEBUG_MSG("Opened Stereo PCM out(outputenum=%d) session ox%x",
QAP_OUT_OFFLOAD,
(int)qap_mod->stream_out[QAP_OUT_OFFLOAD]);
set_out_stream_channel_map(qap_mod->stream_out[QAP_OUT_OFFLOAD], new_conf);
if ((qap_mod->stream_in[QAP_IN_MAIN]
&& qap_mod->stream_in[QAP_IN_MAIN]->client_callback != NULL) ||
(qap_mod->stream_in[QAP_IN_MAIN_2]
&& qap_mod->stream_in[QAP_IN_MAIN_2]->client_callback != NULL)) {
if (qap_mod->stream_in[QAP_IN_MAIN]) {
qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD],
qap_mod->stream_in[QAP_IN_MAIN]->client_callback,
qap_mod->stream_in[QAP_IN_MAIN]->client_cookie);
}
if (qap_mod->stream_in[QAP_IN_MAIN_2]) {
qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD],
qap_mod->stream_in[QAP_IN_MAIN_2]->client_callback,
qap_mod->stream_in[QAP_IN_MAIN_2]->client_cookie);
}
} else if (qap_mod->stream_in[QAP_IN_PCM]
&& qap_mod->stream_in[QAP_IN_PCM]->client_callback != NULL) {
qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.set_callback(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD],
qap_mod->stream_in[QAP_IN_PCM]->client_callback,
qap_mod->stream_in[QAP_IN_PCM]->client_cookie);
}
qap_mod->stream_out[QAP_OUT_OFFLOAD]->compr_config.fragments =
COMPRESS_OFFLOAD_NUM_FRAGMENTS;
qap_mod->stream_out[QAP_OUT_OFFLOAD]->compr_config.fragment_size =
qap_get_pcm_offload_output_buffer_size(qap_mod, &config.offload_info);
if (qap_mod->is_vol_set) {
DEBUG_MSG("Setting Volume Left[%f], Right[%f]", qap_mod->vol_left, qap_mod->vol_right);
qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.set_volume(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD],
qap_mod->vol_left,
qap_mod->vol_right);
}
}
if (qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
DEBUG_MSG_VV("Writing Bytes(%d) to QAP_OUT_OFFLOAD output(%p) buff ptr(%p)",
buffer_size, qap_mod->stream_out[QAP_OUT_OFFLOAD],
data_buffer_p);
ret = qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.write(
(struct audio_stream_out *)qap_mod->stream_out[QAP_OUT_OFFLOAD],
data_buffer_p,
buffer_size);
}
}
DEBUG_MSG_VV("Bytes consumed [%d] by Audio HAL", ret);
}
else if (event_id == QAP_CALLBACK_EVENT_EOS
|| event_id == QAP_CALLBACK_EVENT_MAIN_2_EOS
|| event_id == QAP_CALLBACK_EVENT_EOS_ASSOC) {
struct stream_out *out = qap_mod->stream_in[QAP_IN_MAIN];
struct stream_out *out_pcm = qap_mod->stream_in[QAP_IN_PCM];
struct stream_out *out_main2 = qap_mod->stream_in[QAP_IN_MAIN_2];
struct stream_out *out_assoc = qap_mod->stream_in[QAP_IN_ASSOC];
/**
* TODO:: Only DD/DDP Associate Eos is handled, need to add support
* for other formats.
*/
if (event_id == QAP_CALLBACK_EVENT_EOS
&& (out_pcm != NULL)
&& (check_stream_state_l(out_pcm, STOPPING))) {
lock_output_stream_l(out_pcm);
out_pcm->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_pcm->client_cookie);
set_stream_state_l(out_pcm, STOPPED);
unlock_output_stream_l(out_pcm);
DEBUG_MSG("sent pcm DRAIN_READY");
} else if ( event_id == QAP_CALLBACK_EVENT_EOS_ASSOC
&& (out_assoc != NULL)
&& (check_stream_state_l(out_assoc, STOPPING))) {
lock_output_stream_l(out_assoc);
out_assoc->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_assoc->client_cookie);
set_stream_state_l(out_assoc, STOPPED);
unlock_output_stream_l(out_assoc);
DEBUG_MSG("sent associated DRAIN_READY");
} else if (event_id == QAP_CALLBACK_EVENT_MAIN_2_EOS
&& (out_main2 != NULL)
&& (check_stream_state_l(out_main2, STOPPING))) {
lock_output_stream_l(out_main2);
out_main2->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out_main2->client_cookie);
set_stream_state_l(out_main2, STOPPED);
unlock_output_stream_l(out_main2);
DEBUG_MSG("sent main2 DRAIN_READY");
} else if ((out != NULL) && (check_stream_state_l(out, STOPPING))) {
lock_output_stream_l(out);
out->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out->client_cookie);
set_stream_state_l(out, STOPPED);
unlock_output_stream_l(out);
DEBUG_MSG("sent main DRAIN_READY");
}
}
else if (event_id == QAP_CALLBACK_EVENT_EOS || event_id == QAP_CALLBACK_EVENT_EOS_ASSOC) {
struct stream_out *out = NULL;
if (event_id == QAP_CALLBACK_EVENT_EOS) {
out = qap_mod->stream_in[QAP_IN_MAIN];
} else {
out = qap_mod->stream_in[QAP_IN_ASSOC];
}
if ((out != NULL) && (check_stream_state_l(out, STOPPING))) {
lock_output_stream_l(out);
out->client_callback(STREAM_CBK_EVENT_DRAIN_READY, NULL, out->client_cookie);
set_stream_state_l(out, STOPPED);
unlock_output_stream_l(out);
DEBUG_MSG("sent DRAIN_READY");
}
}
pthread_mutex_unlock(&p_qap->lock);
return;
}
static int qap_sess_close(struct qap_module* qap_mod)
{
int j;
int ret = -EINVAL;
DEBUG_MSG("Closing Session.");
//Check if all streams are closed or not.
for (j = 0; j < MAX_QAP_MODULE_IN; j++) {
if (qap_mod->stream_in[j] != NULL) {
break;
}
}
if (j != MAX_QAP_MODULE_IN) {
DEBUG_MSG("Some stream is still active, Can not close session.");
return 0;
}
qap_mod->is_session_closing = true;
if(p_qap->qap_output_block_handling) {
pthread_mutex_lock(&qap_mod->session_output_lock);
if (qap_mod->is_session_output_active == false) {
pthread_cond_signal(&qap_mod->session_output_cond);
DEBUG_MSG("Wake up MM module output thread");
}
pthread_mutex_unlock(&qap_mod->session_output_lock);
}
pthread_mutex_lock(&p_qap->lock);
if (!qap_mod || !qap_mod->session_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p)",
qap_mod, qap_mod->session_handle);
return -EINVAL;
}
ret = qap_session_close(qap_mod->session_handle);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("close session failed %d", ret);
return -EINVAL;
} else
DEBUG_MSG("Closed QAP session 0x%x", (int)qap_mod->session_handle);
qap_mod->session_handle = NULL;
qap_mod->is_vol_set = false;
memset(qap_mod->stream_state, 0, sizeof(qap_mod->stream_state));
qap_close_all_output_streams(qap_mod);
qap_mod->new_out_format_index = 0;
pthread_mutex_unlock(&p_qap->lock);
qap_mod->is_session_closing = false;
DEBUG_MSG("Exit.");
return 0;
}
static int qap_stream_close(struct stream_out *out)
{
int ret = -EINVAL;
struct qap_module *qap_mod = NULL;
int index = -1;
DEBUG_MSG("Flag [0x%x], Stream handle [%p]", out->flags, out->qap_stream_handle);
qap_mod = get_qap_module_for_input_stream_l(out);
index = get_input_stream_index_l(out);
if (!qap_mod || !qap_mod->session_handle || (index < 0) || !out->qap_stream_handle) {
ERROR_MSG("Wrong state to process qap_mod(%p) sess_hadl(%p) strm hndl(%p), index %d",
qap_mod, qap_mod->session_handle, out->qap_stream_handle, index);
return -EINVAL;
}
pthread_mutex_lock(&p_qap->lock);
set_stream_state_l(out,STOPPED);
qap_mod->stream_in[index] = NULL;
lock_output_stream_l(out);
ret = qap_module_deinit(out->qap_stream_handle);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("deinit failed %d", ret);
return -EINVAL;
} else
DEBUG_MSG("module(ox%x) closed successfully", (int)out->qap_stream_handle);
out->qap_stream_handle = NULL;
unlock_output_stream_l(out);
pthread_mutex_unlock(&p_qap->lock);
//If all streams are closed then close the session.
qap_sess_close(qap_mod);
DEBUG_MSG("Exit");
return ret;
}
#define MAX_INIT_PARAMS 6
static void update_qap_session_init_params(audio_session_handle_t session_handle) {
DEBUG_MSG("Entry");
qap_status_t ret = QAP_STATUS_OK;
uint32_t cmd_data[MAX_INIT_PARAMS] = {0};
/* all init params should be sent
* together so gang them up.
*/
cmd_data[0] = MS12_SESSION_CFG_MAX_CHS;
cmd_data[1] = 6;/*5.1 channels*/
cmd_data[2] = MS12_SESSION_CFG_BS_OUTPUT_MODE;
cmd_data[3] = 3;/*DDP Re-encoding and DDP to DD Transcoding*/
cmd_data[4] = MS12_SESSION_CFG_CHMOD_LOCKING;
cmd_data[MAX_INIT_PARAMS - 1] = 1;/*Lock to 6 channel*/
ret = qap_session_cmd(session_handle,
QAP_SESSION_CMD_SET_PARAM,
MAX_INIT_PARAMS * sizeof(uint32_t),
&cmd_data[0],
NULL,
NULL);
if (ret != QAP_STATUS_OK) {
ERROR_MSG("session init params config failed");
}
DEBUG_MSG("Exit");
return;
}
/* Query HDMI EDID and sets module output accordingly.*/
static void qap_set_hdmi_configuration_to_module()
{
int ret = 0;
int channels = 0;
char prop_value[PROPERTY_VALUE_MAX] = {0};
bool passth_support = false;
qap_session_outputs_config_t *session_outputs_config = NULL;
DEBUG_MSG("Entry");
if (!p_qap) {
return;
}
if (!p_qap->hdmi_connect) {
return;
}
p_qap->hdmi_sink_channels = 0;
if (p_qap->qap_mod[MS12].session_handle)
session_outputs_config = &p_qap->qap_mod[MS12].session_outputs_config;
else if (p_qap->qap_mod[DTS_M8].session_handle)
session_outputs_config = &p_qap->qap_mod[DTS_M8].session_outputs_config;
else {
DEBUG_MSG("HDMI connection comes even before session is setup");
return;
}
session_outputs_config->num_output = 1;
//QAP re-encoding and DSP offload passthrough is supported.
if (property_get_bool("vendor.audio.offload.passthrough", false)
&& property_get_bool("vendor.audio.qap.reencode", false)) {
if (p_qap->qap_mod[MS12].session_handle) {
bool do_setparam = false;
property_get("vendor.audio.qap.hdmi.out", prop_value, NULL);
if (platform_is_edid_supported_format(p_qap->adev->platform, AUDIO_FORMAT_E_AC3)
&& (strncmp(prop_value, "ddp", 3) == 0)) {
do_setparam = true;
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_EAC3;
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_EAC3;
} else if (platform_is_edid_supported_format(p_qap->adev->platform, AUDIO_FORMAT_AC3)) {
do_setparam = true;
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_AC3;
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_AC3;
}
if (do_setparam) {
DEBUG_MSG(" Enabling HDMI(Passthrough out) from MS12 wrapper outputid=0x%x",
session_outputs_config->output_config[0].id);
ret = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_HDMI device with QAP %d", ret);
return;
}
passth_support = true;
}
}
if (p_qap->qap_mod[DTS_M8].session_handle) {
bool do_setparam = false;
if (platform_is_edid_supported_format(p_qap->adev->platform, AUDIO_FORMAT_DTS)) {
do_setparam = true;
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_DTS;
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_DTS;
}
if (do_setparam) {
ret = qap_session_cmd(p_qap->qap_mod[DTS_M8].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_HDMI device with QAP %d", ret);
return;
}
passth_support = true;
}
}
}
//Compressed passthrough is not enabled.
if (!passth_support) {
channels = platform_edid_get_max_channels(p_qap->adev->platform);
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_PCM_16_BIT;
switch (channels) {
case 8:
DEBUG_MSG("Switching Qap output to 7.1 channels");
session_outputs_config->output_config[0].channels = 8;
if (!p_qap->qap_msmd_enabled)
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_PCM_16_BIT;
p_qap->hdmi_sink_channels = channels;
break;
case 6:
DEBUG_MSG("Switching Qap output to 5.1 channels");
session_outputs_config->output_config[0].channels = 6;
if (!p_qap->qap_msmd_enabled)
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_PCM_16_BIT;
p_qap->hdmi_sink_channels = channels;
break;
default:
DEBUG_MSG("Switching Qap output to default channels");
session_outputs_config->output_config[0].channels = 2;
if (!p_qap->qap_msmd_enabled)
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_HDMI|QAP_AUDIO_FORMAT_PCM_16_BIT;
p_qap->hdmi_sink_channels = 2;
break;
}
if (p_qap->qap_mod[MS12].session_handle) {
DEBUG_MSG(" Enabling HDMI(MCH PCM out) from MS12 wrapper outputid = %x", session_outputs_config->output_config[0].id);
ret = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_HDMI device with QAP %d", ret);
return;
}
}
if (p_qap->qap_mod[DTS_M8].session_handle) {
ret = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_HDMI device with QAP %d", ret);
return;
}
}
}
DEBUG_MSG("Exit");
}
static void qap_set_default_configuration_to_module()
{
qap_session_outputs_config_t *session_outputs_config = NULL;
int ret = 0;
DEBUG_MSG("Entry");
if (!p_qap) {
return;
}
if (!p_qap->bt_connect) {
DEBUG_MSG("BT is not connected.");
}
//ms12 wrapper don't support bt, treat this as speaker and routign to bt
//will take care as a part of data callback notifier
if (p_qap->qap_mod[MS12].session_handle)
session_outputs_config = &p_qap->qap_mod[MS12].session_outputs_config;
else if (p_qap->qap_mod[DTS_M8].session_handle)
session_outputs_config = &p_qap->qap_mod[DTS_M8].session_outputs_config;
session_outputs_config->num_output = 1;
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_SPEAKER;
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_PCM_16_BIT;
if (p_qap->qap_mod[MS12].session_handle) {
DEBUG_MSG(" Enabling speaker(PCM out) from MS12 wrapper outputid = %x", session_outputs_config->output_config[0].id);
ret = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_SPEAKER device with QAP %d", ret);
return;
}
}
if (p_qap->qap_mod[DTS_M8].session_handle) {
ret = qap_session_cmd(p_qap->qap_mod[DTS_M8].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != ret) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_SPEAKER device with QAP %d", ret);
return;
}
}
}
/* Open a MM module session with QAP. */
static int audio_extn_qap_session_open(mm_module_type mod_type, __unused struct stream_out *out)
{
DEBUG_MSG("%s %d", __func__, __LINE__);
int ret = 0;
struct qap_module *qap_mod = NULL;
if (mod_type >= MAX_MM_MODULE_TYPE)
return -ENOTSUP; //Not supported by QAP module.
pthread_mutex_lock(&p_qap->lock);
qap_mod = &(p_qap->qap_mod[mod_type]);
//If session is already opened then return.
if (qap_mod->session_handle) {
DEBUG_MSG("QAP Session is already opened.");
pthread_mutex_unlock(&p_qap->lock);
return 0;
}
if (MS12 == mod_type) {
if (NULL == (qap_mod->session_handle = (void *)qap_session_open(QAP_SESSION_MS12_OTT, qap_mod->qap_lib))) {
ERROR_MSG("Failed to open QAP session, lib_handle 0x%x", (int)qap_mod->qap_lib);
ret = -EINVAL;
goto exit;
} else
DEBUG_MSG("Opened QAP session 0x%x", (int)qap_mod->session_handle);
update_qap_session_init_params(qap_mod->session_handle);
}
if (QAP_STATUS_OK != (qap_session_set_callback (qap_mod->session_handle, &qap_session_callback, (void *)qap_mod))) {
ERROR_MSG("Failed to register QAP session callback");
ret = -EINVAL;
goto exit;
}
qap_mod->is_session_output_active = true;
if(p_qap->hdmi_connect)
qap_set_hdmi_configuration_to_module();
else
qap_set_default_configuration_to_module();
exit:
pthread_mutex_unlock(&p_qap->lock);
return ret;
}
static int qap_map_input_format(audio_format_t audio_format, qap_audio_format_t *format)
{
if (audio_format == AUDIO_FORMAT_AC3) {
*format = QAP_AUDIO_FORMAT_AC3;
DEBUG_MSG( "File Format is AC3!");
} else if (audio_format == AUDIO_FORMAT_E_AC3) {
*format = QAP_AUDIO_FORMAT_EAC3;
DEBUG_MSG( "File Format is E_AC3!");
} else if ((audio_format == AUDIO_FORMAT_AAC_ADTS_LC) ||
(audio_format == AUDIO_FORMAT_AAC_ADTS_HE_V1) ||
(audio_format == AUDIO_FORMAT_AAC_ADTS_HE_V2) ||
(audio_format == AUDIO_FORMAT_AAC_LC) ||
(audio_format == AUDIO_FORMAT_AAC_HE_V1) ||
(audio_format == AUDIO_FORMAT_AAC_HE_V2) ||
(audio_format == AUDIO_FORMAT_AAC_LATM_LC) ||
(audio_format == AUDIO_FORMAT_AAC_LATM_HE_V1) ||
(audio_format == AUDIO_FORMAT_AAC_LATM_HE_V2)) {
*format = QAP_AUDIO_FORMAT_AAC_ADTS;
DEBUG_MSG( "File Format is AAC!");
} else if (audio_format == AUDIO_FORMAT_DTS) {
*format = QAP_AUDIO_FORMAT_DTS;
DEBUG_MSG( "File Format is DTS!");
} else if (audio_format == AUDIO_FORMAT_DTS_HD) {
*format = QAP_AUDIO_FORMAT_DTS_HD;
DEBUG_MSG( "File Format is DTS_HD!");
} else if (audio_format == AUDIO_FORMAT_PCM_16_BIT) {
*format = QAP_AUDIO_FORMAT_PCM_16_BIT;
DEBUG_MSG( "File Format is PCM_16!");
} else if (audio_format == AUDIO_FORMAT_PCM_32_BIT) {
*format = QAP_AUDIO_FORMAT_PCM_32_BIT;
DEBUG_MSG( "File Format is PCM_32!");
} else if (audio_format == AUDIO_FORMAT_PCM_24_BIT_PACKED) {
*format = QAP_AUDIO_FORMAT_PCM_24_BIT_PACKED;
DEBUG_MSG( "File Format is PCM_24!");
} else if ((audio_format == AUDIO_FORMAT_PCM_8_BIT) ||
(audio_format == AUDIO_FORMAT_PCM_8_24_BIT)) {
*format = QAP_AUDIO_FORMAT_PCM_8_24_BIT;
DEBUG_MSG( "File Format is PCM_8_24!");
} else {
ERROR_MSG( "File Format not supported!");
return -EINVAL;
}
return 0;
}
void qap_module_callback(__unused qap_module_handle_t module_handle,
void* priv_data,
qap_module_callback_event_t event_id,
__unused int size,
__unused void *data)
{
struct stream_out *out=(struct stream_out *)priv_data;
DEBUG_MSG("Entry");
if (QAP_MODULE_CALLBACK_EVENT_SEND_INPUT_BUFFER == event_id) {
DEBUG_MSG("QAP_MODULE_CALLBACK_EVENT_SEND_INPUT_BUFFER for (%p)", out);
if (out->client_callback) {
out->client_callback(STREAM_CBK_EVENT_WRITE_READY, NULL, out->client_cookie);
}
else
DEBUG_MSG("client has no callback registered, no action needed for this event %d",
event_id);
}
else
DEBUG_MSG("Un Recognized event %d", event_id);
DEBUG_MSG("exit");
return;
}
/* opens a stream in QAP module. */
static int qap_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_l(config->format);
struct qap_module* qap_mod = NULL;
qap_module_config_t input_config = {0};
DEBUG_MSG("Flags 0x%x, Device 0x%x for use case %s out 0x%x", flags, devices, use_case_table[out->usecase], (int)out);
if (mmtype >= MAX_MM_MODULE_TYPE) {
ERROR_MSG("Unsupported Stream");
return -ENOTSUP;
}
//Open the module session, if not opened already.
status = audio_extn_qap_session_open(mmtype, out);
qap_mod = &(p_qap->qap_mod[mmtype]);
if ((status != 0) || (!qap_mod->session_handle ))
return status;
input_config.sample_rate = config->sample_rate;
input_config.channels = popcount(config->channel_mask);
if (input_config.format != AUDIO_FORMAT_PCM_16_BIT) {
input_config.format &= AUDIO_FORMAT_MAIN_MASK;
}
input_config.module_type = QAP_MODULE_DECODER;
status = qap_map_input_format(config->format, &input_config.format);
if (status == -EINVAL)
return -EINVAL;
DEBUG_MSG("qap_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 == QAP_AUDIO_FORMAT_PCM_16_BIT) {
//If PCM stream is already opened then fail this stream open.
if (qap_mod->stream_in[QAP_IN_PCM]) {
ERROR_MSG("PCM input is already active.");
return -ENOTSUP;
}
input_config.flags = QAP_MODULE_FLAG_SYSTEM_SOUND;
status = qap_module_init(qap_mod->session_handle, &input_config, &out->qap_stream_handle);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to open PCM(QAP_MODULE_FLAG_SYSTEM_SOUND) QAP module %d", status);
return -EINVAL;
} else
DEBUG_MSG("QAP_MODULE_FLAG_SYSTEM_SOUND, module(ox%x) opened successfully", (int)out->qap_stream_handle);
qap_mod->stream_in[QAP_IN_PCM] = out;
} else if ((flags & AUDIO_OUTPUT_FLAG_MAIN) && (flags & AUDIO_OUTPUT_FLAG_ASSOCIATED)) {
if (is_main_active_l(qap_mod) || is_dual_main_active_l(qap_mod)) {
ERROR_MSG("Dual Main or Main already active. So, Cannot open main and associated stream");
return -EINVAL;
} else {
input_config.flags = QAP_MODULE_FLAG_PRIMARY;
status = qap_module_init(qap_mod->session_handle, &input_config, &out->qap_stream_handle);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to open QAP stream/module with QAP_MODULE_FLAG_PRIMARY flag %d", status);
return -EINVAL;
} else
DEBUG_MSG("QAP_MODULE_FLAG_PRIMARY, module opened successfully 0x%x", (int)out->qap_stream_handle);;
qap_mod->stream_in[QAP_IN_MAIN] = out;
}
} 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_l(qap_mod)) {
ERROR_MSG("Dual Main already active. So, Cannot open main stream");
return -EINVAL;
} else if (is_main_active_l(qap_mod) && qap_mod->stream_in[QAP_IN_ASSOC]) {
ERROR_MSG("Main and Associated already active. So, Cannot open main stream");
return -EINVAL;
} else if (is_main_active_l(qap_mod) && (mmtype != MS12)) {
ERROR_MSG("Main already active and Not an MS12 format. So, Cannot open another main stream");
return -EINVAL;
} else {
input_config.flags = QAP_MODULE_FLAG_PRIMARY;
status = qap_module_init(qap_mod->session_handle, &input_config, &out->qap_stream_handle);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to open QAP stream/module with QAP_MODULE_FLAG_PRIMARY flag %d", status);
return -EINVAL;
} else
DEBUG_MSG("QAP_MODULE_FLAG_PRIMARY, module opened successfully 0x%x", (int)out->qap_stream_handle);
if(qap_mod->stream_in[QAP_IN_MAIN]) {
qap_mod->stream_in[QAP_IN_MAIN_2] = out;
} else {
qap_mod->stream_in[QAP_IN_MAIN] = out;
}
}
} else if ((flags & AUDIO_OUTPUT_FLAG_ASSOCIATED)) {
if (is_dual_main_active_l(qap_mod)) {
ERROR_MSG("Dual Main already active. So, Cannot open associated stream");
return -EINVAL;
} else if (!is_main_active_l(qap_mod)) {
ERROR_MSG("Main not active. So, Cannot open associated stream");
return -EINVAL;
} else if (qap_mod->stream_in[QAP_IN_ASSOC]) {
ERROR_MSG("Associated already active. So, Cannot open associated stream");
return -EINVAL;
}
input_config.flags = QAP_MODULE_FLAG_SECONDARY;
status = qap_module_init(qap_mod->session_handle, &input_config, &out->qap_stream_handle);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to open QAP stream/module with QAP_MODULE_FLAG_SECONDARY flag %d", status);
return -EINVAL;
} else
DEBUG_MSG("QAP_MODULE_FLAG_SECONDARY, module opened successfully 0x%x", (int)out->qap_stream_handle);
qap_mod->stream_in[QAP_IN_ASSOC] = out;
}
if (out->qap_stream_handle) {
status = qap_module_set_callback(out->qap_stream_handle, &qap_module_callback, out);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to register module callback %d", status);
return -EINVAL;
} else
DEBUG_MSG("Module call back registered 0x%x cookie 0x%x", (int)out->qap_stream_handle, (int)out);
}
if (status != 0) {
//If no stream is active then close the session.
qap_sess_close(qap_mod);
return 0;
}
//If Device is HDMI, QAP passthrough is enabled and there is no previous QAP passthrough input stream.
if ((!p_qap->passthrough_in)
&& (devices & AUDIO_DEVICE_OUT_AUX_DIGITAL)
&& audio_extn_qap_passthrough_enabled(out)) {
//Assign the QAP passthrough input stream.
p_qap->passthrough_in = out;
//If HDMI is connected and format is supported by HDMI then create QAP passthrough output stream.
if (p_qap->hdmi_connect
&& platform_is_edid_supported_format(p_qap->adev->platform, out->format)) {
status = create_qap_passthrough_stream_l();
if (status < 0) {
qap_stream_close(out);
ERROR_MSG("QAP passthrough stream creation failed with error %d", status);
return status;
}
}
/*Else: since QAP passthrough input stream is already initialized,
* when hdmi is connected
* then qap passthrough output stream will be created.
*/
}
DEBUG_MSG();
return status;
}
static int qap_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_l(out);
//If QAP passthrough is active then block the resume on module input streams.
if (p_qap->passthrough_out) {
//If resume is received for the QAP passthrough stream then call the primary HAL api.
pthread_mutex_lock(&p_qap->lock);
if (p_qap->passthrough_in == out) {
status = p_qap->passthrough_out->stream.resume(
(struct audio_stream_out*)p_qap->passthrough_out);
if (!status) out->offload_state = OFFLOAD_STATE_PLAYING;
}
pthread_mutex_unlock(&p_qap->lock);
} else {
//Flush the module input stream.
status = qap_stream_start_l(out);
}
unlock_output_stream_l(out);
DEBUG_MSG();
return status;
}
static int qap_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 qap_module *qap_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);
qap_mod = get_qap_module_for_input_stream_l(out);
if (!qap_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 QAP 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(qap_mod->bt_hdl) == NULL
&& audio_extn_bt_hal_get_device(qap_mod->bt_hdl) != NULL) {
ret = audio_extn_bt_hal_open_output_stream(qap_mod->bt_hdl,
QAP_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(qap_mod->bt_hdl) != NULL) {
audio_extn_bt_hal_close_output_stream(qap_mod->bt_hdl);
}
}
#endif
if (p_qap->passthrough_in == out) { //Device routing is received for QAP passthrough stream.
if (!(val & AUDIO_DEVICE_OUT_AUX_DIGITAL)) { //HDMI route is disabled.
//If QAP pasthrough output is enabled. Close it.
close_qap_passthrough_stream_l();
//Send the routing information to mm module pcm output.
if (qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
ret = qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.common.set_parameters(
(struct audio_stream *)qap_mod->stream_out[QAP_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_qap_passthrough_stream_l();
if (p_qap->passthrough_out != NULL) { //If QAP passthrough out is enabled then send routing information.
ret = p_qap->passthrough_out->stream.common.set_parameters(
(struct audio_stream *)p_qap->passthrough_out, kvpairs);
}
}
} else {
//Send the routing information to mm module pcm output.
if (qap_mod->stream_out[QAP_OUT_OFFLOAD]) {
ret = qap_mod->stream_out[QAP_OUT_OFFLOAD]->stream.common.set_parameters(
(struct audio_stream *)qap_mod->stream_out[QAP_OUT_OFFLOAD], kvpairs);
}
//else: device info is updated in the input streams.
}
str_parms_destroy(parms);
return ret;
}
/* Checks if a stream is QAP stream or not. */
bool audio_extn_is_qap_stream(struct stream_out *out)
{
struct qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
if (qap_mod) {
return true;
}
return false;
}
#if 0
/* API to send playback stream specific config parameters */
int audio_extn_qap_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 qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
if (!out || !qap_mod || !payload) {
ERROR_MSG("Invalid Param");
return ret;
}
/* apply param for all active out sessions */
for (index = 0; index < MAX_QAP_MODULE_OUT; index++) {
new_out = qap_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_l(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_l(new_out);
}
return ret;
}
int audio_extn_qap_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 qap_module *qap_mod = get_qap_module_for_input_stream_l(out);
if (!out || !qap_mod || !payload) {
ERROR_MSG("Invalid Param");
return ret;
}
if (!p_qap->hdmi_connect) {
ERROR_MSG("hdmi not connected");
return ret;
}
/* get session which is routed to hdmi*/
if (p_qap->passthrough_out)
new_out = p_qap->passthrough_out;
else {
for (i = 0; i < MAX_QAP_MODULE_OUT; i++) {
if (qap_mod->stream_out[i]) {
new_out = qap_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_l(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_l(new_out);
return ret;
}
#endif
int audio_extn_qap_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;
DEBUG_MSG("Entry");
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 QAP for dummy PCM session opened by APM during boot time
if(flags == 0) {
ALOGD("bypassing QAP for flags is equal to none");
return ret;
}
#endif
out = (struct stream_out *)*stream_out;
DEBUG_MSG("%s 0x%x", use_case_table[out->usecase], (int)out);
ret = qap_stream_open(out, config, flags, devices);
if (ret < 0) {
ERROR_MSG("Error opening QAP stream err[%d]", ret);
//Stream not supported by QAP, Bypass QAP.
return 0;
}
/* Override function pointers based on qap definitions */
out->stream.set_volume = qap_out_set_volume;
out->stream.pause = qap_out_pause;
out->stream.resume = qap_out_resume;
out->stream.drain = qap_out_drain;
out->stream.flush = qap_out_flush;
out->stream.common.standby = qap_out_standby;
out->stream.common.set_parameters = qap_out_set_parameters;
out->stream.get_latency = qap_out_get_latency;
out->stream.get_render_position = qap_out_get_render_position;
out->stream.write = qap_out_write;
out->stream.get_presentation_position = qap_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 = QAP_DEEP_BUFFER_OUTPUT_PERIOD_SIZE;
out->config.period_count = DEEP_BUFFER_OUTPUT_PERIOD_COUNT;
out->config.start_threshold = QAP_DEEP_BUFFER_OUTPUT_PERIOD_SIZE / 4;
out->config.avail_min = QAP_DEEP_BUFFER_OUTPUT_PERIOD_SIZE / 4;
} else if(out->flags == AUDIO_OUTPUT_FLAG_DIRECT) {
out->compr_config.fragment_size = qap_get_pcm_offload_input_buffer_size(&(config->offload_info));
}
*stream_out = &out->stream;
DEBUG_MSG("Exit");
return 0;
}
void audio_extn_qap_close_output_stream(struct audio_hw_device *dev,
struct audio_stream_out *stream)
{
struct stream_out *out = (struct stream_out *)stream;
struct qap_module* qap_mod = get_qap_module_for_input_stream_l(out);
DEBUG_MSG("%s 0x%x", use_case_table[out->usecase], (int)out);
if (!qap_mod) {
DEBUG_MSG("qap module is NULL, nothing to close");
/*closing non-MS12/default output stream opened with qap */
adev_close_output_stream(dev, stream);
return;
}
DEBUG_MSG("stream_handle(%p) format = %x", out, out->format);
//If close is received for QAP passthrough stream then close the QAP passthrough output.
if (p_qap->passthrough_in == out) {
if (p_qap->passthrough_out) {
ALOGD("%s %d closing stream handle %p", __func__, __LINE__, p_qap->passthrough_out);
pthread_mutex_lock(&p_qap->lock);
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->passthrough_out));
pthread_mutex_unlock(&p_qap->lock);
p_qap->passthrough_out = NULL;
}
p_qap->passthrough_in = NULL;
}
qap_stream_close(out);
adev_close_output_stream(dev, stream);
DEBUG_MSG("Exit");
}
/* Check if QAP is supported or not. */
bool audio_extn_qap_is_enabled()
{
bool prop_enabled = false;
char value[PROPERTY_VALUE_MAX] = {0};
property_get("vendor.audio.qap.enabled", value, NULL);
prop_enabled = atoi(value) || !strncmp("true", value, 4);
return (prop_enabled);
}
/* QAP set parameter function. For Device connect and disconnect. */
int audio_extn_qap_set_parameters(struct audio_device *adev, struct str_parms *parms)
{
int status = 0, val = 0;
qap_session_outputs_config_t *session_outputs_config = NULL;
if (!p_qap) {
return -EINVAL;
}
DEBUG_MSG("Entry");
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.
DEBUG_MSG("AUDIO_DEVICE_OUT_AUX_DIGITAL connected");
p_qap->hdmi_connect = 1;
p_qap->hdmi_sink_channels = 0;
if (p_qap->passthrough_in) { //If QAP passthrough is already initialized.
lock_output_stream_l(p_qap->passthrough_in);
if (platform_is_edid_supported_format(adev->platform,
p_qap->passthrough_in->format)) {
//If passthrough format is supported by HDMI then create the QAP passthrough output if not created already.
create_qap_passthrough_stream_l();
//Ignoring the returned error, If error then QAP passthrough is disabled.
} else {
//If passthrough format is not supported by HDMI then close the QAP passthrough output if already created.
close_qap_passthrough_stream_l();
}
unlock_output_stream_l(p_qap->passthrough_in);
}
qap_set_hdmi_configuration_to_module();
} else if (val & AUDIO_DEVICE_OUT_BLUETOOTH_A2DP) {
DEBUG_MSG("AUDIO_DEVICE_OUT_BLUETOOTH_A2DP connected");
p_qap->bt_connect = 1;
qap_set_default_configuration_to_module();
#ifndef SPLIT_A2DP_ENABLED
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
if (!p_qap->qap_mod[k].bt_hdl) {
DEBUG_MSG("Opening a2dp output...");
status = audio_extn_bt_hal_load(&p_qap->qap_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)) {
DEBUG_MSG("AUDIO_DEVICE_OUT_AUX_DIGITAL disconnected");
if (val & AUDIO_DEVICE_OUT_AUX_DIGITAL) {
p_qap->hdmi_sink_channels = 0;
p_qap->passthrough_enabled = 0;
p_qap->mch_pcm_hdmi_enabled = 0;
p_qap->hdmi_connect = 0;
if (p_qap->qap_mod[MS12].session_handle)
session_outputs_config = &p_qap->qap_mod[MS12].session_outputs_config;
else if (p_qap->qap_mod[DTS_M8].session_handle)
session_outputs_config = &p_qap->qap_mod[DTS_M8].session_outputs_config;
else {
DEBUG_MSG("HDMI disconnection comes even before session is setup");
return 0;
}
session_outputs_config->num_output = 1;
session_outputs_config->output_config[0].id = AUDIO_DEVICE_OUT_SPEAKER;
session_outputs_config->output_config[0].format = QAP_AUDIO_FORMAT_PCM_16_BIT;
if (p_qap->qap_mod[MS12].session_handle) {
DEBUG_MSG(" Enabling speaker(PCM out) from MS12 wrapper outputid = %x", session_outputs_config->output_config[0].id);
status = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_SPEAKER device with QAP %d",status);
return -EINVAL;
}
}
if (p_qap->qap_mod[DTS_M8].session_handle) {
status = qap_session_cmd(p_qap->qap_mod[MS12].session_handle,
QAP_SESSION_CMD_SET_OUTPUTS,
sizeof(qap_session_outputs_config_t),
session_outputs_config,
NULL,
NULL);
if (QAP_STATUS_OK != status) {
ERROR_MSG("Unable to register AUDIO_DEVICE_OUT_SPEAKER device with QAP %d", status);
return -EINVAL;
}
}
close_all_hdmi_output_l();
close_qap_passthrough_stream_l();
} else if (val & AUDIO_DEVICE_OUT_BLUETOOTH_A2DP) {
DEBUG_MSG("AUDIO_DEVICE_OUT_BLUETOOTH_A2DP disconnected");
p_qap->bt_connect = 0;
//reconfig HDMI as end device (if connected)
if(p_qap->hdmi_connect)
qap_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_qap->qap_mod[k].bt_hdl) {
audio_extn_bt_hal_unload(p_qap->qap_mod[k].bt_hdl);
p_qap->qap_mod[k].bt_hdl = NULL;
}
}
#endif
}
//TODO else if: Need to consider other devices.
}
#if 0
/* does this need to be ported to QAP?*/
for (k = 0; k < MAX_MM_MODULE_TYPE; k++) {
kv_parirs = str_parms_to_str(parms);
if (p_qap->qap_mod[k].session_handle) {
p_qap->qap_mod[k].qap_audio_session_set_param(
p_qap->qap_mod[k].session_handle, kv_parirs);
}
}
#endif
DEBUG_MSG("Exit");
return status;
}
/* Create the QAP. */
int audio_extn_qap_init(struct audio_device *adev)
{
DEBUG_MSG("Entry");
p_qap = calloc(1, sizeof(struct qap));
if (p_qap == NULL) {
ERROR_MSG("Out of memory");
return -ENOMEM;
}
p_qap->adev = adev;
if (property_get_bool("vendor.audio.qap.msmd", false)) {
DEBUG_MSG("MSMD enabled.");
p_qap->qap_msmd_enabled = 1;
}
if (property_get_bool("vendor.audio.qap.output.block.handling", false)) {
DEBUG_MSG("out put thread blocking handling enabled.");
p_qap->qap_output_block_handling = 1;
}
pthread_mutex_init(&p_qap->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 qap_module *qap_mod = &(p_qap->qap_mod[i]);
if (i == MS12) {
property_get("vendor.audio.qap.library", value, NULL);
snprintf(lib_name, PROPERTY_VALUE_MAX, "%s", value);
DEBUG_MSG("Opening Ms12 library at %s", lib_name);
qap_mod->qap_lib = ( void *) qap_load_library(lib_name);
if (qap_mod->qap_lib == NULL) {
ERROR_MSG("qap load lib failed for MS12 %s", lib_name);
continue;
}
DEBUG_MSG("Loaded QAP lib at %s", lib_name);
pthread_mutex_init(&qap_mod->session_output_lock, (const pthread_mutexattr_t *) NULL);
pthread_cond_init(&qap_mod->session_output_cond, (const pthread_condattr_t *)NULL);
} else if (i == DTS_M8) {
property_get("vendor.audio.qap.m8.library", value, NULL);
snprintf(lib_name, PROPERTY_VALUE_MAX, "%s", value);
qap_mod->qap_lib = dlopen(lib_name, RTLD_NOW);
if (qap_mod->qap_lib == NULL) {
ERROR_MSG("DLOPEN failed for DTS M8 %s", lib_name);
continue;
}
DEBUG_MSG("DLOPEN successful for %s", lib_name);
pthread_mutex_init(&qap_mod->session_output_lock, (const pthread_mutexattr_t *) NULL);
pthread_cond_init(&qap_mod->session_output_cond, (const pthread_condattr_t *)NULL);
} else {
continue;
}
}
DEBUG_MSG("Exit");
return 0;
}
/* Tear down the qap extension. */
void audio_extn_qap_deinit()
{
int i;
DEBUG_MSG("Entry");
char value[PROPERTY_VALUE_MAX] = {0};
char lib_name[PROPERTY_VALUE_MAX] = {0};
if (p_qap != NULL) {
for (i = 0; i < MAX_MM_MODULE_TYPE; i++) {
if (p_qap->qap_mod[i].session_handle != NULL)
qap_sess_close(&p_qap->qap_mod[i]);
if (p_qap->qap_mod[i].qap_lib != NULL) {
if (i == MS12) {
property_get("vendor.audio.qap.library", value, NULL);
snprintf(lib_name, PROPERTY_VALUE_MAX, "%s", value);
DEBUG_MSG("lib_name %s", lib_name);
if (QAP_STATUS_OK != qap_unload_library(p_qap->qap_mod[i].qap_lib))
ERROR_MSG("Failed to unload MS12 library lib name %s", lib_name);
else
DEBUG_MSG("closed/unloaded QAP lib at %s", lib_name);
p_qap->qap_mod[i].qap_lib = NULL;
} else {
dlclose(p_qap->qap_mod[i].qap_lib);
p_qap->qap_mod[i].qap_lib = NULL;
}
pthread_mutex_destroy(&p_qap->qap_mod[i].session_output_lock);
pthread_cond_destroy(&p_qap->qap_mod[i].session_output_cond);
}
}
if (p_qap->passthrough_out) {
adev_close_output_stream((struct audio_hw_device *)p_qap->adev,
(struct audio_stream_out *)(p_qap->passthrough_out));
p_qap->passthrough_out = NULL;
}
pthread_mutex_destroy(&p_qap->lock);
free(p_qap);
p_qap = NULL;
}
DEBUG_MSG("Exit");
}