|
|
@@ -92,6 +92,9 @@ struct afe_ctl {
|
|
|
atomic_t status;
|
|
|
wait_queue_head_t wait[AFE_MAX_PORTS];
|
|
|
wait_queue_head_t wait_wakeup;
|
|
|
+ struct task_struct *task;
|
|
|
+ wait_queue_head_t lpass_core_hw_wait;
|
|
|
+ uint32_t lpass_hw_core_client_hdl;
|
|
|
void (*tx_cb)(uint32_t opcode,
|
|
|
uint32_t token, uint32_t *payload, void *priv);
|
|
|
void (*rx_cb)(uint32_t opcode,
|
|
|
@@ -555,6 +558,16 @@ static int32_t afe_callback(struct apr_client_data *data, void *priv)
|
|
|
return -EINVAL;
|
|
|
} else if (data->opcode == AFE_EVENT_MBHC_DETECTION_SW_WA) {
|
|
|
msm_aud_evt_notifier_call_chain(SWR_WAKE_IRQ_EVENT, NULL);
|
|
|
+ } else if (data->opcode ==
|
|
|
+ AFE_CMD_RSP_REMOTE_LPASS_CORE_HW_VOTE_REQUEST) {
|
|
|
+ uint32_t *payload = data->payload;
|
|
|
+
|
|
|
+ pr_debug("%s: AFE_CMD_RSP_REMOTE_LPASS_CORE_HW_VOTE_REQUEST handle %d\n",
|
|
|
+ __func__, payload[0]);
|
|
|
+ this_afe.lpass_hw_core_client_hdl = payload[0];
|
|
|
+ atomic_set(&this_afe.state, 0);
|
|
|
+ atomic_set(&this_afe.status, 0);
|
|
|
+ wake_up(&this_afe.lpass_core_hw_wait);
|
|
|
} else if (data->payload_size) {
|
|
|
uint32_t *payload;
|
|
|
uint16_t port_id = 0;
|
|
|
@@ -635,6 +648,11 @@ static int32_t afe_callback(struct apr_client_data *data, void *priv)
|
|
|
else
|
|
|
return -EINVAL;
|
|
|
break;
|
|
|
+ case AFE_CMD_REMOTE_LPASS_CORE_HW_VOTE_REQUEST:
|
|
|
+ case AFE_CMD_REMOTE_LPASS_CORE_HW_DEVOTE_REQUEST:
|
|
|
+ atomic_set(&this_afe.state, 0);
|
|
|
+ wake_up(&this_afe.lpass_core_hw_wait);
|
|
|
+ break;
|
|
|
case AFE_SVC_CMD_EVENT_CFG:
|
|
|
atomic_set(&this_afe.state, payload[1]);
|
|
|
wake_up(&this_afe.wait_wakeup);
|
|
|
@@ -8427,6 +8445,7 @@ int __init afe_init(void)
|
|
|
init_waitqueue_head(&this_afe.wait[i]);
|
|
|
}
|
|
|
init_waitqueue_head(&this_afe.wait_wakeup);
|
|
|
+ init_waitqueue_head(&this_afe.lpass_core_hw_wait);
|
|
|
wakeup_source_init(&wl.ws, "spkr-prot");
|
|
|
ret = afe_init_cal_data();
|
|
|
if (ret)
|
|
|
@@ -8498,3 +8517,161 @@ int afe_cal_init_hwdep(void *card)
|
|
|
return ret;
|
|
|
}
|
|
|
EXPORT_SYMBOL(afe_cal_init_hwdep);
|
|
|
+
|
|
|
+/*
|
|
|
+ * afe_vote_lpass_core_hw -
|
|
|
+ * Voting for lpass core hardware
|
|
|
+ *
|
|
|
+ * @hw_block_id: id of the hardware block
|
|
|
+ * @client_name: client name
|
|
|
+ * @client_handle: client handle
|
|
|
+ *
|
|
|
+ */
|
|
|
+int afe_vote_lpass_core_hw(uint32_t hw_block_id, char *client_name,
|
|
|
+ uint32_t *client_handle)
|
|
|
+{
|
|
|
+ struct afe_cmd_remote_lpass_core_hw_vote_request hw_vote_cfg;
|
|
|
+ struct afe_cmd_remote_lpass_core_hw_vote_request *cmd_ptr =
|
|
|
+ &hw_vote_cfg;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ if (!client_handle) {
|
|
|
+ pr_err("%s: Invalid client_handle\n", __func__);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!client_name) {
|
|
|
+ pr_err("%s: Invalid client_name\n", __func__);
|
|
|
+ *client_handle = 0;
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ mutex_lock(&this_afe.afe_cmd_lock);
|
|
|
+
|
|
|
+ memset(cmd_ptr, 0, sizeof(hw_vote_cfg));
|
|
|
+
|
|
|
+ cmd_ptr->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
|
|
|
+ APR_HDR_LEN(APR_HDR_SIZE),
|
|
|
+ APR_PKT_VER);
|
|
|
+ cmd_ptr->hdr.pkt_size = sizeof(hw_vote_cfg);
|
|
|
+ cmd_ptr->hdr.src_port = 0;
|
|
|
+ cmd_ptr->hdr.dest_port = 0;
|
|
|
+ cmd_ptr->hdr.token = 0;
|
|
|
+ cmd_ptr->hdr.opcode = AFE_CMD_REMOTE_LPASS_CORE_HW_VOTE_REQUEST;
|
|
|
+ cmd_ptr->hw_block_id = hw_block_id;
|
|
|
+ strlcpy(cmd_ptr->client_name, client_name,
|
|
|
+ sizeof(cmd_ptr->client_name));
|
|
|
+
|
|
|
+ pr_debug("%s: lpass core hw vote opcode[0x%x] hw id[0x%x]\n",
|
|
|
+ __func__, cmd_ptr->hdr.opcode, cmd_ptr->hw_block_id);
|
|
|
+
|
|
|
+ *client_handle = 0;
|
|
|
+ atomic_set(&this_afe.status, 0);
|
|
|
+ atomic_set(&this_afe.state, 1);
|
|
|
+ ret = apr_send_pkt(this_afe.apr, (uint32_t *) cmd_ptr);
|
|
|
+ if (ret < 0) {
|
|
|
+ pr_err("%s: lpass core hw vote failed %d\n",
|
|
|
+ __func__, ret);
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wait_event_timeout(this_afe.lpass_core_hw_wait,
|
|
|
+ (atomic_read(&this_afe.state) == 0),
|
|
|
+ msecs_to_jiffies(TIMEOUT_MS));
|
|
|
+ if (!ret) {
|
|
|
+ pr_err("%s: timeout. waited for lpass core hw vote\n",
|
|
|
+ __func__);
|
|
|
+ ret = -ETIMEDOUT;
|
|
|
+ goto done;
|
|
|
+ } else {
|
|
|
+ /* set ret to 0 as no timeout happened */
|
|
|
+ ret = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atomic_read(&this_afe.status) > 0) {
|
|
|
+ pr_err("%s: lpass core hw vote cmd failed [%s]\n",
|
|
|
+ __func__, adsp_err_get_err_str(
|
|
|
+ atomic_read(&this_afe.status)));
|
|
|
+ ret = adsp_err_get_lnx_err_code(
|
|
|
+ atomic_read(&this_afe.status));
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ *client_handle = this_afe.lpass_hw_core_client_hdl;
|
|
|
+ pr_debug("%s: lpass_hw_core_client_hdl %d\n", __func__,
|
|
|
+ this_afe.lpass_hw_core_client_hdl);
|
|
|
+done:
|
|
|
+ mutex_unlock(&this_afe.afe_cmd_lock);
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(afe_vote_lpass_core_hw);
|
|
|
+
|
|
|
+/*
|
|
|
+ * afe_unvote_lpass_core_hw -
|
|
|
+ * unvoting for lpass core hardware
|
|
|
+ *
|
|
|
+ * @hw_block_id: id of the hardware block
|
|
|
+ * @client_handle: client handle
|
|
|
+ *
|
|
|
+ */
|
|
|
+int afe_unvote_lpass_core_hw(uint32_t hw_block_id, uint32_t client_handle)
|
|
|
+{
|
|
|
+ struct afe_cmd_remote_lpass_core_hw_devote_request hw_vote_cfg;
|
|
|
+ struct afe_cmd_remote_lpass_core_hw_devote_request *cmd_ptr =
|
|
|
+ &hw_vote_cfg;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ mutex_lock(&this_afe.afe_cmd_lock);
|
|
|
+
|
|
|
+ memset(cmd_ptr, 0, sizeof(hw_vote_cfg));
|
|
|
+
|
|
|
+ cmd_ptr->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
|
|
|
+ APR_HDR_LEN(APR_HDR_SIZE),
|
|
|
+ APR_PKT_VER);
|
|
|
+ cmd_ptr->hdr.pkt_size = sizeof(hw_vote_cfg);
|
|
|
+ cmd_ptr->hdr.src_port = 0;
|
|
|
+ cmd_ptr->hdr.dest_port = 0;
|
|
|
+ cmd_ptr->hdr.token = 0;
|
|
|
+ cmd_ptr->hdr.opcode = AFE_CMD_REMOTE_LPASS_CORE_HW_DEVOTE_REQUEST;
|
|
|
+ cmd_ptr->hw_block_id = hw_block_id;
|
|
|
+ cmd_ptr->client_handle = client_handle;
|
|
|
+
|
|
|
+ pr_debug("%s: lpass core hw unvote opcode[0x%x] hw id[0x%x]\n",
|
|
|
+ __func__, cmd_ptr->hdr.opcode, cmd_ptr->hw_block_id);
|
|
|
+
|
|
|
+ atomic_set(&this_afe.status, 0);
|
|
|
+ atomic_set(&this_afe.state, 1);
|
|
|
+ ret = apr_send_pkt(this_afe.apr, (uint32_t *) cmd_ptr);
|
|
|
+ if (ret < 0) {
|
|
|
+ pr_err("%s: lpass core hw devote failed %d\n",
|
|
|
+ __func__, ret);
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = wait_event_timeout(this_afe.lpass_core_hw_wait,
|
|
|
+ (atomic_read(&this_afe.state) == 0),
|
|
|
+ msecs_to_jiffies(TIMEOUT_MS));
|
|
|
+ if (!ret) {
|
|
|
+ pr_err("%s: timeout. waited for lpass core hw devote\n",
|
|
|
+ __func__);
|
|
|
+ ret = -ETIMEDOUT;
|
|
|
+ goto done;
|
|
|
+ } else {
|
|
|
+ /* set ret to 0 as no timeout happened */
|
|
|
+ ret = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (atomic_read(&this_afe.status) > 0) {
|
|
|
+ pr_err("%s: lpass core hw devote cmd failed [%s]\n",
|
|
|
+ __func__, adsp_err_get_err_str(
|
|
|
+ atomic_read(&this_afe.status)));
|
|
|
+ ret = adsp_err_get_lnx_err_code(
|
|
|
+ atomic_read(&this_afe.status));
|
|
|
+ }
|
|
|
+
|
|
|
+done:
|
|
|
+ mutex_unlock(&this_afe.afe_cmd_lock);
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(afe_unvote_lpass_core_hw);
|
|
|
+
|
Mangesh Kunchamwar