[PATCH v7 13/24] ASoC: qdsp6: q6adm: Add q6adm driver
Banajit Goswami
bgoswami at codeaurora.org
Wed May 9 00:55:56 PDT 2018
On 5/1/2018 5:08 AM, Srinivas Kandagatla wrote:
> This patch adds support to Q6ADM (Audio Device Manager) module in
> q6dsp. ADM performs routing between audio streams and AFE ports.
> It does Rate matching for streams going to devices driven by
> different clocks, it handles volume ramping, Mixing with channel
> and bit-width. ADM creates and destroys dynamic COPP services
> for device-related audio processing as needed.
>
> This patch adds basic support to ADM.
>
> Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla at linaro.org>
> Reviewed-and-tested-by: Rohit kumar <rohitkr at codeaurora.org>
> ---
> sound/soc/qcom/Kconfig | 4 +
> sound/soc/qcom/qdsp6/Makefile | 1 +
> sound/soc/qcom/qdsp6/q6adm.c | 636 ++++++++++++++++++++++++++++++++++++++++++
> sound/soc/qcom/qdsp6/q6adm.h | 25 ++
> 4 files changed, 666 insertions(+)
> create mode 100644 sound/soc/qcom/qdsp6/q6adm.c
> create mode 100644 sound/soc/qcom/qdsp6/q6adm.h
>
> diff --git a/sound/soc/qcom/Kconfig b/sound/soc/qcom/Kconfig
> index bb0a2afb0563..971127edbc23 100644
> --- a/sound/soc/qcom/Kconfig
> +++ b/sound/soc/qcom/Kconfig
> @@ -50,12 +50,16 @@ config SND_SOC_QDSP6_CORE
> config SND_SOC_QDSP6_AFE
> tristate
<snip>
> +}
> +
> +static int q6adm_callback(struct apr_device *adev, struct apr_resp_pkt *data)
> +{
> + struct aprv2_ibasic_rsp_result_t *result = data->payload;
> + int port_idx, copp_idx;
> + struct apr_hdr *hdr = &data->hdr;
> + struct q6copp *copp;
> + struct q6adm *adm = dev_get_drvdata(&adev->dev);
> +
> + if (!data->payload_size)
> + return 0;
> +
> +
> + copp_idx = (hdr->token) & 0XFF;
> + port_idx = ((hdr->token) >> 16) & 0xFF;
> + if (port_idx < 0 || port_idx >= AFE_MAX_PORTS) {
> + dev_err(&adev->dev, "Invalid port idx %d token %d\n",
> + port_idx, hdr->token);
> + return 0;
> + }
> + if (copp_idx < 0 || copp_idx >= MAX_COPPS_PER_PORT) {
> + dev_err(&adev->dev, "Invalid copp idx %d token %d\n",
> + copp_idx, hdr->token);
> + return 0;
> + }
> +
> + switch (hdr->opcode) {
> + case APR_BASIC_RSP_RESULT: {
> + if (result->status != 0) {
> + dev_err(&adev->dev, "cmd = 0x%x return error = 0x%x\n",
> + result->opcode, result->status);
> + }
> + switch (result->opcode) {
> + case ADM_CMD_DEVICE_OPEN_V5:
> + case ADM_CMD_DEVICE_CLOSE_V5:
> + copp = adm_find_copp(adm, port_idx, copp_idx);
> + if (!copp)
> + return 0;
> +
> + copp->result = *result;
> + wake_up(&copp->wait);
> + break;
> + case ADM_CMD_MATRIX_MAP_ROUTINGS_V5:
> + adm->result = *result;
> + wake_up(&adm->matrix_map_wait);
> + break;
> +
> + default:
> + dev_err(&adev->dev, "Unknown Cmd: 0x%x\n",
> + result->opcode);
> + break;
> + }
> + return 0;
> + }
> + case ADM_CMDRSP_DEVICE_OPEN_V5: {
> + struct adm_cmd_rsp_device_open_v5 {
> + u32 status;
> + u16 copp_id;
> + u16 reserved;
> + } __packed * open = data->payload;
> +
> + open = data->payload;
Isn't this repetition of previous line from struct definition?
> +
> + return c;
> +}
> +
> +static int q6adm_apr_send_copp_pkt(struct q6adm *adm, struct q6copp *copp,
> + struct apr_pkt *pkt, uint32_t rsp_opcode)
> +{
> + struct device *dev = adm->dev;
> + uint32_t opcode = pkt->hdr.opcode;
> + int ret;
> +
> + mutex_lock(&adm->lock);
> + copp->result.opcode = 0;
> + copp->result.status = 0;
> + ret = apr_send_pkt(adm->apr, pkt);
> + if (ret < 0) {
> + dev_err(dev, "Failed to send APR packet\n");
> + ret = -EINVAL;
> + goto err;
> + }
> +
> + /* Wait for the callback with copp id */
> + if (rsp_opcode)
> + ret = wait_event_timeout(copp->wait,
> + (copp->result.opcode == opcode) ||
> + (copp->result.opcode == rsp_opcode),
> + msecs_to_jiffies(TIMEOUT_MS));
> + else
> + ret = wait_event_timeout(copp->wait,
> + (copp->result.opcode == opcode),
> + msecs_to_jiffies(TIMEOUT_MS));
> +
> + if (!ret) {
> + dev_err(dev, "ADM copp cmd timedout\n");
> + ret = -EINVAL;
ret = -ETIMEDOUT;
> + } else if (copp->result.status > 0) {
> + dev_err(dev, "DSP returned error[%d]\n",
> + copp->result.status);
> + ret = -EINVAL;
> + }
> +
> +err:
> + mutex_unlock(&adm->lock);
> + return ret;
> +}
> +
> +static int q6adm_device_close(struct q6adm *adm, struct q6copp *copp,
> + int port_id, int copp_idx)
> +{
> + struct apr_pkt close;
> +
> + close.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
> + APR_HDR_LEN(APR_HDR_SIZE),
> + APR_PKT_VER);
> + close.hdr.pkt_size = sizeof(close);
> + close.hdr.src_port = port_id;
> + close.hdr.dest_port = copp->id;
> + close.hdr.token = port_id << 16 | copp_idx;
> + close.hdr.opcode = ADM_CMD_DEVICE_CLOSE_V5;
> +
> + return q6adm_apr_send_copp_pkt(adm, copp, &close, 0);
> +}
> +
> +static void adm_free_copp(struct kref *ref)
> +{
> + struct q6copp *c = container_of(ref, struct q6copp, refcount);
> + struct q6adm *adm = c->adm;
> + int port_idx = c->afe_port;
> + int copp_idx = c->copp_idx;
> + unsigned long flags;
> + int ret;
> +
> + ret = q6adm_device_close(adm, c, port_idx, copp_idx);
> + if (ret < 0)
> + dev_err(adm->dev, "Failed to close copp %d\n", ret);
> +
> + clear_bit(c->copp_idx, &adm->copp_bitmap[port_idx]);
> + spin_lock_irqsave(&adm->copps_list_lock, flags);
> + list_del(&c->node);
> + spin_unlock_irqrestore(&adm->copps_list_lock, flags);
> + kfree(c);
> +}
> +
> +static struct q6copp *adm_find_matching_copp(struct q6adm *adm,
> + int port_id, int topology,
> + int mode, int rate, int channel_mode,
> + int bit_width, int app_type)
> +{
> + unsigned long flags;
> + struct q6copp *c;
> +
> + spin_lock_irqsave(&adm->copps_list_lock, flags);
> +
> + list_for_each_entry(c, &adm->copps_list, node) {
> + if ((port_id == c->afe_port) && (topology == c->topology) &&
> + (mode == c->mode) && (rate == c->rate) &&
> + (bit_width == c->bit_width) && (app_type == c->app_type)) {
> + spin_unlock_irqrestore(&adm->copps_list_lock, flags);
> + kref_get(&c->refcount);
> + return c;
> + }
> + }
> + spin_unlock_irqrestore(&adm->copps_list_lock, flags);
> +
> + c = adm_alloc_copp(adm, port_id);
> + if (IS_ERR_OR_NULL(c))
> + return ERR_CAST(c);
> +
> + kref_init(&c->refcount);
> + c->topology = topology;
> + c->mode = mode;
> + c->rate = rate;
> + c->channels = channel_mode;
> + c->bit_width = bit_width;
> + c->app_type = app_type;
> +
> + spin_lock_irqsave(&adm->copps_list_lock, flags);
> + list_add_tail(&c->node, &adm->copps_list);
> + spin_unlock_irqrestore(&adm->copps_list_lock, flags);
> +
> + return c;
> +
Remove extra blank line at end of function.
> +}
> +
> +static int q6adm_device_open(struct q6adm *adm, struct q6copp *copp,
> + int port_id, int path, int topology,
> + int channel_mode, int bit_width, int rate)
<snip>
> +
> +/**
> + * q6adm_matrix_map() - Map asm streams and afe ports using payload
> + *
> + * @dev: Pointer to adm child device.
> + * @path: playback or capture path.
> + * @payload_map: map between session id and afe ports.
> + * @perf_mode: Performace mode.
> + *
> + * Return: Will be an negative on error or a zero on success.
> + */
> +int q6adm_matrix_map(struct device *dev, int path,
> + struct route_payload payload_map, int perf_mode)
> +{
> + struct q6adm *adm = dev_get_drvdata(dev->parent);
> + struct q6adm_cmd_matrix_map_routings_v5 *route;
> + struct q6adm_session_map_node_v5 *node;
> + struct apr_pkt *pkt;
> + uint16_t *copps_list;
> + int pkt_size, ret, i, copp_idx;
> + void *matrix_map = NULL;
> + struct q6copp *copp;
> +
> + /* Assumes port_ids have already been validated during adm_open */
> + pkt_size = (APR_HDR_SIZE + sizeof(*route) + sizeof(*node) +
> + (sizeof(uint32_t) * payload_map.num_copps));
> +
> + matrix_map = kzalloc(pkt_size, GFP_KERNEL);
> + if (!matrix_map)
> + return -ENOMEM;
> +
> + pkt = matrix_map;
> + route = matrix_map + APR_HDR_SIZE;
> + node = matrix_map + APR_HDR_SIZE + sizeof(*route);
> + copps_list = matrix_map + APR_HDR_SIZE + sizeof(*route) + sizeof(*node);
> +
> + pkt->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
> + APR_HDR_LEN(APR_HDR_SIZE),
> + APR_PKT_VER);
> + pkt->hdr.pkt_size = pkt_size;
> + pkt->hdr.token = 0;
> + pkt->hdr.opcode = ADM_CMD_MATRIX_MAP_ROUTINGS_V5;
> + route->num_sessions = 1;
> +
> + switch (path) {
> + case ADM_PATH_PLAYBACK:
> + route->matrix_id = ADM_MATRIX_ID_AUDIO_RX;
> + break;
> + case ADM_PATH_LIVE_REC:
> + route->matrix_id = ADM_MATRIX_ID_AUDIO_TX;
> + break;
> + default:
> + dev_err(dev, "Wrong path set[%d]\n", path);
> + break;
> + }
> +
> + node->session_id = payload_map.session_id;
> + node->num_copps = payload_map.num_copps;
> +
> + for (i = 0; i < payload_map.num_copps; i++) {
> + int port_idx = payload_map.port_id[i];
> +
> + if (port_idx < 0) {
> + dev_err(dev, "Invalid port_id 0x%x\n",
> + payload_map.port_id[i]);
> + kfree(pkt);
> + return -EINVAL;
> + }
> + copp_idx = payload_map.copp_idx[i];
> +
> + copp = adm_find_copp(adm, port_idx, copp_idx);
> + if (!copp) {
> + kfree(pkt);
> + return -EINVAL;
> + }
> +
> + copps_list[i] = copp->id;
> + }
> +
> + mutex_lock(&adm->lock);
> + adm->result.status = 0;
> + adm->result.opcode = 0;
> +
> + ret = apr_send_pkt(adm->apr, pkt);
> + if (ret < 0) {
> + dev_err(dev, "routing for syream %d failed ret %d\n",
"stream" typo
> + payload_map.session_id, ret);
> + goto fail_cmd;
> + }
> + ret = wait_event_timeout(adm->matrix_map_wait,
> + adm->result.opcode == pkt->hdr.opcode,
> + msecs_to_jiffies(TIMEOUT_MS));
> + if (!ret) {
> + dev_err(dev, "routing for stream %d failed\n",
> + payload_map.session_id);
> + ret = -ETIMEDOUT;
> + goto fail_cmd;
> + } else if (adm->result.status > 0) {
> + dev_err(dev, "DSP returned error[%d]\n",
> + adm->result.status);
> + ret = -EINVAL;
> + goto fail_cmd;
> + }
> +
> +fail_cmd:
> + mutex_unlock(&adm->lock);
> + kfree(pkt);
> + return ret;
> +}
> +EXPORT_SYMBOL_GPL(q6adm_matrix_map);
> +
> +/**
> + * q6adm_close() - Close adm copp
> + *
> + * @dev: Pointer to adm child device.
> + * @port_id: afe port id.
> + * @perf_mode: perf_mode mode
> + * @copp_idx: copp index to close
> + *
> + * Return: Will be an negative on error or a zero on success.
> + */
> +int q6adm_close(struct device *dev, int port_id, int perf_mode, int copp_idx)
perf_mode unused param. Remove for now. Can be added back when needed.
Otherwise LGTM.
Once fixed above, add acked-by
Acked-by: Banajit Goswami <bgoswami at codeaurora.org>
--
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
a Linux Foundation Collaborative Project
More information about the linux-arm-kernel
mailing list