^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) // Copyright (c) 2011-2017, The Linux Foundation. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) // Copyright (c) 2018, Linaro Limited
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/kref.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/soc/qcom/apr.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/wait.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <sound/asound.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "q6adm.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include "q6afe.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include "q6core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include "q6dsp-common.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include "q6dsp-errno.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define ADM_CMD_DEVICE_OPEN_V5 0x00010326
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define ADM_CMDRSP_DEVICE_OPEN_V5 0x00010329
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define ADM_CMD_DEVICE_CLOSE_V5 0x00010327
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define ADM_CMD_MATRIX_MAP_ROUTINGS_V5 0x00010325
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define TIMEOUT_MS 1000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define RESET_COPP_ID 99
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define INVALID_COPP_ID 0xFF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) /* Definition for a legacy device session. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define ADM_LEGACY_DEVICE_SESSION 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define ADM_MATRIX_ID_AUDIO_RX 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define ADM_MATRIX_ID_AUDIO_TX 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct q6copp {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int afe_port;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) int copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) int id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) int topology;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) int mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) int rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) int bit_width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) int channels;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) int app_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) int acdb_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) struct aprv2_ibasic_rsp_result_t result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) struct kref refcount;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) wait_queue_head_t wait;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) struct list_head node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) struct q6adm *adm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct q6adm {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct apr_device *apr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct q6core_svc_api_info ainfo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) unsigned long copp_bitmap[AFE_MAX_PORTS];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) struct list_head copps_list;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) spinlock_t copps_list_lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) struct aprv2_ibasic_rsp_result_t result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) struct mutex lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) wait_queue_head_t matrix_map_wait;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct q6adm_cmd_device_open_v5 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) u16 flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) u16 mode_of_operation;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) u16 endpoint_id_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) u16 endpoint_id_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) u32 topology_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) u16 dev_num_channel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u16 bit_width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) u32 sample_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) u8 dev_channel_mapping[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) struct q6adm_cmd_matrix_map_routings_v5 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) u32 matrix_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) u32 num_sessions;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct q6adm_session_map_node_v5 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) u16 session_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) u16 num_copps;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) static struct q6copp *q6adm_find_copp(struct q6adm *adm, int port_idx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) int copp_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct q6copp *c = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct q6copp *ret = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) spin_lock_irqsave(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) list_for_each_entry(c, &adm->copps_list, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if ((port_idx == c->afe_port) && (copp_idx == c->copp_idx)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) ret = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) kref_get(&c->refcount);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) spin_unlock_irqrestore(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) static void q6adm_free_copp(struct kref *ref)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) struct q6copp *c = container_of(ref, struct q6copp, refcount);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) struct q6adm *adm = c->adm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) spin_lock_irqsave(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) clear_bit(c->copp_idx, &adm->copp_bitmap[c->afe_port]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) list_del(&c->node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) spin_unlock_irqrestore(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) kfree(c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static int q6adm_callback(struct apr_device *adev, struct apr_resp_pkt *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) struct aprv2_ibasic_rsp_result_t *result = data->payload;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) int port_idx, copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) struct apr_hdr *hdr = &data->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) struct q6copp *copp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) struct q6adm *adm = dev_get_drvdata(&adev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if (!data->payload_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) copp_idx = (hdr->token) & 0XFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) port_idx = ((hdr->token) >> 16) & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) if (port_idx < 0 || port_idx >= AFE_MAX_PORTS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) dev_err(&adev->dev, "Invalid port idx %d token %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) port_idx, hdr->token);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (copp_idx < 0 || copp_idx >= MAX_COPPS_PER_PORT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) dev_err(&adev->dev, "Invalid copp idx %d token %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) copp_idx, hdr->token);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) switch (hdr->opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) case APR_BASIC_RSP_RESULT: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) if (result->status != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) dev_err(&adev->dev, "cmd = 0x%x return error = 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) result->opcode, result->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) switch (result->opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) case ADM_CMD_DEVICE_OPEN_V5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) case ADM_CMD_DEVICE_CLOSE_V5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) copp = q6adm_find_copp(adm, port_idx, copp_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) if (!copp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) copp->result = *result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) wake_up(&copp->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) case ADM_CMD_MATRIX_MAP_ROUTINGS_V5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) adm->result = *result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) wake_up(&adm->matrix_map_wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) dev_err(&adev->dev, "Unknown Cmd: 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) result->opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) case ADM_CMDRSP_DEVICE_OPEN_V5: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) struct adm_cmd_rsp_device_open_v5 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) u32 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) u16 copp_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) u16 reserved;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) } __packed * open = data->payload;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) copp = q6adm_find_copp(adm, port_idx, copp_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) if (!copp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) if (open->copp_id == INVALID_COPP_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) dev_err(&adev->dev, "Invalid coppid rxed %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) open->copp_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) copp->result.status = ADSP_EBADPARAM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) wake_up(&copp->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) copp->result.opcode = hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) copp->id = open->copp_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) wake_up(&copp->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) dev_err(&adev->dev, "Unknown cmd:0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) hdr->opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) static struct q6copp *q6adm_alloc_copp(struct q6adm *adm, int port_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) struct q6copp *c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) int idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) idx = find_first_zero_bit(&adm->copp_bitmap[port_idx],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) MAX_COPPS_PER_PORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) if (idx > MAX_COPPS_PER_PORT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return ERR_PTR(-EBUSY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) c = kzalloc(sizeof(*c), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) if (!c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) set_bit(idx, &adm->copp_bitmap[port_idx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) c->copp_idx = idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) c->afe_port = port_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) c->adm = adm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) init_waitqueue_head(&c->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static int q6adm_apr_send_copp_pkt(struct q6adm *adm, struct q6copp *copp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct apr_pkt *pkt, uint32_t rsp_opcode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) struct device *dev = adm->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) uint32_t opcode = pkt->hdr.opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) mutex_lock(&adm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) copp->result.opcode = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) copp->result.status = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) ret = apr_send_pkt(adm->apr, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) dev_err(dev, "Failed to send APR packet\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) /* Wait for the callback with copp id */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) if (rsp_opcode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) ret = wait_event_timeout(copp->wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) (copp->result.opcode == opcode) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) (copp->result.opcode == rsp_opcode),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) msecs_to_jiffies(TIMEOUT_MS));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) ret = wait_event_timeout(copp->wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) (copp->result.opcode == opcode),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) msecs_to_jiffies(TIMEOUT_MS));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) dev_err(dev, "ADM copp cmd timedout\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) ret = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) } else if (copp->result.status > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) dev_err(dev, "DSP returned error[%d]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) copp->result.status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) mutex_unlock(&adm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) static int q6adm_device_close(struct q6adm *adm, struct q6copp *copp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) int port_id, int copp_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) struct apr_pkt close;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) close.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) APR_HDR_LEN(APR_HDR_SIZE),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) APR_PKT_VER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) close.hdr.pkt_size = sizeof(close);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) close.hdr.src_port = port_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) close.hdr.dest_port = copp->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) close.hdr.token = port_id << 16 | copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) close.hdr.opcode = ADM_CMD_DEVICE_CLOSE_V5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) return q6adm_apr_send_copp_pkt(adm, copp, &close, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) static struct q6copp *q6adm_find_matching_copp(struct q6adm *adm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) int port_id, int topology,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) int mode, int rate,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) int channel_mode, int bit_width,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) int app_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) struct q6copp *c = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) struct q6copp *ret = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) spin_lock_irqsave(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) list_for_each_entry(c, &adm->copps_list, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) if ((port_id == c->afe_port) && (topology == c->topology) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) (mode == c->mode) && (rate == c->rate) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) (bit_width == c->bit_width) && (app_type == c->app_type)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) ret = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) kref_get(&c->refcount);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) spin_unlock_irqrestore(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static int q6adm_device_open(struct q6adm *adm, struct q6copp *copp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) int port_id, int path, int topology,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) int channel_mode, int bit_width, int rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) struct q6adm_cmd_device_open_v5 *open;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) int afe_port = q6afe_get_port_id(port_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) struct apr_pkt *pkt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) void *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) int ret, pkt_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) pkt_size = APR_HDR_SIZE + sizeof(*open);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) p = kzalloc(pkt_size, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) if (!p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) pkt = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) open = p + APR_HDR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) pkt->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) APR_HDR_LEN(APR_HDR_SIZE),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) APR_PKT_VER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) pkt->hdr.pkt_size = pkt_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) pkt->hdr.src_port = afe_port;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) pkt->hdr.dest_port = afe_port;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) pkt->hdr.token = port_id << 16 | copp->copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) pkt->hdr.opcode = ADM_CMD_DEVICE_OPEN_V5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) open->flags = ADM_LEGACY_DEVICE_SESSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) open->mode_of_operation = path;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) open->endpoint_id_1 = afe_port;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) open->topology_id = topology;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) open->dev_num_channel = channel_mode & 0x00FF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) open->bit_width = bit_width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) open->sample_rate = rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) ret = q6dsp_map_channels(&open->dev_channel_mapping[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) channel_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) ret = q6adm_apr_send_copp_pkt(adm, copp, pkt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) ADM_CMDRSP_DEVICE_OPEN_V5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) kfree(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) * q6adm_open() - open adm and grab a free copp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) * @dev: Pointer to adm child device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) * @port_id: port id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) * @path: playback or capture path.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) * @rate: rate at which copp is required.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) * @channel_mode: channel mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * @topology: adm topology id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) * @perf_mode: performace mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) * @bit_width: audio sample bit width
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) * @app_type: Application type.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) * @acdb_id: ACDB id
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) * Return: Will be an negative on error or a valid copp pointer on success.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) struct q6copp *q6adm_open(struct device *dev, int port_id, int path, int rate,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) int channel_mode, int topology, int perf_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) uint16_t bit_width, int app_type, int acdb_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) struct q6adm *adm = dev_get_drvdata(dev->parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) struct q6copp *copp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (port_id < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) dev_err(dev, "Invalid port_id 0x%x\n", port_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) return ERR_PTR(-EINVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) copp = q6adm_find_matching_copp(adm, port_id, topology, perf_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) rate, channel_mode, bit_width, app_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (copp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) dev_err(dev, "Found Matching Copp 0x%x\n", copp->copp_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) return copp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) spin_lock_irqsave(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) copp = q6adm_alloc_copp(adm, port_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) if (IS_ERR(copp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) spin_unlock_irqrestore(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return ERR_CAST(copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) list_add_tail(&copp->node, &adm->copps_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) spin_unlock_irqrestore(&adm->copps_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) kref_init(&copp->refcount);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) copp->topology = topology;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) copp->mode = perf_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) copp->rate = rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) copp->channels = channel_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) copp->bit_width = bit_width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) copp->app_type = app_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) ret = q6adm_device_open(adm, copp, port_id, path, topology,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) channel_mode, bit_width, rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) return ERR_PTR(ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) return copp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) EXPORT_SYMBOL_GPL(q6adm_open);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) * q6adm_get_copp_id() - get copp index
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) * @copp: Pointer to valid copp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) * Return: Will be an negative on error or a valid copp index on success.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) int q6adm_get_copp_id(struct q6copp *copp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) if (!copp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) return copp->copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) EXPORT_SYMBOL_GPL(q6adm_get_copp_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) * q6adm_matrix_map() - Map asm streams and afe ports using payload
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) * @dev: Pointer to adm child device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) * @path: playback or capture path.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) * @payload_map: map between session id and afe ports.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) * @perf_mode: Performace mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) * Return: Will be an negative on error or a zero on success.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) int q6adm_matrix_map(struct device *dev, int path,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) struct route_payload payload_map, int perf_mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) struct q6adm *adm = dev_get_drvdata(dev->parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) struct q6adm_cmd_matrix_map_routings_v5 *route;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) struct q6adm_session_map_node_v5 *node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) struct apr_pkt *pkt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) uint16_t *copps_list;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) int pkt_size, ret, i, copp_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) void *matrix_map = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) struct q6copp *copp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) /* Assumes port_ids have already been validated during adm_open */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) pkt_size = (APR_HDR_SIZE + sizeof(*route) + sizeof(*node) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) (sizeof(uint32_t) * payload_map.num_copps));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) matrix_map = kzalloc(pkt_size, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) if (!matrix_map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) pkt = matrix_map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) route = matrix_map + APR_HDR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) node = matrix_map + APR_HDR_SIZE + sizeof(*route);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) copps_list = matrix_map + APR_HDR_SIZE + sizeof(*route) + sizeof(*node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) pkt->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) APR_HDR_LEN(APR_HDR_SIZE),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) APR_PKT_VER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) pkt->hdr.pkt_size = pkt_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) pkt->hdr.token = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) pkt->hdr.opcode = ADM_CMD_MATRIX_MAP_ROUTINGS_V5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) route->num_sessions = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) switch (path) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) case ADM_PATH_PLAYBACK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) route->matrix_id = ADM_MATRIX_ID_AUDIO_RX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) case ADM_PATH_LIVE_REC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) route->matrix_id = ADM_MATRIX_ID_AUDIO_TX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) dev_err(dev, "Wrong path set[%d]\n", path);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) node->session_id = payload_map.session_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) node->num_copps = payload_map.num_copps;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) for (i = 0; i < payload_map.num_copps; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) int port_idx = payload_map.port_id[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) if (port_idx < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) dev_err(dev, "Invalid port_id 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) payload_map.port_id[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) kfree(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) copp_idx = payload_map.copp_idx[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) copp = q6adm_find_copp(adm, port_idx, copp_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) if (!copp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) kfree(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) copps_list[i] = copp->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) mutex_lock(&adm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) adm->result.status = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) adm->result.opcode = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) ret = apr_send_pkt(adm->apr, pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) dev_err(dev, "routing for stream %d failed ret %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) payload_map.session_id, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) goto fail_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) ret = wait_event_timeout(adm->matrix_map_wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) adm->result.opcode == pkt->hdr.opcode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) msecs_to_jiffies(TIMEOUT_MS));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) dev_err(dev, "routing for stream %d failed\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) payload_map.session_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) ret = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) goto fail_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) } else if (adm->result.status > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) dev_err(dev, "DSP returned error[%d]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) adm->result.status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) goto fail_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) fail_cmd:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) mutex_unlock(&adm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) kfree(pkt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) EXPORT_SYMBOL_GPL(q6adm_matrix_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) * q6adm_close() - Close adm copp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) * @dev: Pointer to adm child device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) * @copp: pointer to previously opened copp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) * Return: Will be an negative on error or a zero on success.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) int q6adm_close(struct device *dev, struct q6copp *copp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) struct q6adm *adm = dev_get_drvdata(dev->parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) ret = q6adm_device_close(adm, copp, copp->afe_port, copp->copp_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) dev_err(adm->dev, "Failed to close copp %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) kref_put(&copp->refcount, q6adm_free_copp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) EXPORT_SYMBOL_GPL(q6adm_close);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) static int q6adm_probe(struct apr_device *adev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) struct device *dev = &adev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) struct q6adm *adm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) adm = devm_kzalloc(dev, sizeof(*adm), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) if (!adm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) adm->apr = adev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) dev_set_drvdata(dev, adm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) adm->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) q6core_get_svc_api_info(adev->svc_id, &adm->ainfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) mutex_init(&adm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) init_waitqueue_head(&adm->matrix_map_wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) INIT_LIST_HEAD(&adm->copps_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) spin_lock_init(&adm->copps_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) return of_platform_populate(dev->of_node, NULL, NULL, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) static int q6adm_remove(struct apr_device *adev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) of_platform_depopulate(&adev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) static const struct of_device_id q6adm_device_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) { .compatible = "qcom,q6adm" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) MODULE_DEVICE_TABLE(of, q6adm_device_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) static struct apr_driver qcom_q6adm_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) .probe = q6adm_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) .remove = q6adm_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) .callback = q6adm_callback,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) .name = "qcom-q6adm",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) .of_match_table = of_match_ptr(q6adm_device_id),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) module_apr_driver(qcom_q6adm_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) MODULE_DESCRIPTION("Q6 Audio Device Manager");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags