int srs_trumedia_open(int port_id, int srs_tech_id, void *srs_params)
{
struct asm_pp_params_command *open = NULL;
int ret = 0, sz = 0;
int index;
pr_debug("SRS - %s", __func__);
index = afe_get_port_index(port_id);
if (IS_ERR_VALUE(index)) {
pr_err("%s: invald port id\n", __func__);
return index;
}
switch (srs_tech_id) {
case SRS_ID_GLOBAL: {
struct srs_trumedia_params_GLOBAL *glb_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_GLOBAL);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_GLOBAL) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS;
open->params.param_size =
sizeof(struct srs_trumedia_params_GLOBAL);
glb_params = (struct srs_trumedia_params_GLOBAL *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(glb_params, srs_params,
sizeof(struct srs_trumedia_params_GLOBAL));
pr_debug("SRS - %s: Global params - 1 = %x, 2 = %x, 3 = %x,"
" 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x\n",
__func__, (int)glb_params->v1,
(int)glb_params->v2, (int)glb_params->v3,
(int)glb_params->v4, (int)glb_params->v5,
(int)glb_params->v6, (int)glb_params->v7,
(int)glb_params->v8);
break;
}
case SRS_ID_WOWHD: {
struct srs_trumedia_params_WOWHD *whd_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_WOWHD);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_WOWHD) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS_WOWHD;
open->params.param_size =
sizeof(struct srs_trumedia_params_WOWHD);
whd_params = (struct srs_trumedia_params_WOWHD *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(whd_params, srs_params,
sizeof(struct srs_trumedia_params_WOWHD));
pr_debug("SRS - %s: WOWHD params - 1 = %x, 2 = %x, 3 = %x,"
" 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x, 9 = %x,"
" 10 = %x, 11 = %x\n", __func__, (int)whd_params->v1,
(int)whd_params->v2, (int)whd_params->v3,
(int)whd_params->v4, (int)whd_params->v5,
(int)whd_params->v6, (int)whd_params->v7,
(int)whd_params->v8, (int)whd_params->v9,
(int)whd_params->v10, (int)whd_params->v11);
break;
}
case SRS_ID_CSHP: {
struct srs_trumedia_params_CSHP *chp_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_CSHP);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_CSHP) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS_CSHP;
open->params.param_size =
sizeof(struct srs_trumedia_params_CSHP);
chp_params = (struct srs_trumedia_params_CSHP *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(chp_params, srs_params,
sizeof(struct srs_trumedia_params_CSHP));
pr_debug("SRS - %s: CSHP params - 1 = %x, 2 = %x, 3 = %x,"
" 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x,"
" 9 = %x\n", __func__, (int)chp_params->v1,
(int)chp_params->v2, (int)chp_params->v3,
(int)chp_params->v4, (int)chp_params->v5,
(int)chp_params->v6, (int)chp_params->v7,
(int)chp_params->v8, (int)chp_params->v9);
break;
}
case SRS_ID_HPF: {
struct srs_trumedia_params_HPF *hpf_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_HPF);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_HPF) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS_HPF;
open->params.param_size =
sizeof(struct srs_trumedia_params_HPF);
hpf_params = (struct srs_trumedia_params_HPF *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(hpf_params, srs_params,
sizeof(struct srs_trumedia_params_HPF));
pr_debug("SRS - %s: HPF params - 1 = %x\n", __func__,
(int)hpf_params->v1);
break;
}
case SRS_ID_PEQ: {
struct srs_trumedia_params_PEQ *peq_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_PEQ);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_PEQ) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS_PEQ;
open->params.param_size =
sizeof(struct srs_trumedia_params_PEQ);
peq_params = (struct srs_trumedia_params_PEQ *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(peq_params, srs_params,
sizeof(struct srs_trumedia_params_PEQ));
pr_debug("SRS - %s: PEQ params - 1 = %x 2 = %x, 3 = %x,"
" 4 = %x\n", __func__, (int)peq_params->v1,
(int)peq_params->v2, (int)peq_params->v3,
(int)peq_params->v4);
break;
}
case SRS_ID_HL: {
struct srs_trumedia_params_HL *hl_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_trumedia_params_HL);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_trumedia_params_HL) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_TRUMEDIA_PARAMS_HL;
open->params.param_size = sizeof(struct srs_trumedia_params_HL);
hl_params = (struct srs_trumedia_params_HL *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(hl_params, srs_params,
sizeof(struct srs_trumedia_params_HL));
pr_debug("SRS - %s: HL params - 1 = %x, 2 = %x, 3 = %x, 4 = %x,"
" 5 = %x, 6 = %x, 7 = %x\n", __func__,
(int)hl_params->v1, (int)hl_params->v2,
(int)hl_params->v3, (int)hl_params->v4,
(int)hl_params->v5, (int)hl_params->v6,
(int)hl_params->v7);
break;
}
default:
goto fail_cmd;
}
open->payload = NULL;
open->params.module_id = SRS_TRUMEDIA_MODULE_ID;
open->params.reserved = 0;
open->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
open->hdr.pkt_size = sz;
open->hdr.src_svc = APR_SVC_ADM;
open->hdr.src_domain = APR_DOMAIN_APPS;
open->hdr.src_port = port_id;
open->hdr.dest_svc = APR_SVC_ADM;
open->hdr.dest_domain = APR_DOMAIN_ADSP;
open->hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
open->hdr.token = port_id;
open->hdr.opcode = ADM_CMD_SET_PARAMS;
pr_debug("SRS - %s: Command was sent now check Q6 - port id = %d,"
" size %d, module id %x, param id %x.\n", __func__,
open->hdr.dest_port, open->payload_size,
open->params.module_id, open->params.param_id);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)open);
if (ret < 0) {
pr_err("SRS - %s: ADM enable for port %d failed\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait, 1,
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("SRS - %s: ADM open failed for port %d\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
}
fail_cmd:
kfree(open);
return ret;
}
int adm_disconnect_afe_port(int mode, int session_id, int port_id)
{
struct adm_cmd_connect_afe_port cmd;
int ret = 0;
int index;
pr_debug("%s: port %d session id:%d mode:%d\n", __func__,
port_id, session_id, mode);
port_id = afe_convert_virtual_to_portid(port_id);
if (afe_validate_port(port_id) < 0) {
pr_err("%s port idi[%d] is invalid\n", __func__, port_id);
return -ENODEV;
}
if (this_adm.apr == NULL) {
this_adm.apr = apr_register("ADSP", "ADM", adm_callback,
0xFFFFFFFF, &this_adm);
if (this_adm.apr == NULL) {
pr_err("%s: Unable to register ADM\n", __func__);
ret = -ENODEV;
return ret;
}
rtac_set_adm_handle(this_adm.apr);
}
index = afe_get_port_index(port_id);
pr_debug("%s: Port ID %d, index %d\n", __func__, port_id, index);
cmd.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
cmd.hdr.pkt_size = sizeof(cmd);
cmd.hdr.src_svc = APR_SVC_ADM;
cmd.hdr.src_domain = APR_DOMAIN_APPS;
cmd.hdr.src_port = port_id;
cmd.hdr.dest_svc = APR_SVC_ADM;
cmd.hdr.dest_domain = APR_DOMAIN_ADSP;
cmd.hdr.dest_port = port_id;
cmd.hdr.token = port_id;
cmd.hdr.opcode = ADM_CMD_DISCONNECT_AFE_PORT;
cmd.mode = mode;
cmd.session_id = session_id;
cmd.afe_port_id = port_id;
atomic_set(&this_adm.copp_stat[index], 0);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)&cmd);
if (ret < 0) {
pr_err("%s:ADM enable for port %d failed\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait,
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s ADM connect AFE failed for port %d\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
}
atomic_dec(&this_adm.copp_cnt[index]);
return 0;
fail_cmd:
return ret;
}
int srs_ss3d_open(int port_id, int srs_tech_id, void *srs_params)
{
struct asm_pp_params_command *open = NULL;
int ret = 0, sz = 0;
int index;
pr_debug("SRS - %s: called.", __func__);
switch (srs_tech_id) {
case SRS_ID_SS3D_GLOBAL: {
struct srs_SS3D_params_GLOBAL *glb_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_SS3D_params_GLOBAL);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_SS3D_params_GLOBAL) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_SS3D_PARAMS;
open->params.param_size =
sizeof(struct srs_SS3D_params_GLOBAL);
glb_params = (struct srs_SS3D_params_GLOBAL *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(glb_params, srs_params,
sizeof(struct srs_SS3D_params_GLOBAL));
pr_debug("SRS - ss3d global params - 1 = %x, 2 = %x, 3 = %x\n"
" 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x\n",
(int)glb_params->v1, (int)glb_params->v2,
(int)glb_params->v3, (int)glb_params->v4,
(int)glb_params->v5, (int)glb_params->v6,
(int)glb_params->v7, (int)glb_params->v8);
break;
}
case SRS_ID_SS3D_CTRL: {
struct srs_SS3D_ctrl_params *whd_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_SS3D_ctrl_params);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_SS3D_ctrl_params) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_SS3D_PARAMS_CTRL;
open->params.param_size = sizeof(struct srs_SS3D_ctrl_params);
whd_params = (struct srs_SS3D_ctrl_params *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(whd_params, srs_params,
sizeof(struct srs_SS3D_ctrl_params));
{
struct SS3D *D = (struct SS3D *)whd_params->v;
pr_debug("SRS - ss3d ctrl params\n"
"1 = 0x%08X, 2 = 0x%08X, 3 = 0x%04X,\n"
"4 = 0x%04X, 5 = 0x%04X, 6 = 0x%04X,\n"
"7 = 0x%08X, 8 = 0x%04X, 9 = 0x%04X,\n"
"10 = 0x%04X, 11 = 0x%04X, 12 = 0x%04X,\n"
"13 = 0x%04X, 14 = 0x%04X, 15 = 0x%04X,\n"
"16 = 0x%04X, 17 = 0x%04X, 18 = 0x%04X,\n"
"19 = 0x%04X, 20 = 0x%04X, 21 = 0x%04X,\n"
"22 = 0x%04X, 23 = 0x%04X, 24 = 0x%04X,\n"
"25 = 0x%04X, 26.0 = 0x%04X, 26.1 = 0x%04X,\n"
"26.2 = 0x%04X, 26.3 = 0x%04X,\n"
"26.4 = 0x%04X, 27 = 0x%04X, 28 = 0x%04X,\n"
"29 = 0x%04X, 30 = 0x%04X, 31 = 0x%04X,\n"
"32 = 0x%04X, 33 = 0x%04X, 34 = 0x%08X,\n"
"35 = 0x%08X, 36 = 0x%08X, 37 = 0x%08X,\n"
"38 = 0x%08X, 39 = 0x%08X, 40 = 0x%08X",
D->_1, D->_2, D->_3, D->_4, D->_5, D->_6, D->_7,
D->_8, D->_9, D->_10, D->_11, D->_12, D->_13,
D->_14, D->_15, D->_16, D->_17, D->_18, D->_19,
D->_20, D->_21, D->_22, D->_23, D->_24, D->_25,
D->_26[0], D->_26[1], D->_26[2], D->_26[3],
D->_26[4], D->_27, D->_28, D->_29, D->_30,
D->_31, D->_32, D->_33, D->_34, D->_35, D->_36,
D->_37, D->_38, D->_39, D->_40);
}
break;
}
case SRS_ID_SS3D_FILTER: {
struct srs_SS3D_filter_params *chp_params = NULL;
sz = sizeof(struct asm_pp_params_command) +
sizeof(struct srs_SS3D_filter_params);
open = kzalloc(sz, GFP_KERNEL);
open->payload_size = sizeof(struct srs_SS3D_filter_params) +
sizeof(struct asm_pp_param_data_hdr);
open->params.param_id = SRS_SS3D_PARAMS_FILTER;
open->params.param_size =
sizeof(struct srs_SS3D_filter_params);
chp_params = (struct srs_SS3D_filter_params *)((u8 *)open +
sizeof(struct asm_pp_params_command));
memcpy(chp_params, srs_params,
sizeof(struct srs_SS3D_filter_params));
{
struct SS3D_F *D = (struct SS3D_F *)chp_params->v;
pr_debug("SRS - ss3d filter params\n"
"1 = 0x%08X, 2 = 0x%08X, 3 = 0x%08X\n"
"4 = 0x%08X, 5 = 0x%08X, 6 = 0x%08X\n"
"7 = 0x%08X", D->_1, D->_2, D->_3, D->_4, D->_5,
D->_6, D->_7);
}
break;
}
default:
pr_debug("SRS - bad param!\n");
goto fail_cmd;
}
open->payload = NULL;
open->params.module_id = SRS_SS3D_MODULE_ID;
open->params.reserved = 0;
open->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
open->hdr.pkt_size = sz;
open->hdr.src_svc = APR_SVC_ADM;
open->hdr.src_domain = APR_DOMAIN_APPS;
open->hdr.src_port = port_id;
open->hdr.dest_svc = APR_SVC_ADM;
open->hdr.dest_domain = APR_DOMAIN_ADSP;
index = afe_get_port_index(port_id);
open->hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
open->hdr.token = port_id;
open->hdr.opcode = ADM_CMD_SET_PARAMS;
pr_debug("SRS - %s: Command was sent now check Q6 - port id = %d,\n"
"size %d, module id %x, param id %x.\n",
__func__, open->hdr.dest_port, open->payload_size,
open->params.module_id, open->params.param_id);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)open);
if (ret < 0) {
pr_err("SRS - %s: ADM enable for port %d failed\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait, 1,
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("SRS - %s: ADM open failed for port %d\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
fail_cmd:
kfree(open);
return ret;
}
static int32_t adm_callback(struct apr_client_data *data, void *priv)
{
uint32_t *payload;
int i, index;
payload = data->payload;
if (data->opcode == RESET_EVENTS) {
pr_debug("adm_callback: Reset event is received: %d %d apr[%p]\n",
data->reset_event, data->reset_proc,
this_adm.apr);
if (this_adm.apr) {
apr_reset(this_adm.apr);
for (i = 0; i < AFE_MAX_PORTS; i++) {
atomic_set(&this_adm.copp_id[i],
RESET_COPP_ID);
atomic_set(&this_adm.copp_cnt[i], 0);
atomic_set(&this_adm.copp_stat[i], 0);
}
this_adm.apr = NULL;
}
pr_debug("Resetting calibration blocks");
for (i = 0; i < MAX_AUDPROC_TYPES; i++) {
mem_addr_audproc[i].cal_size = 0;
mem_addr_audproc[i].cal_kvaddr = 0;
mem_addr_audproc[i].cal_paddr = 0;
mem_addr_audvol[i].cal_size = 0;
mem_addr_audvol[i].cal_kvaddr = 0;
mem_addr_audvol[i].cal_paddr = 0;
}
return 0;
}
pr_debug("%s: code = 0x%x %x %x size = %d\n", __func__,
data->opcode, payload[0], payload[1],
data->payload_size);
if (data->payload_size) {
index = afe_get_port_index(data->token);
pr_debug("%s: Port ID %d, index %d\n", __func__,
data->token, index);
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d token %d\n",
__func__, index, data->token);
return 0;
}
if (data->opcode == APR_BASIC_RSP_RESULT) {
pr_debug("APR_BASIC_RSP_RESULT id %x\n", payload[0]);
switch (payload[0]) {
case ADM_CMD_SET_PARAMS:
if (rtac_make_adm_callback(payload,
data->payload_size))
break;
case ADM_CMD_COPP_CLOSE:
case ADM_CMD_MEMORY_MAP:
case ADM_CMD_MEMORY_UNMAP:
case ADM_CMD_MEMORY_MAP_REGIONS:
case ADM_CMD_MEMORY_UNMAP_REGIONS:
case ADM_CMD_MATRIX_MAP_ROUTINGS:
case ADM_CMD_CONNECT_AFE_PORT:
case ADM_CMD_DISCONNECT_AFE_PORT:
case ADM_CMD_CONNECT_AFE_PORT_V2:
case ADM_CMD_MULTI_CHANNEL_COPP_OPEN_V3:
atomic_set(&this_adm.copp_stat[index], 1);
wake_up(&this_adm.wait);
break;
default:
pr_err("%s: Unknown Cmd: 0x%x\n", __func__,
payload[0]);
break;
}
return 0;
}
switch (data->opcode) {
case ADM_CMDRSP_MULTI_CHANNEL_COPP_OPEN_V3:
case ADM_CMDRSP_COPP_OPEN:
case ADM_CMDRSP_MULTI_CHANNEL_COPP_OPEN: {
struct adm_copp_open_respond *open = data->payload;
if (open->copp_id == INVALID_COPP_ID) {
pr_err("%s: invalid coppid rxed %d\n",
__func__, open->copp_id);
atomic_set(&this_adm.copp_stat[index], 1);
wake_up(&this_adm.wait);
break;
}
if (index == IDX_PSEUDOPORT_01)
pseudo_copp[
atomic_read(&this_adm.copp_cnt[index])] =
open->copp_id;
atomic_set(&this_adm.copp_id[index], open->copp_id);
atomic_set(&this_adm.copp_stat[index], 1);
pr_debug("%s: coppid rxed=%d\n", __func__,
open->copp_id);
wake_up(&this_adm.wait);
}
break;
case ADM_CMDRSP_GET_PARAMS:
pr_debug("%s: ADM_CMDRSP_GET_PARAMS\n", __func__);
rtac_make_adm_callback(payload,
data->payload_size);
break;
default:
pr_err("%s: Unknown cmd:0x%x\n", __func__,
data->opcode);
break;
}
}
return 0;
}
int adm_matrix_map(int session_id, int path, int num_copps,
unsigned int *port_id, int copp_id)
{
struct adm_routings_command route;
int ret = 0, i = 0;
int index = afe_get_port_index(copp_id);
int copp_cnt;
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d token %d\n",
__func__, index, copp_id);
return 0;
}
pr_debug("%s: session 0x%x path:%d num_copps:%d port_id[0]:%d\n",
__func__, session_id, path, num_copps, port_id[0]);
route.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
route.hdr.pkt_size = sizeof(route);
route.hdr.src_svc = 0;
route.hdr.src_domain = APR_DOMAIN_APPS;
route.hdr.src_port = copp_id;
route.hdr.dest_svc = APR_SVC_ADM;
route.hdr.dest_domain = APR_DOMAIN_ADSP;
route.hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
route.hdr.token = copp_id;
route.hdr.opcode = ADM_CMD_MATRIX_MAP_ROUTINGS;
route.num_sessions = 1;
route.session[0].id = session_id;
if (num_copps < ADM_MAX_COPPS) {
copp_cnt = num_copps;
} else {
copp_cnt = ADM_MAX_COPPS;
pr_warn("%s: max out routable COPPs\n", __func__);
}
route.session[0].num_copps = copp_cnt;
for (i = 0; i < copp_cnt; i++) {
int tmp;
port_id[i] = afe_convert_virtual_to_portid(port_id[i]);
tmp = afe_get_port_index(port_id[i]);
pr_debug("%s: port_id[%d]: %d, index: %d\n", __func__, i,
port_id[i], tmp);
if (tmp >= 0 && tmp < AFE_MAX_PORTS)
route.session[0].copp_id[i] =
atomic_read(&this_adm.copp_id[tmp]);
}
if (copp_cnt % 2)
route.session[0].copp_id[i] = 0;
switch (path) {
case 0x1:
route.path = AUDIO_RX;
break;
case 0x2:
case 0x3:
route.path = AUDIO_TX;
break;
default:
pr_err("%s: Wrong path set[%d]\n", __func__, path);
break;
}
atomic_set(&this_adm.copp_stat[index], 0);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)&route);
if (ret < 0) {
pr_err("%s: ADM routing for port %d failed\n",
__func__, port_id[0]);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait,
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s: ADM cmd Route failed for port %d\n",
__func__, port_id[0]);
ret = -EINVAL;
goto fail_cmd;
}
for (i = 0; i < num_copps; i++)
send_adm_cal(port_id[i], path);
for (i = 0; i < num_copps; i++) {
int tmp;
tmp = afe_get_port_index(port_id[i]);
if (tmp >= 0 && tmp < AFE_MAX_PORTS)
rtac_add_adm_device(port_id[i],
atomic_read(&this_adm.copp_id[tmp]),
path, session_id);
else
pr_debug("%s: Invalid port index %d",
__func__, tmp);
}
return 0;
fail_cmd:
return ret;
}
int adm_close(int port_id)
{
struct apr_hdr close;
int ret = 0;
int index = 0;
port_id = afe_convert_virtual_to_portid(port_id);
index = afe_get_port_index(port_id);
if (afe_validate_port(port_id) < 0)
return -EINVAL;
pr_debug("%s port_id=%d index %d\n", __func__, port_id, index);
if (!(atomic_read(&this_adm.copp_cnt[index]))) {
pr_err("%s: copp count for port[%d]is 0\n", __func__, port_id);
goto fail_cmd;
}
atomic_dec(&this_adm.copp_cnt[index]);
if (!(atomic_read(&this_adm.copp_cnt[index]))) {
close.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
close.pkt_size = sizeof(close);
close.src_svc = APR_SVC_ADM;
close.src_domain = APR_DOMAIN_APPS;
close.src_port = port_id;
close.dest_svc = APR_SVC_ADM;
close.dest_domain = APR_DOMAIN_ADSP;
close.dest_port = atomic_read(&this_adm.copp_id[index]);
close.token = port_id;
close.opcode = ADM_CMD_COPP_CLOSE;
atomic_set(&this_adm.copp_id[index], RESET_COPP_ID);
atomic_set(&this_adm.copp_stat[index], 0);
pr_debug("%s:coppid %d portid=%d index=%d coppcnt=%d\n",
__func__,
atomic_read(&this_adm.copp_id[index]),
port_id, index,
atomic_read(&this_adm.copp_cnt[index]));
ret = apr_send_pkt(this_adm.apr, (uint32_t *)&close);
if (ret < 0) {
pr_err("%s ADM close failed\n", __func__);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait,
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s: ADM cmd Route failed for port %d\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
rtac_remove_adm_device(port_id);
}
fail_cmd:
return ret;
}
int srs_trumedia_open(int port_id, int srs_tech_id, void *srs_params)
{
struct adm_cmd_set_pp_params_inband_v5 *adm_params = NULL;
int ret = 0, sz = 0;
int index;
pr_debug("SRS - %s", __func__);
switch (srs_tech_id) {
case SRS_ID_GLOBAL: {
struct srs_trumedia_params_GLOBAL *glb_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_GLOBAL);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_GLOBAL) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_GLOBAL);
glb_params = (struct srs_trumedia_params_GLOBAL *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(glb_params, srs_params,
sizeof(struct srs_trumedia_params_GLOBAL));
pr_debug("SRS - %s: Global params - 1 = %x, 2 = %x, 3 = %x, 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x\n",
__func__, (int)glb_params->v1,
(int)glb_params->v2, (int)glb_params->v3,
(int)glb_params->v4, (int)glb_params->v5,
(int)glb_params->v6, (int)glb_params->v7,
(int)glb_params->v8);
break;
}
case SRS_ID_WOWHD: {
struct srs_trumedia_params_WOWHD *whd_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_WOWHD);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_WOWHD) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS_WOWHD;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_WOWHD);
whd_params = (struct srs_trumedia_params_WOWHD *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(whd_params, srs_params,
sizeof(struct srs_trumedia_params_WOWHD));
pr_debug("SRS - %s: WOWHD params - 1 = %x, 2 = %x, 3 = %x, 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x, 9 = %x, 10 = %x, 11 = %x\n",
__func__, (int)whd_params->v1,
(int)whd_params->v2, (int)whd_params->v3,
(int)whd_params->v4, (int)whd_params->v5,
(int)whd_params->v6, (int)whd_params->v7,
(int)whd_params->v8, (int)whd_params->v9,
(int)whd_params->v10, (int)whd_params->v11);
break;
}
case SRS_ID_CSHP: {
struct srs_trumedia_params_CSHP *chp_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_CSHP);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_CSHP) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS_CSHP;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_CSHP);
chp_params = (struct srs_trumedia_params_CSHP *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(chp_params, srs_params,
sizeof(struct srs_trumedia_params_CSHP));
pr_debug("SRS - %s: CSHP params - 1 = %x, 2 = %x, 3 = %x, 4 = %x, 5 = %x, 6 = %x, 7 = %x, 8 = %x, 9 = %x\n",
__func__, (int)chp_params->v1,
(int)chp_params->v2, (int)chp_params->v3,
(int)chp_params->v4, (int)chp_params->v5,
(int)chp_params->v6, (int)chp_params->v7,
(int)chp_params->v8, (int)chp_params->v9);
break;
}
case SRS_ID_HPF: {
struct srs_trumedia_params_HPF *hpf_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_HPF);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_HPF) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS_HPF;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_HPF);
hpf_params = (struct srs_trumedia_params_HPF *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(hpf_params, srs_params,
sizeof(struct srs_trumedia_params_HPF));
pr_debug("SRS - %s: HPF params - 1 = %x\n", __func__,
(int)hpf_params->v1);
break;
}
case SRS_ID_PEQ: {
struct srs_trumedia_params_PEQ *peq_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_PEQ);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_PEQ) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS_PEQ;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_PEQ);
peq_params = (struct srs_trumedia_params_PEQ *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(peq_params, srs_params,
sizeof(struct srs_trumedia_params_PEQ));
pr_debug("SRS - %s: PEQ params - 1 = %x 2 = %x, 3 = %x, 4 = %x\n",
__func__, (int)peq_params->v1,
(int)peq_params->v2, (int)peq_params->v3,
(int)peq_params->v4);
break;
}
case SRS_ID_HL: {
struct srs_trumedia_params_HL *hl_params = NULL;
sz = sizeof(struct adm_cmd_set_pp_params_inband_v5) +
sizeof(struct srs_trumedia_params_HL);
adm_params = kzalloc(sz, GFP_KERNEL);
adm_params->payload_size =
sizeof(struct srs_trumedia_params_HL) +
sizeof(struct adm_param_data_v5);
adm_params->params.param_id = SRS_TRUMEDIA_PARAMS_HL;
adm_params->params.param_size =
sizeof(struct srs_trumedia_params_HL);
hl_params = (struct srs_trumedia_params_HL *)
((u8 *)adm_params +
sizeof(struct adm_cmd_set_pp_params_inband_v5));
memcpy(hl_params, srs_params,
sizeof(struct srs_trumedia_params_HL));
pr_debug("SRS - %s: HL params - 1 = %x, 2 = %x, 3 = %x, 4 = %x, 5 = %x, 6 = %x, 7 = %x\n",
__func__, (int)hl_params->v1,
(int)hl_params->v2, (int)hl_params->v3,
(int)hl_params->v4, (int)hl_params->v5,
(int)hl_params->v6, (int)hl_params->v7);
break;
}
default:
goto fail_cmd;
}
adm_params->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
adm_params->hdr.pkt_size = sz;
adm_params->hdr.src_svc = APR_SVC_ADM;
adm_params->hdr.src_domain = APR_DOMAIN_APPS;
adm_params->hdr.src_port = port_id;
adm_params->hdr.dest_svc = APR_SVC_ADM;
adm_params->hdr.dest_domain = APR_DOMAIN_ADSP;
index = afe_get_port_index(port_id);
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d portid %#x\n",
__func__, index, port_id);
ret = -EINVAL;
goto fail_cmd;
}
adm_params->hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
adm_params->hdr.token = port_id;
adm_params->hdr.opcode = ADM_CMD_SET_PP_PARAMS_V5;
adm_params->payload_addr_lsw = 0;
adm_params->payload_addr_msw = 0;
adm_params->mem_map_handle = 0;
adm_params->params.module_id = SRS_TRUMEDIA_MODULE_ID;
adm_params->params.reserved = 0;
pr_debug("SRS - %s: Command was sent now check Q6 - port id = %d, size %d, module id %x, param id %x.\n",
__func__, adm_params->hdr.dest_port,
adm_params->payload_size, adm_params->params.module_id,
adm_params->params.param_id);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)adm_params);
if (ret < 0) {
pr_err("SRS - %s: ADM enable for port %d failed\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
}
/* Wait for the callback with copp id */
ret = wait_event_timeout(this_adm.wait[index], 1,
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s: SRS set params timed out port = %d\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
fail_cmd:
kfree(adm_params);
return ret;
}
int adm_multi_ch_copp_open(int port_id, int path, int rate, int channel_mode,
int topology, int perfmode)
{
struct adm_multi_ch_copp_open_command open;
int ret = 0;
int index;
pr_debug("%s: port %d path:%d rate:%d channel :%d\n", __func__,
port_id, path, rate, channel_mode);
port_id = afe_convert_virtual_to_portid(port_id);
if (afe_validate_port(port_id) < 0) {
pr_err("%s port idi[%d] is invalid\n", __func__, port_id);
return -ENODEV;
}
index = afe_get_port_index(port_id);
pr_debug("%s: Port ID %d, index %d\n", __func__, port_id, index);
if (this_adm.apr == NULL) {
this_adm.apr = apr_register("ADSP", "ADM", adm_callback,
0xFFFFFFFF, &this_adm);
if (this_adm.apr == NULL) {
pr_err("%s: Unable to register ADM\n", __func__);
ret = -ENODEV;
return ret;
}
rtac_set_adm_handle(this_adm.apr);
}
if (atomic_read(&this_adm.copp_cnt[index]) == 0) {
open.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
open.hdr.pkt_size =
sizeof(struct adm_multi_ch_copp_open_command);
if (perfmode) {
pr_debug("%s Performance mode", __func__);
open.hdr.opcode = ADM_CMD_MULTI_CHANNEL_COPP_OPEN_V3;
open.flags = ADM_MULTI_CH_COPP_OPEN_PERF_MODE_BIT;
open.reserved = PCM_BITS_PER_SAMPLE;
} else {
open.hdr.opcode = ADM_CMD_MULTI_CHANNEL_COPP_OPEN;
open.reserved = 0;
}
memset(open.dev_channel_mapping, 0, 8);
if (channel_mode == 1) {
open.dev_channel_mapping[0] = PCM_CHANNEL_FC;
} else if (channel_mode == 2) {
open.dev_channel_mapping[0] = PCM_CHANNEL_FL;
open.dev_channel_mapping[1] = PCM_CHANNEL_FR;
} else if (channel_mode == 4) {
open.dev_channel_mapping[0] = PCM_CHANNEL_FL;
open.dev_channel_mapping[1] = PCM_CHANNEL_FR;
open.dev_channel_mapping[2] = PCM_CHANNEL_RB;
open.dev_channel_mapping[3] = PCM_CHANNEL_LB;
} else if (channel_mode == 6) {
open.dev_channel_mapping[0] = PCM_CHANNEL_FL;
open.dev_channel_mapping[1] = PCM_CHANNEL_FR;
open.dev_channel_mapping[2] = PCM_CHANNEL_LFE;
open.dev_channel_mapping[3] = PCM_CHANNEL_FC;
open.dev_channel_mapping[4] = PCM_CHANNEL_LB;
open.dev_channel_mapping[5] = PCM_CHANNEL_RB;
} else if (channel_mode == 8) {
open.dev_channel_mapping[0] = PCM_CHANNEL_FL;
open.dev_channel_mapping[1] = PCM_CHANNEL_FR;
open.dev_channel_mapping[2] = PCM_CHANNEL_LFE;
open.dev_channel_mapping[3] = PCM_CHANNEL_FC;
open.dev_channel_mapping[4] = PCM_CHANNEL_LB;
open.dev_channel_mapping[5] = PCM_CHANNEL_RB;
open.dev_channel_mapping[6] = PCM_CHANNEL_FLC;
open.dev_channel_mapping[7] = PCM_CHANNEL_FRC;
} else {
pr_err("%s invalid num_chan %d\n", __func__,
channel_mode);
return -EINVAL;
}
open.hdr.src_svc = APR_SVC_ADM;
open.hdr.src_domain = APR_DOMAIN_APPS;
open.hdr.src_port = port_id;
open.hdr.dest_svc = APR_SVC_ADM;
open.hdr.dest_domain = APR_DOMAIN_ADSP;
open.hdr.dest_port = port_id;
open.hdr.token = port_id;
open.mode = path;
open.endpoint_id1 = port_id;
if (this_adm.ec_ref_rx == 0) {
open.endpoint_id2 = 0xFFFF;
} else if (this_adm.ec_ref_rx && (path != 1)) {
open.endpoint_id2 = this_adm.ec_ref_rx;
this_adm.ec_ref_rx = 0;
}
pr_debug("%s open.endpoint_id1:%d open.endpoint_id2:%d",
__func__, open.endpoint_id1, open.endpoint_id2);
if (path == ADM_PATH_PLAYBACK)
open.topology_id = get_adm_rx_topology();
else {
open.topology_id = get_adm_tx_topology();
if ((open.topology_id ==
VPM_TX_SM_ECNS_COPP_TOPOLOGY) ||
(open.topology_id ==
VPM_TX_DM_FLUENCE_COPP_TOPOLOGY))
rate = 16000;
}
if (open.topology_id == 0)
open.topology_id = topology;
open.channel_config = channel_mode & 0x00FF;
open.rate = rate;
pr_debug("%s: channel_config=%d port_id=%d rate=%d"
" topology_id=0x%X\n", __func__, open.channel_config,
open.endpoint_id1, open.rate,
open.topology_id);
atomic_set(&this_adm.copp_stat[index], 0);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)&open);
if (ret < 0) {
pr_err("%s:ADM enable for port %d failed\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait,
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s ADM open failed for port %d\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
}
}
atomic_inc(&this_adm.copp_cnt[index]);
return 0;
fail_cmd:
return ret;
}
static int send_adm_cal_block(int port_id, struct acdb_cal_block *aud_cal)
{
s32 result = 0;
struct adm_cmd_set_pp_params_v5 adm_params;
int index = afe_get_port_index(port_id);
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d portid %#x\n",
__func__, index, port_id);
return 0;
}
pr_debug("%s: Port id %#x, index %d\n", __func__, port_id, index);
if (!aud_cal || aud_cal->cal_size == 0) {
pr_debug("%s: No ADM cal to send for port_id = %#x!\n",
__func__, port_id);
result = -EINVAL;
goto done;
}
adm_params.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(20), APR_PKT_VER);
adm_params.hdr.pkt_size = APR_PKT_SIZE(APR_HDR_SIZE,
sizeof(adm_params));
adm_params.hdr.src_svc = APR_SVC_ADM;
adm_params.hdr.src_domain = APR_DOMAIN_APPS;
adm_params.hdr.src_port = port_id;
adm_params.hdr.dest_svc = APR_SVC_ADM;
adm_params.hdr.dest_domain = APR_DOMAIN_ADSP;
adm_params.hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
adm_params.hdr.token = port_id;
adm_params.hdr.opcode = ADM_CMD_SET_PP_PARAMS_V5;
adm_params.payload_addr_lsw = aud_cal->cal_paddr;
adm_params.payload_addr_msw = 0;
adm_params.mem_map_handle = atomic_read(&this_adm.mem_map_cal_handles[
atomic_read(&this_adm.mem_map_cal_index)]);
adm_params.payload_size = aud_cal->cal_size;
atomic_set(&this_adm.copp_stat[index], 0);
pr_debug("%s: Sending SET_PARAMS payload = 0x%x, size = %d\n",
__func__, adm_params.payload_addr_lsw,
adm_params.payload_size);
result = apr_send_pkt(this_adm.apr, (uint32_t *)&adm_params);
if (result < 0) {
pr_err("%s: Set params failed port = %#x payload = 0x%x\n",
__func__, port_id, aud_cal->cal_paddr);
result = -EINVAL;
goto done;
}
/* Wait for the callback */
result = wait_event_timeout(this_adm.wait[index],
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!result) {
pr_err("%s: Set params timed out port = %#x, payload = 0x%x\n",
__func__, port_id, aud_cal->cal_paddr);
result = -EINVAL;
goto done;
}
result = 0;
done:
return result;
}
void send_adm_custom_topology(int port_id)
{
struct acdb_cal_block cal_block;
struct cmd_set_topologies adm_top;
int index;
int result;
int size = 4096;
get_adm_custom_topology(&cal_block);
if (cal_block.cal_size == 0) {
pr_debug("%s: no cal to send addr= 0x%x\n",
__func__, cal_block.cal_paddr);
goto done;
}
index = afe_get_port_index(port_id);
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d portid %#x\n",
__func__, index, port_id);
goto done;
}
if (this_adm.set_custom_topology) {
/* specific index 4 for adm topology memory */
atomic_set(&this_adm.mem_map_cal_index, ADM_CUSTOM_TOP_CAL);
/* Only call this once */
this_adm.set_custom_topology = 0;
result = adm_memory_map_regions(GLOBAL_CFG,
&cal_block.cal_paddr, 0, &size, 1);
if (result < 0) {
pr_err("%s: mmap did not work! addr = 0x%x, size = %d\n",
__func__, cal_block.cal_paddr,
cal_block.cal_size);
goto done;
}
}
adm_top.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(20), APR_PKT_VER);
adm_top.hdr.pkt_size = APR_PKT_SIZE(APR_HDR_SIZE,
sizeof(adm_top));
adm_top.hdr.src_svc = APR_SVC_ADM;
adm_top.hdr.src_domain = APR_DOMAIN_APPS;
adm_top.hdr.src_port = port_id;
adm_top.hdr.dest_svc = APR_SVC_ADM;
adm_top.hdr.dest_domain = APR_DOMAIN_ADSP;
adm_top.hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
adm_top.hdr.token = port_id;
adm_top.hdr.opcode = ADM_CMD_ADD_TOPOLOGIES;
adm_top.payload_addr_lsw = cal_block.cal_paddr;
adm_top.payload_addr_msw = 0;
adm_top.mem_map_handle =
atomic_read(&this_adm.mem_map_cal_handles[ADM_CUSTOM_TOP_CAL]);
adm_top.payload_size = cal_block.cal_size;
atomic_set(&this_adm.copp_stat[index], 0);
pr_debug("%s: Sending ADM_CMD_ADD_TOPOLOGIES payload = 0x%x, size = %d\n",
__func__, adm_top.payload_addr_lsw,
adm_top.payload_size);
result = apr_send_pkt(this_adm.apr, (uint32_t *)&adm_top);
if (result < 0) {
pr_err("%s: Set topologies failed port = 0x%x payload = 0x%x\n",
__func__, port_id, cal_block.cal_paddr);
goto done;
}
/* Wait for the callback */
result = wait_event_timeout(this_adm.wait[index],
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!result) {
pr_err("%s: Set topologies timed out port = 0x%x, payload = 0x%x\n",
__func__, port_id, cal_block.cal_paddr);
goto done;
}
done:
return;
}
int adm_dolby_dap_get_params(int port_id, uint32_t module_id, uint32_t param_id,
uint32_t params_length, char *params)
{
struct adm_cmd_get_pp_params_v5 *adm_params = NULL;
int sz, rc = 0, i = 0, index = afe_get_port_index(port_id);
int *params_data = (int *)params;
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d portid %#x\n",
__func__, index, port_id);
return -EINVAL;
}
sz = sizeof(struct adm_cmd_set_pp_params_v5) + params_length;
adm_params = kzalloc(sz, GFP_KERNEL);
if (!adm_params) {
pr_err("%s, adm params memory alloc failed", __func__);
return -ENOMEM;
}
memcpy(((u8 *)adm_params + sizeof(struct adm_cmd_set_pp_params_v5)),
params, params_length);
adm_params->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
adm_params->hdr.pkt_size = sz;
adm_params->hdr.src_svc = APR_SVC_ADM;
adm_params->hdr.src_domain = APR_DOMAIN_APPS;
adm_params->hdr.src_port = port_id;
adm_params->hdr.dest_svc = APR_SVC_ADM;
adm_params->hdr.dest_domain = APR_DOMAIN_ADSP;
adm_params->hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
adm_params->hdr.token = port_id;
adm_params->hdr.opcode = ADM_CMD_GET_PP_PARAMS_V5;
adm_params->data_payload_addr_lsw = 0;
adm_params->data_payload_addr_msw = 0;
adm_params->mem_map_handle = 0;
adm_params->module_id = module_id;
adm_params->param_id = param_id;
adm_params->param_max_size = params_length;
adm_params->reserved = 0;
atomic_set(&this_adm.copp_stat[index], 0);
rc = apr_send_pkt(this_adm.apr, (uint32_t *)adm_params);
if (rc < 0) {
pr_err("%s: Failed to Get DOLBY Params on port %d\n", __func__,
port_id);
rc = -EINVAL;
goto dolby_dap_get_param_return;
}
/* Wait for the callback with copp id */
rc = wait_event_timeout(this_adm.wait[index],
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!rc) {
pr_err("%s: DOLBY get params timed out port = %d\n", __func__,
port_id);
rc = -EINVAL;
goto dolby_dap_get_param_return;
}
if (params_data) {
for (i = 0; i < adm_dolby_get_parameters[0]; i++)
params_data[i] = adm_dolby_get_parameters[1+i];
}
rc = 0;
dolby_dap_get_param_return:
kfree(adm_params);
return rc;
}
int adm_matrix_map(int session_id, int path, int num_copps,
unsigned int *port_id, int copp_id, bool perf_mode)
{
struct adm_cmd_matrix_map_routings_v5 *route;
struct adm_session_map_node_v5 *node;
uint16_t *copps_list;
int cmd_size = 0;
int ret = 0, i = 0;
void *payload = NULL;
void *matrix_map = NULL;
/* Assumes port_ids have already been validated during adm_open */
int index = q6audio_get_port_index(copp_id);
if (index < 0 || index >= AFE_MAX_PORTS) {
pr_err("%s: invalid port idx %d token %d\n",
__func__, index, copp_id);
return 0;
}
cmd_size = (sizeof(struct adm_cmd_matrix_map_routings_v5) +
sizeof(struct adm_session_map_node_v5) +
(sizeof(uint32_t) * num_copps));
matrix_map = kzalloc(cmd_size, GFP_KERNEL);
if (matrix_map == NULL) {
pr_err("%s: Mem alloc failed\n", __func__);
ret = -EINVAL;
return ret;
}
route = (struct adm_cmd_matrix_map_routings_v5 *)matrix_map;
pr_debug("%s: session 0x%x path:%d num_copps:%d port_id[0]:%#x coppid[%d]\n",
__func__, session_id, path, num_copps, port_id[0], copp_id);
route->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
route->hdr.pkt_size = cmd_size;
route->hdr.src_svc = 0;
route->hdr.src_domain = APR_DOMAIN_APPS;
route->hdr.src_port = copp_id;
route->hdr.dest_svc = APR_SVC_ADM;
route->hdr.dest_domain = APR_DOMAIN_ADSP;
if (perf_mode) {
route->hdr.dest_port =
atomic_read(&this_adm.copp_low_latency_id[index]);
} else {
route->hdr.dest_port = atomic_read(&this_adm.copp_id[index]);
}
route->hdr.token = copp_id;
route->hdr.opcode = ADM_CMD_MATRIX_MAP_ROUTINGS_V5;
route->num_sessions = 1;
switch (path) {
case 0x1:
route->matrix_id = ADM_MATRIX_ID_AUDIO_RX;
break;
case 0x2:
case 0x3:
route->matrix_id = ADM_MATRIX_ID_AUDIO_TX;
break;
default:
pr_err("%s: Wrong path set[%d]\n", __func__, path);
break;
}
payload = ((u8 *)matrix_map +
sizeof(struct adm_cmd_matrix_map_routings_v5));
node = (struct adm_session_map_node_v5 *)payload;
node->session_id = session_id;
node->num_copps = num_copps;
payload = (u8 *)node + sizeof(struct adm_session_map_node_v5);
copps_list = (uint16_t *)payload;
for (i = 0; i < num_copps; i++) {
int tmp;
port_id[i] = q6audio_convert_virtual_to_portid(port_id[i]);
tmp = q6audio_get_port_index(port_id[i]);
if (tmp >= 0 && tmp < AFE_MAX_PORTS) {
if (perf_mode)
copps_list[i] =
atomic_read(&this_adm.copp_low_latency_id[tmp]);
else
copps_list[i] =
atomic_read(&this_adm.copp_id[tmp]);
}
else
continue;
pr_debug("%s: port_id[%#x]: %d, index: %d act coppid[0x%x]\n",
__func__, i, port_id[i], tmp,
atomic_read(&this_adm.copp_id[tmp]));
}
atomic_set(&this_adm.copp_stat[index], 0);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)matrix_map);
if (ret < 0) {
pr_err("%s: ADM routing for port %#x failed\n",
__func__, port_id[0]);
ret = -EINVAL;
goto fail_cmd;
}
ret = wait_event_timeout(this_adm.wait[index],
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(TIMEOUT_MS));
if (!ret) {
pr_err("%s: ADM cmd Route failed for port %#x\n",
__func__, port_id[0]);
ret = -EINVAL;
goto fail_cmd;
}
if (!perf_mode) {
for (i = 0; i < num_copps; i++)
send_adm_cal(port_id[i], path);
for (i = 0; i < num_copps; i++) {
int tmp;
tmp = afe_get_port_index(port_id[i]);
if (tmp >= 0 && tmp < AFE_MAX_PORTS) {
rtac_add_adm_device(port_id[i],
atomic_read(&this_adm.copp_id[tmp]),
path, session_id);
pr_debug("%s, copp_id: %d\n", __func__,
atomic_read(&this_adm.copp_id[tmp]));
} else {
pr_debug("%s: Invalid port index %d",
__func__, tmp);
}
}
}
fail_cmd:
kfree(matrix_map);
return ret;
}
int adm_open(int port_id, int path, int rate, int channel_mode, int topology)
{
struct adm_copp_open_command open;
int ret = 0;
int index;
pr_debug("%s: port %d path:%d rate:%d mode:%d\n", __func__,
port_id, path, rate, channel_mode);
port_id = afe_convert_virtual_to_portid(port_id);
if (afe_validate_port(port_id) < 0) {
pr_err("%s port idi[%d] is invalid\n", __func__, port_id);
return -ENODEV;
}
index = afe_get_port_index(port_id);
pr_debug("%s: Port ID %d, index %d\n", __func__, port_id, index);
if (this_adm.apr == NULL) {
this_adm.apr = apr_register("ADSP", "ADM", adm_callback,
0xFFFFFFFF, &this_adm);
if (this_adm.apr == NULL) {
pr_err("%s: Unable to register ADM\n", __func__);
ret = -ENODEV;
return ret;
}
rtac_set_adm_handle(this_adm.apr);
}
/* Create a COPP if port id are not enabled */
if (atomic_read(&this_adm.copp_cnt[index]) == 0) {
open.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER);
open.hdr.pkt_size = sizeof(open);
open.hdr.src_svc = APR_SVC_ADM;
open.hdr.src_domain = APR_DOMAIN_APPS;
open.hdr.src_port = port_id;
open.hdr.dest_svc = APR_SVC_ADM;
open.hdr.dest_domain = APR_DOMAIN_ADSP;
open.hdr.dest_port = port_id;
open.hdr.token = port_id;
open.hdr.opcode = ADM_CMD_COPP_OPEN;
open.mode = path;
open.endpoint_id1 = port_id;
open.endpoint_id2 = 0xFFFF;
/* convert path to acdb path */
if (path == ADM_PATH_PLAYBACK)
open.topology_id = get_adm_rx_topology();
else {
open.topology_id = get_adm_tx_topology();
if ((open.topology_id ==
VPM_TX_SM_ECNS_COPP_TOPOLOGY) ||
(open.topology_id ==
VPM_TX_DM_FLUENCE_COPP_TOPOLOGY))
rate = 16000;
}
if (open.topology_id == 0)
open.topology_id = topology;
open.channel_config = channel_mode & 0x00FF;
open.rate = rate;
pr_debug("%s: channel_config=%d port_id=%d rate=%d\
topology_id=0x%X\n", __func__, open.channel_config,\
open.endpoint_id1, open.rate,\
open.topology_id);
atomic_set(&this_adm.copp_stat[index], 0);
ret = apr_send_pkt(this_adm.apr, (uint32_t *)&open);
if (ret < 0) {
pr_err("%s:ADM enable for port %d failed\n",
__func__, port_id);
ret = -EINVAL;
goto fail_cmd;
}
/* Wait for the callback with copp id */
ret = wait_event_timeout(this_adm.wait,
atomic_read(&this_adm.copp_stat[index]),
msecs_to_jiffies(3 * TIMEOUT_MS));
if (!ret) {
#if 0
pr_err("%s ADM open failed for port %d\n", __func__,
port_id);
ret = -EINVAL;
goto fail_cmd;
#else
// chenjun
pr_err("chenjun:%s ADM open port %d always OK.\n", __func__,
port_id);
#endif
}
}
atomic_inc(&this_adm.copp_cnt[index]);
return 0;
fail_cmd:
return ret;
}
