Vignesh Kulothungan | 65b7a17 | 2017-12-12 17:33:24 -0800 | [diff] [blame] | 1 | /* Copyright (c) 2012-2018, The Linux Foundation. All rights reserved. |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 2 | * |
| 3 | * This program is free software; you can redistribute it and/or modify |
| 4 | * it under the terms of the GNU General Public License version 2 and |
| 5 | * only version 2 as published by the Free Software Foundation. |
| 6 | * |
| 7 | * This program is distributed in the hope that it will be useful, |
| 8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 10 | * GNU General Public License for more details. |
| 11 | */ |
| 12 | |
| 13 | #include <linux/kernel.h> |
| 14 | #include <linux/module.h> |
| 15 | #include <linux/string.h> |
| 16 | #include <linux/types.h> |
| 17 | #include <linux/spinlock.h> |
| 18 | #include <linux/mutex.h> |
| 19 | #include <linux/sched.h> |
| 20 | #include <linux/slab.h> |
Laxminath Kasam | 605b42f | 2017-08-01 22:02:15 +0530 | [diff] [blame] | 21 | #include <dsp/q6core.h> |
| 22 | #include <dsp/audio_cal_utils.h> |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 23 | #include <dsp/apr_audio-v2.h> |
Laxminath Kasam | 605b42f | 2017-08-01 22:02:15 +0530 | [diff] [blame] | 24 | #include <ipc/apr.h> |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 25 | #include "adsp_err.h" |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 26 | |
| 27 | #define TIMEOUT_MS 1000 |
| 28 | /* |
| 29 | * AVS bring up in the modem is optimitized for the new |
| 30 | * Sub System Restart design and 100 milliseconds timeout |
| 31 | * is sufficient to make sure the Q6 will be ready. |
| 32 | */ |
| 33 | #define Q6_READY_TIMEOUT_MS 100 |
| 34 | |
| 35 | enum { |
| 36 | META_CAL, |
| 37 | CUST_TOP_CAL, |
| 38 | CORE_MAX_CAL |
| 39 | }; |
| 40 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 41 | enum ver_query_status { |
| 42 | VER_QUERY_UNATTEMPTED, |
| 43 | VER_QUERY_UNSUPPORTED, |
| 44 | VER_QUERY_SUPPORTED |
| 45 | }; |
| 46 | |
| 47 | struct q6core_avcs_ver_info { |
| 48 | enum ver_query_status status; |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 49 | struct avcs_fwk_ver_info *ver_info; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 50 | }; |
| 51 | |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 52 | struct q6core_str { |
| 53 | struct apr_svc *core_handle_q; |
| 54 | wait_queue_head_t bus_bw_req_wait; |
| 55 | wait_queue_head_t cmd_req_wait; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 56 | wait_queue_head_t avcs_fwk_ver_req_wait; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 57 | u32 bus_bw_resp_received; |
| 58 | enum cmd_flags { |
| 59 | FLAG_NONE, |
| 60 | FLAG_CMDRSP_LICENSE_RESULT |
| 61 | } cmd_resp_received_flag; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 62 | u32 avcs_fwk_ver_resp_received; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 63 | struct mutex cmd_lock; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 64 | struct mutex ver_lock; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 65 | union { |
| 66 | struct avcs_cmdrsp_get_license_validation_result |
| 67 | cmdrsp_license_result; |
| 68 | } cmd_resp_payload; |
| 69 | u32 param; |
| 70 | struct cal_type_data *cal_data[CORE_MAX_CAL]; |
| 71 | uint32_t mem_map_cal_handle; |
| 72 | int32_t adsp_status; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 73 | struct q6core_avcs_ver_info q6core_avcs_ver_info; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 74 | }; |
| 75 | |
| 76 | static struct q6core_str q6core_lcl; |
| 77 | |
| 78 | struct generic_get_data_ { |
| 79 | int valid; |
| 80 | int size_in_ints; |
| 81 | int ints[]; |
| 82 | }; |
| 83 | static struct generic_get_data_ *generic_get_data; |
| 84 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 85 | static int parse_fwk_version_info(uint32_t *payload) |
| 86 | { |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 87 | size_t ver_size; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 88 | int num_services; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 89 | |
| 90 | pr_debug("%s: Payload info num services %d\n", |
| 91 | __func__, payload[4]); |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 92 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 93 | /* |
| 94 | * payload1[4] is the number of services running on DSP |
| 95 | * Based on this info, we copy the payload into core |
| 96 | * avcs version info structure. |
| 97 | */ |
| 98 | num_services = payload[4]; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 99 | if (num_services > VSS_MAX_AVCS_NUM_SERVICES) { |
| 100 | pr_err("%s: num_services: %d greater than max services: %d\n", |
| 101 | __func__, num_services, VSS_MAX_AVCS_NUM_SERVICES); |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 102 | return -EINVAL; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 103 | } |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 104 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 105 | /* |
| 106 | * Dynamically allocate memory for all |
| 107 | * the services based on num_services |
| 108 | */ |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 109 | ver_size = sizeof(struct avcs_get_fwk_version) + |
| 110 | num_services * sizeof(struct avs_svc_api_info); |
Aditya Bavanari | 9ae2dde | 2018-01-09 11:35:29 +0530 | [diff] [blame] | 111 | |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 112 | q6core_lcl.q6core_avcs_ver_info.ver_info = |
| 113 | kzalloc(ver_size, GFP_ATOMIC); |
| 114 | if (q6core_lcl.q6core_avcs_ver_info.ver_info == NULL) |
| 115 | return -ENOMEM; |
| 116 | |
| 117 | memcpy(q6core_lcl.q6core_avcs_ver_info.ver_info, (uint8_t *) payload, |
| 118 | ver_size); |
| 119 | return 0; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 120 | } |
| 121 | |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 122 | static int32_t aprv2_core_fn_q(struct apr_client_data *data, void *priv) |
| 123 | { |
| 124 | uint32_t *payload1; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 125 | int ret = 0; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 126 | |
| 127 | if (data == NULL) { |
| 128 | pr_err("%s: data argument is null\n", __func__); |
| 129 | return -EINVAL; |
| 130 | } |
| 131 | |
| 132 | pr_debug("%s: core msg: payload len = %u, apr resp opcode = 0x%x\n", |
| 133 | __func__, |
| 134 | data->payload_size, data->opcode); |
| 135 | |
| 136 | switch (data->opcode) { |
| 137 | |
| 138 | case APR_BASIC_RSP_RESULT:{ |
| 139 | |
| 140 | if (data->payload_size == 0) { |
| 141 | pr_err("%s: APR_BASIC_RSP_RESULT No Payload ", |
| 142 | __func__); |
| 143 | return 0; |
| 144 | } |
| 145 | |
| 146 | payload1 = data->payload; |
| 147 | |
| 148 | switch (payload1[0]) { |
| 149 | |
| 150 | case AVCS_CMD_SHARED_MEM_UNMAP_REGIONS: |
| 151 | pr_debug("%s: Cmd = AVCS_CMD_SHARED_MEM_UNMAP_REGIONS status[0x%x]\n", |
| 152 | __func__, payload1[1]); |
| 153 | q6core_lcl.bus_bw_resp_received = 1; |
| 154 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 155 | break; |
| 156 | case AVCS_CMD_SHARED_MEM_MAP_REGIONS: |
| 157 | pr_debug("%s: Cmd = AVCS_CMD_SHARED_MEM_MAP_REGIONS status[0x%x]\n", |
| 158 | __func__, payload1[1]); |
| 159 | q6core_lcl.bus_bw_resp_received = 1; |
| 160 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 161 | break; |
| 162 | case AVCS_CMD_REGISTER_TOPOLOGIES: |
| 163 | pr_debug("%s: Cmd = AVCS_CMD_REGISTER_TOPOLOGIES status[0x%x]\n", |
| 164 | __func__, payload1[1]); |
| 165 | /* -ADSP status to match Linux error standard */ |
| 166 | q6core_lcl.adsp_status = -payload1[1]; |
| 167 | q6core_lcl.bus_bw_resp_received = 1; |
| 168 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 169 | break; |
| 170 | case AVCS_CMD_DEREGISTER_TOPOLOGIES: |
| 171 | pr_debug("%s: Cmd = AVCS_CMD_DEREGISTER_TOPOLOGIES status[0x%x]\n", |
| 172 | __func__, payload1[1]); |
| 173 | q6core_lcl.bus_bw_resp_received = 1; |
| 174 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 175 | break; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 176 | case AVCS_CMD_GET_FWK_VERSION: |
| 177 | pr_debug("%s: Cmd = AVCS_CMD_GET_FWK_VERSION status[%s]\n", |
| 178 | __func__, adsp_err_get_err_str(payload1[1])); |
| 179 | /* ADSP status to match Linux error standard */ |
| 180 | q6core_lcl.adsp_status = -payload1[1]; |
| 181 | if (payload1[1] == ADSP_EUNSUPPORTED) |
| 182 | q6core_lcl.q6core_avcs_ver_info.status = |
| 183 | VER_QUERY_UNSUPPORTED; |
| 184 | q6core_lcl.avcs_fwk_ver_resp_received = 1; |
| 185 | wake_up(&q6core_lcl.avcs_fwk_ver_req_wait); |
| 186 | break; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 187 | default: |
| 188 | pr_err("%s: Invalid cmd rsp[0x%x][0x%x] opcode %d\n", |
| 189 | __func__, |
| 190 | payload1[0], payload1[1], data->opcode); |
| 191 | break; |
| 192 | } |
| 193 | break; |
| 194 | } |
| 195 | |
| 196 | case RESET_EVENTS:{ |
| 197 | pr_debug("%s: Reset event received in Core service\n", |
| 198 | __func__); |
Tanya Dixit | 861a8fa | 2017-09-12 15:38:21 +0530 | [diff] [blame] | 199 | /* |
| 200 | * no reset for q6core_avcs_ver_info done as |
| 201 | * the data will not change after SSR |
| 202 | */ |
| 203 | apr_reset(q6core_lcl.core_handle_q); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 204 | q6core_lcl.core_handle_q = NULL; |
| 205 | break; |
| 206 | } |
| 207 | case AVCS_CMDRSP_SHARED_MEM_MAP_REGIONS: |
| 208 | payload1 = data->payload; |
| 209 | pr_debug("%s: AVCS_CMDRSP_SHARED_MEM_MAP_REGIONS handle %d\n", |
| 210 | __func__, payload1[0]); |
| 211 | q6core_lcl.mem_map_cal_handle = payload1[0]; |
| 212 | q6core_lcl.bus_bw_resp_received = 1; |
| 213 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 214 | break; |
| 215 | case AVCS_CMDRSP_ADSP_EVENT_GET_STATE: |
| 216 | payload1 = data->payload; |
| 217 | q6core_lcl.param = payload1[0]; |
| 218 | pr_debug("%s: Received ADSP get state response 0x%x\n", |
| 219 | __func__, q6core_lcl.param); |
| 220 | /* ensure .param is updated prior to .bus_bw_resp_received */ |
| 221 | wmb(); |
| 222 | q6core_lcl.bus_bw_resp_received = 1; |
| 223 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 224 | break; |
| 225 | case AVCS_CMDRSP_GET_LICENSE_VALIDATION_RESULT: |
| 226 | payload1 = data->payload; |
| 227 | pr_debug("%s: cmd = LICENSE_VALIDATION_RESULT, result = 0x%x\n", |
| 228 | __func__, payload1[0]); |
| 229 | q6core_lcl.cmd_resp_payload.cmdrsp_license_result.result |
| 230 | = payload1[0]; |
| 231 | q6core_lcl.cmd_resp_received_flag = FLAG_CMDRSP_LICENSE_RESULT; |
| 232 | wake_up(&q6core_lcl.cmd_req_wait); |
| 233 | break; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 234 | case AVCS_CMDRSP_GET_FWK_VERSION: |
| 235 | pr_debug("%s: Received AVCS_CMDRSP_GET_FWK_VERSION\n", |
| 236 | __func__); |
| 237 | payload1 = data->payload; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 238 | ret = parse_fwk_version_info(payload1); |
Vignesh Kulothungan | 65b7a17 | 2017-12-12 17:33:24 -0800 | [diff] [blame] | 239 | if (ret < 0) { |
| 240 | q6core_lcl.adsp_status = ret; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 241 | pr_err("%s: Failed to parse payload:%d\n", |
| 242 | __func__, ret); |
Vignesh Kulothungan | 65b7a17 | 2017-12-12 17:33:24 -0800 | [diff] [blame] | 243 | } else { |
| 244 | q6core_lcl.q6core_avcs_ver_info.status = |
| 245 | VER_QUERY_SUPPORTED; |
| 246 | } |
Aditya Bavanari | 9ae2dde | 2018-01-09 11:35:29 +0530 | [diff] [blame] | 247 | q6core_lcl.avcs_fwk_ver_resp_received = 1; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 248 | wake_up(&q6core_lcl.avcs_fwk_ver_req_wait); |
| 249 | break; |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 250 | default: |
| 251 | pr_err("%s: Message id from adsp core svc: 0x%x\n", |
| 252 | __func__, data->opcode); |
| 253 | if (generic_get_data) { |
| 254 | generic_get_data->valid = 1; |
| 255 | generic_get_data->size_in_ints = |
| 256 | data->payload_size/sizeof(int); |
| 257 | pr_debug("callback size = %i\n", |
| 258 | data->payload_size); |
| 259 | memcpy(generic_get_data->ints, data->payload, |
| 260 | data->payload_size); |
| 261 | q6core_lcl.bus_bw_resp_received = 1; |
| 262 | wake_up(&q6core_lcl.bus_bw_req_wait); |
| 263 | break; |
| 264 | } |
| 265 | break; |
| 266 | } |
| 267 | |
| 268 | return 0; |
| 269 | } |
| 270 | |
| 271 | void ocm_core_open(void) |
| 272 | { |
| 273 | if (q6core_lcl.core_handle_q == NULL) |
| 274 | q6core_lcl.core_handle_q = apr_register("ADSP", "CORE", |
| 275 | aprv2_core_fn_q, 0xFFFFFFFF, NULL); |
| 276 | pr_debug("%s: Open_q %pK\n", __func__, q6core_lcl.core_handle_q); |
| 277 | if (q6core_lcl.core_handle_q == NULL) |
Laxminath Kasam | c188070 | 2018-04-04 10:59:57 +0530 | [diff] [blame^] | 278 | pr_err_ratelimited("%s: Unable to register CORE\n", __func__); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 279 | } |
| 280 | |
| 281 | struct cal_block_data *cal_utils_get_cal_block_by_key( |
| 282 | struct cal_type_data *cal_type, uint32_t key) |
| 283 | { |
| 284 | struct list_head *ptr, *next; |
| 285 | struct cal_block_data *cal_block = NULL; |
| 286 | struct audio_cal_info_metainfo *metainfo; |
| 287 | |
| 288 | list_for_each_safe(ptr, next, |
| 289 | &cal_type->cal_blocks) { |
| 290 | |
| 291 | cal_block = list_entry(ptr, |
| 292 | struct cal_block_data, list); |
| 293 | metainfo = (struct audio_cal_info_metainfo *) |
| 294 | cal_block->cal_info; |
| 295 | if (metainfo->nKey != key) { |
| 296 | pr_debug("%s: metainfo key mismatch!!! found:%x, needed:%x\n", |
| 297 | __func__, metainfo->nKey, key); |
| 298 | } else { |
| 299 | pr_debug("%s: metainfo key match found", __func__); |
| 300 | return cal_block; |
| 301 | } |
| 302 | } |
| 303 | return NULL; |
| 304 | } |
| 305 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 306 | static int q6core_send_get_avcs_fwk_ver_cmd(void) |
| 307 | { |
| 308 | struct apr_hdr avcs_ver_cmd; |
| 309 | int ret; |
| 310 | |
| 311 | avcs_ver_cmd.hdr_field = |
| 312 | APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, APR_HDR_LEN(APR_HDR_SIZE), |
| 313 | APR_PKT_VER); |
| 314 | avcs_ver_cmd.pkt_size = sizeof(struct apr_hdr); |
| 315 | avcs_ver_cmd.src_port = 0; |
| 316 | avcs_ver_cmd.dest_port = 0; |
| 317 | avcs_ver_cmd.token = 0; |
| 318 | avcs_ver_cmd.opcode = AVCS_CMD_GET_FWK_VERSION; |
| 319 | |
| 320 | q6core_lcl.adsp_status = 0; |
| 321 | q6core_lcl.avcs_fwk_ver_resp_received = 0; |
| 322 | |
| 323 | ret = apr_send_pkt(q6core_lcl.core_handle_q, |
| 324 | (uint32_t *) &avcs_ver_cmd); |
| 325 | if (ret < 0) { |
| 326 | pr_err("%s: failed to send apr packet, ret=%d\n", __func__, |
| 327 | ret); |
| 328 | goto done; |
| 329 | } |
| 330 | |
| 331 | ret = wait_event_timeout(q6core_lcl.avcs_fwk_ver_req_wait, |
| 332 | (q6core_lcl.avcs_fwk_ver_resp_received == 1), |
| 333 | msecs_to_jiffies(TIMEOUT_MS)); |
| 334 | if (!ret) { |
| 335 | pr_err("%s: wait_event timeout for AVCS fwk version info\n", |
| 336 | __func__); |
| 337 | ret = -ETIMEDOUT; |
| 338 | goto done; |
| 339 | } |
| 340 | |
| 341 | if (q6core_lcl.adsp_status < 0) { |
| 342 | /* |
| 343 | * adsp_err_get_err_str expects a positive value but we store |
| 344 | * the DSP error as negative to match the Linux error standard. |
| 345 | * Pass in the negated value so adsp_err_get_err_str returns |
| 346 | * the correct string. |
| 347 | */ |
| 348 | pr_err("%s: DSP returned error[%s]\n", __func__, |
| 349 | adsp_err_get_err_str(-q6core_lcl.adsp_status)); |
| 350 | ret = adsp_err_get_lnx_err_code(q6core_lcl.adsp_status); |
| 351 | goto done; |
| 352 | } |
| 353 | |
| 354 | ret = 0; |
| 355 | |
| 356 | done: |
| 357 | return ret; |
| 358 | } |
| 359 | |
| 360 | int q6core_get_service_version(uint32_t service_id, |
| 361 | struct avcs_fwk_ver_info *ver_info, |
| 362 | size_t size) |
| 363 | { |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 364 | struct avcs_fwk_ver_info *cached_ver_info = NULL; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 365 | int i; |
| 366 | uint32_t num_services; |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 367 | size_t ver_size; |
| 368 | int ret; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 369 | |
| 370 | if (ver_info == NULL) { |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 371 | pr_err("%s: ver_info is NULL\n", __func__); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 372 | return -EINVAL; |
| 373 | } |
| 374 | |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 375 | ret = q6core_get_fwk_version_size(service_id); |
| 376 | if (ret < 0) { |
| 377 | pr_err("%s: Failed to get service size for service id %d with error %d\n", |
| 378 | __func__, service_id, ret); |
| 379 | return ret; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 380 | } |
| 381 | |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 382 | ver_size = ret; |
| 383 | if (ver_size != size) { |
| 384 | pr_err("%s: Expected size %zu and provided size %zu do not match\n", |
| 385 | __func__, ver_size, size); |
| 386 | return -EINVAL; |
| 387 | } |
| 388 | |
| 389 | cached_ver_info = q6core_lcl.q6core_avcs_ver_info.ver_info; |
| 390 | num_services = cached_ver_info->avcs_fwk_version.num_services; |
| 391 | |
| 392 | if (service_id == AVCS_SERVICE_ID_ALL) { |
| 393 | memcpy(ver_info, cached_ver_info, ver_size); |
| 394 | return 0; |
| 395 | } |
| 396 | |
| 397 | ver_info->avcs_fwk_version = cached_ver_info->avcs_fwk_version; |
| 398 | for (i = 0; i < num_services; i++) { |
| 399 | if (cached_ver_info->services[i].service_id == service_id) { |
| 400 | ver_info->services[0] = cached_ver_info->services[i]; |
| 401 | return 0; |
| 402 | } |
| 403 | } |
| 404 | pr_err("%s: No service matching service ID %d\n", __func__, service_id); |
| 405 | return -EINVAL; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 406 | } |
| 407 | EXPORT_SYMBOL(q6core_get_service_version); |
| 408 | |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 409 | size_t q6core_get_fwk_version_size(uint32_t service_id) |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 410 | { |
| 411 | int ret = 0; |
| 412 | uint32_t num_services; |
| 413 | |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 414 | mutex_lock(&(q6core_lcl.ver_lock)); |
| 415 | pr_debug("%s: q6core_avcs_ver_info.status(%d)\n", __func__, |
| 416 | q6core_lcl.q6core_avcs_ver_info.status); |
| 417 | |
| 418 | switch (q6core_lcl.q6core_avcs_ver_info.status) { |
| 419 | case VER_QUERY_SUPPORTED: |
| 420 | pr_debug("%s: AVCS FWK version query already attempted\n", |
| 421 | __func__); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 422 | break; |
| 423 | case VER_QUERY_UNSUPPORTED: |
| 424 | ret = -EOPNOTSUPP; |
| 425 | break; |
| 426 | case VER_QUERY_UNATTEMPTED: |
| 427 | pr_debug("%s: Attempting AVCS FWK version query\n", __func__); |
| 428 | if (q6core_is_adsp_ready()) { |
| 429 | ret = q6core_send_get_avcs_fwk_ver_cmd(); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 430 | } else { |
| 431 | pr_err("%s: ADSP is not ready to query version\n", |
| 432 | __func__); |
| 433 | ret = -ENODEV; |
| 434 | } |
| 435 | break; |
| 436 | default: |
| 437 | pr_err("%s: Invalid version query status %d\n", __func__, |
| 438 | q6core_lcl.q6core_avcs_ver_info.status); |
| 439 | ret = -EINVAL; |
| 440 | break; |
| 441 | } |
| 442 | mutex_unlock(&(q6core_lcl.ver_lock)); |
| 443 | |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 444 | if (ret) |
| 445 | goto done; |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 446 | |
Aditya Bavanari | 9ae2dde | 2018-01-09 11:35:29 +0530 | [diff] [blame] | 447 | if (q6core_lcl.q6core_avcs_ver_info.ver_info != NULL) { |
| 448 | num_services = q6core_lcl.q6core_avcs_ver_info.ver_info |
| 449 | ->avcs_fwk_version.num_services; |
| 450 | } else { |
| 451 | pr_err("%s: ver_info is NULL\n", __func__); |
| 452 | ret = -EINVAL; |
| 453 | goto done; |
| 454 | } |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 455 | |
| 456 | ret = sizeof(struct avcs_get_fwk_version); |
| 457 | if (service_id == AVCS_SERVICE_ID_ALL) |
| 458 | ret += num_services * sizeof(struct avs_svc_api_info); |
| 459 | else |
| 460 | ret += sizeof(struct avs_svc_api_info); |
| 461 | done: |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 462 | return ret; |
| 463 | } |
Siena Richard | 2d0102d | 2017-09-05 11:15:45 -0700 | [diff] [blame] | 464 | EXPORT_SYMBOL(q6core_get_fwk_version_size); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 465 | |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 466 | /** |
| 467 | * core_set_license - |
| 468 | * command to set license for module |
| 469 | * |
| 470 | * @key: license key hash |
| 471 | * @module_id: DSP Module ID |
| 472 | * |
| 473 | * Returns 0 on success or error on failure |
| 474 | */ |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 475 | int32_t core_set_license(uint32_t key, uint32_t module_id) |
| 476 | { |
| 477 | struct avcs_cmd_set_license *cmd_setl = NULL; |
| 478 | struct cal_block_data *cal_block = NULL; |
| 479 | int rc = 0, packet_size = 0; |
| 480 | |
| 481 | pr_debug("%s: key:0x%x, id:0x%x\n", __func__, key, module_id); |
| 482 | |
| 483 | mutex_lock(&(q6core_lcl.cmd_lock)); |
| 484 | if (q6core_lcl.cal_data[META_CAL] == NULL) { |
| 485 | pr_err("%s: cal_data not initialized yet!!\n", __func__); |
| 486 | rc = -EINVAL; |
| 487 | goto cmd_unlock; |
| 488 | } |
| 489 | |
| 490 | mutex_lock(&((q6core_lcl.cal_data[META_CAL])->lock)); |
| 491 | cal_block = cal_utils_get_cal_block_by_key( |
| 492 | q6core_lcl.cal_data[META_CAL], key); |
| 493 | if (cal_block == NULL || |
| 494 | cal_block->cal_data.kvaddr == NULL || |
| 495 | cal_block->cal_data.size <= 0) { |
| 496 | pr_err("%s: Invalid cal block to send", __func__); |
| 497 | rc = -EINVAL; |
| 498 | goto cal_data_unlock; |
| 499 | } |
| 500 | |
| 501 | packet_size = sizeof(struct avcs_cmd_set_license) + |
| 502 | cal_block->cal_data.size; |
| 503 | /*round up total packet_size to next 4 byte boundary*/ |
| 504 | packet_size = ((packet_size + 0x3)>>2)<<2; |
| 505 | |
| 506 | cmd_setl = kzalloc(packet_size, GFP_KERNEL); |
| 507 | if (cmd_setl == NULL) { |
| 508 | rc = -ENOMEM; |
| 509 | goto cal_data_unlock; |
| 510 | } |
| 511 | |
| 512 | ocm_core_open(); |
| 513 | if (q6core_lcl.core_handle_q == NULL) { |
| 514 | pr_err("%s: apr registration for CORE failed\n", __func__); |
| 515 | rc = -ENODEV; |
| 516 | goto fail_cmd; |
| 517 | } |
| 518 | |
| 519 | cmd_setl->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_EVENT, |
| 520 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 521 | cmd_setl->hdr.pkt_size = packet_size; |
| 522 | cmd_setl->hdr.src_port = 0; |
| 523 | cmd_setl->hdr.dest_port = 0; |
| 524 | cmd_setl->hdr.token = 0; |
| 525 | cmd_setl->hdr.opcode = AVCS_CMD_SET_LICENSE; |
| 526 | cmd_setl->id = module_id; |
| 527 | cmd_setl->overwrite = 1; |
| 528 | cmd_setl->size = cal_block->cal_data.size; |
| 529 | memcpy((uint8_t *)cmd_setl + sizeof(struct avcs_cmd_set_license), |
| 530 | cal_block->cal_data.kvaddr, |
| 531 | cal_block->cal_data.size); |
| 532 | pr_info("%s: Set license opcode=0x%x, id =0x%x, size = %d\n", |
| 533 | __func__, cmd_setl->hdr.opcode, |
| 534 | cmd_setl->id, cmd_setl->size); |
| 535 | rc = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *)cmd_setl); |
| 536 | if (rc < 0) |
| 537 | pr_err("%s: SET_LICENSE failed op[0x%x]rc[%d]\n", |
| 538 | __func__, cmd_setl->hdr.opcode, rc); |
| 539 | |
| 540 | fail_cmd: |
| 541 | kfree(cmd_setl); |
| 542 | cal_data_unlock: |
| 543 | mutex_unlock(&((q6core_lcl.cal_data[META_CAL])->lock)); |
| 544 | cmd_unlock: |
| 545 | mutex_unlock(&(q6core_lcl.cmd_lock)); |
| 546 | |
| 547 | return rc; |
| 548 | } |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 549 | EXPORT_SYMBOL(core_set_license); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 550 | |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 551 | /** |
| 552 | * core_get_license_status - |
| 553 | * command to retrieve license status for module |
| 554 | * |
| 555 | * @module_id: DSP Module ID |
| 556 | * |
| 557 | * Returns 0 on success or error on failure |
| 558 | */ |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 559 | int32_t core_get_license_status(uint32_t module_id) |
| 560 | { |
| 561 | struct avcs_cmd_get_license_validation_result get_lvr_cmd; |
| 562 | int ret = 0; |
| 563 | |
| 564 | pr_debug("%s: module_id 0x%x", __func__, module_id); |
| 565 | |
| 566 | mutex_lock(&(q6core_lcl.cmd_lock)); |
| 567 | ocm_core_open(); |
| 568 | if (q6core_lcl.core_handle_q == NULL) { |
| 569 | pr_err("%s: apr registration for CORE failed\n", __func__); |
| 570 | ret = -ENODEV; |
| 571 | goto fail_cmd; |
| 572 | } |
| 573 | |
| 574 | get_lvr_cmd.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 575 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 576 | get_lvr_cmd.hdr.pkt_size = |
| 577 | sizeof(struct avcs_cmd_get_license_validation_result); |
| 578 | |
| 579 | get_lvr_cmd.hdr.src_port = 0; |
| 580 | get_lvr_cmd.hdr.dest_port = 0; |
| 581 | get_lvr_cmd.hdr.token = 0; |
| 582 | get_lvr_cmd.hdr.opcode = AVCS_CMD_GET_LICENSE_VALIDATION_RESULT; |
| 583 | get_lvr_cmd.id = module_id; |
| 584 | |
| 585 | |
| 586 | ret = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *) &get_lvr_cmd); |
| 587 | if (ret < 0) { |
| 588 | pr_err("%s: license_validation request failed, err %d\n", |
| 589 | __func__, ret); |
| 590 | ret = -EREMOTE; |
| 591 | goto fail_cmd; |
| 592 | } |
| 593 | |
| 594 | q6core_lcl.cmd_resp_received_flag &= ~(FLAG_CMDRSP_LICENSE_RESULT); |
| 595 | mutex_unlock(&(q6core_lcl.cmd_lock)); |
| 596 | ret = wait_event_timeout(q6core_lcl.cmd_req_wait, |
| 597 | (q6core_lcl.cmd_resp_received_flag == |
| 598 | FLAG_CMDRSP_LICENSE_RESULT), |
| 599 | msecs_to_jiffies(TIMEOUT_MS)); |
| 600 | mutex_lock(&(q6core_lcl.cmd_lock)); |
| 601 | if (!ret) { |
| 602 | pr_err("%s: wait_event timeout for CMDRSP_LICENSE_RESULT\n", |
| 603 | __func__); |
| 604 | ret = -ETIME; |
| 605 | goto fail_cmd; |
| 606 | } |
| 607 | q6core_lcl.cmd_resp_received_flag &= ~(FLAG_CMDRSP_LICENSE_RESULT); |
| 608 | ret = q6core_lcl.cmd_resp_payload.cmdrsp_license_result.result; |
| 609 | |
| 610 | fail_cmd: |
| 611 | mutex_unlock(&(q6core_lcl.cmd_lock)); |
| 612 | pr_info("%s: cmdrsp_license_result.result = 0x%x for module 0x%x\n", |
| 613 | __func__, ret, module_id); |
| 614 | return ret; |
| 615 | } |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 616 | EXPORT_SYMBOL(core_get_license_status); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 617 | |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 618 | /** |
| 619 | * core_set_dolby_manufacturer_id - |
| 620 | * command to set dolby manufacturer id |
| 621 | * |
| 622 | * @manufacturer_id: Dolby manufacturer id |
| 623 | * |
| 624 | * Returns 0 on success or error on failure |
| 625 | */ |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 626 | uint32_t core_set_dolby_manufacturer_id(int manufacturer_id) |
| 627 | { |
| 628 | struct adsp_dolby_manufacturer_id payload; |
| 629 | int rc = 0; |
| 630 | |
| 631 | pr_debug("%s: manufacturer_id :%d\n", __func__, manufacturer_id); |
| 632 | mutex_lock(&(q6core_lcl.cmd_lock)); |
| 633 | ocm_core_open(); |
| 634 | if (q6core_lcl.core_handle_q) { |
| 635 | payload.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_EVENT, |
| 636 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 637 | payload.hdr.pkt_size = |
| 638 | sizeof(struct adsp_dolby_manufacturer_id); |
| 639 | payload.hdr.src_port = 0; |
| 640 | payload.hdr.dest_port = 0; |
| 641 | payload.hdr.token = 0; |
| 642 | payload.hdr.opcode = ADSP_CMD_SET_DOLBY_MANUFACTURER_ID; |
| 643 | payload.manufacturer_id = manufacturer_id; |
| 644 | pr_debug("%s: Send Dolby security opcode=0x%x manufacturer ID = %d\n", |
| 645 | __func__, |
| 646 | payload.hdr.opcode, payload.manufacturer_id); |
| 647 | rc = apr_send_pkt(q6core_lcl.core_handle_q, |
| 648 | (uint32_t *)&payload); |
| 649 | if (rc < 0) |
| 650 | pr_err("%s: SET_DOLBY_MANUFACTURER_ID failed op[0x%x]rc[%d]\n", |
| 651 | __func__, payload.hdr.opcode, rc); |
| 652 | } |
| 653 | mutex_unlock(&(q6core_lcl.cmd_lock)); |
| 654 | return rc; |
| 655 | } |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 656 | EXPORT_SYMBOL(core_set_dolby_manufacturer_id); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 657 | |
| 658 | /** |
| 659 | * q6core_is_adsp_ready - check adsp ready status |
| 660 | * |
| 661 | * Returns true if adsp is ready otherwise returns false |
| 662 | */ |
| 663 | bool q6core_is_adsp_ready(void) |
| 664 | { |
| 665 | int rc = 0; |
| 666 | bool ret = false; |
| 667 | struct apr_hdr hdr; |
| 668 | |
| 669 | pr_debug("%s: enter\n", __func__); |
| 670 | memset(&hdr, 0, sizeof(hdr)); |
| 671 | hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 672 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 673 | hdr.pkt_size = APR_PKT_SIZE(APR_HDR_SIZE, 0); |
| 674 | hdr.opcode = AVCS_CMD_ADSP_EVENT_GET_STATE; |
| 675 | |
| 676 | mutex_lock(&(q6core_lcl.cmd_lock)); |
| 677 | ocm_core_open(); |
| 678 | if (q6core_lcl.core_handle_q) { |
| 679 | q6core_lcl.bus_bw_resp_received = 0; |
| 680 | rc = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *)&hdr); |
| 681 | if (rc < 0) { |
Laxminath Kasam | c188070 | 2018-04-04 10:59:57 +0530 | [diff] [blame^] | 682 | pr_err_ratelimited("%s: Get ADSP state APR packet send event %d\n", |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 683 | __func__, rc); |
| 684 | goto bail; |
| 685 | } |
| 686 | |
| 687 | rc = wait_event_timeout(q6core_lcl.bus_bw_req_wait, |
| 688 | (q6core_lcl.bus_bw_resp_received == 1), |
| 689 | msecs_to_jiffies(Q6_READY_TIMEOUT_MS)); |
| 690 | if (rc > 0 && q6core_lcl.bus_bw_resp_received) { |
| 691 | /* ensure to read updated param by callback thread */ |
| 692 | rmb(); |
| 693 | ret = !!q6core_lcl.param; |
| 694 | } |
| 695 | } |
| 696 | bail: |
| 697 | pr_debug("%s: leave, rc %d, adsp ready %d\n", __func__, rc, ret); |
| 698 | mutex_unlock(&(q6core_lcl.cmd_lock)); |
| 699 | return ret; |
| 700 | } |
| 701 | EXPORT_SYMBOL(q6core_is_adsp_ready); |
| 702 | |
| 703 | static int q6core_map_memory_regions(phys_addr_t *buf_add, uint32_t mempool_id, |
| 704 | uint32_t *bufsz, uint32_t bufcnt, uint32_t *map_handle) |
| 705 | { |
| 706 | struct avs_cmd_shared_mem_map_regions *mmap_regions = NULL; |
| 707 | struct avs_shared_map_region_payload *mregions = NULL; |
| 708 | void *mmap_region_cmd = NULL; |
| 709 | void *payload = NULL; |
| 710 | int ret = 0; |
| 711 | int i = 0; |
| 712 | int cmd_size = 0; |
| 713 | |
| 714 | cmd_size = sizeof(struct avs_cmd_shared_mem_map_regions) |
| 715 | + sizeof(struct avs_shared_map_region_payload) |
| 716 | * bufcnt; |
| 717 | |
| 718 | mmap_region_cmd = kzalloc(cmd_size, GFP_KERNEL); |
| 719 | if (mmap_region_cmd == NULL) |
| 720 | return -ENOMEM; |
| 721 | |
| 722 | mmap_regions = (struct avs_cmd_shared_mem_map_regions *)mmap_region_cmd; |
| 723 | mmap_regions->hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 724 | APR_HDR_LEN(APR_HDR_SIZE), |
| 725 | APR_PKT_VER); |
| 726 | mmap_regions->hdr.pkt_size = cmd_size; |
| 727 | mmap_regions->hdr.src_port = 0; |
| 728 | mmap_regions->hdr.dest_port = 0; |
| 729 | mmap_regions->hdr.token = 0; |
| 730 | mmap_regions->hdr.opcode = AVCS_CMD_SHARED_MEM_MAP_REGIONS; |
| 731 | mmap_regions->mem_pool_id = ADSP_MEMORY_MAP_SHMEM8_4K_POOL & 0x00ff; |
| 732 | mmap_regions->num_regions = bufcnt & 0x00ff; |
| 733 | mmap_regions->property_flag = 0x00; |
| 734 | |
| 735 | payload = ((u8 *) mmap_region_cmd + |
| 736 | sizeof(struct avs_cmd_shared_mem_map_regions)); |
| 737 | mregions = (struct avs_shared_map_region_payload *)payload; |
| 738 | |
| 739 | for (i = 0; i < bufcnt; i++) { |
| 740 | mregions->shm_addr_lsw = lower_32_bits(buf_add[i]); |
| 741 | mregions->shm_addr_msw = |
| 742 | msm_audio_populate_upper_32_bits(buf_add[i]); |
| 743 | mregions->mem_size_bytes = bufsz[i]; |
| 744 | ++mregions; |
| 745 | } |
| 746 | |
| 747 | pr_debug("%s: sending memory map, addr %pK, size %d, bufcnt = %d\n", |
| 748 | __func__, buf_add, bufsz[0], mmap_regions->num_regions); |
| 749 | |
| 750 | *map_handle = 0; |
| 751 | q6core_lcl.bus_bw_resp_received = 0; |
| 752 | ret = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *) |
| 753 | mmap_regions); |
| 754 | if (ret < 0) { |
| 755 | pr_err("%s: mmap regions failed %d\n", |
| 756 | __func__, ret); |
| 757 | ret = -EINVAL; |
| 758 | goto done; |
| 759 | } |
| 760 | |
| 761 | ret = wait_event_timeout(q6core_lcl.bus_bw_req_wait, |
| 762 | (q6core_lcl.bus_bw_resp_received == 1), |
| 763 | msecs_to_jiffies(TIMEOUT_MS)); |
| 764 | if (!ret) { |
| 765 | pr_err("%s: timeout. waited for memory map\n", __func__); |
| 766 | ret = -ETIME; |
| 767 | goto done; |
| 768 | } |
| 769 | |
| 770 | *map_handle = q6core_lcl.mem_map_cal_handle; |
| 771 | done: |
| 772 | kfree(mmap_region_cmd); |
| 773 | return ret; |
| 774 | } |
| 775 | |
| 776 | static int q6core_memory_unmap_regions(uint32_t mem_map_handle) |
| 777 | { |
| 778 | struct avs_cmd_shared_mem_unmap_regions unmap_regions; |
| 779 | int ret = 0; |
| 780 | |
| 781 | memset(&unmap_regions, 0, sizeof(unmap_regions)); |
| 782 | unmap_regions.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 783 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 784 | unmap_regions.hdr.pkt_size = sizeof(unmap_regions); |
| 785 | unmap_regions.hdr.src_svc = APR_SVC_ADSP_CORE; |
| 786 | unmap_regions.hdr.src_domain = APR_DOMAIN_APPS; |
| 787 | unmap_regions.hdr.src_port = 0; |
| 788 | unmap_regions.hdr.dest_svc = APR_SVC_ADSP_CORE; |
| 789 | unmap_regions.hdr.dest_domain = APR_DOMAIN_ADSP; |
| 790 | unmap_regions.hdr.dest_port = 0; |
| 791 | unmap_regions.hdr.token = 0; |
| 792 | unmap_regions.hdr.opcode = AVCS_CMD_SHARED_MEM_UNMAP_REGIONS; |
| 793 | unmap_regions.mem_map_handle = mem_map_handle; |
| 794 | |
| 795 | q6core_lcl.bus_bw_resp_received = 0; |
| 796 | |
| 797 | pr_debug("%s: unmap regions map handle %d\n", |
| 798 | __func__, mem_map_handle); |
| 799 | |
| 800 | ret = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *) |
| 801 | &unmap_regions); |
| 802 | if (ret < 0) { |
| 803 | pr_err("%s: unmap regions failed %d\n", |
| 804 | __func__, ret); |
| 805 | ret = -EINVAL; |
| 806 | goto done; |
| 807 | } |
| 808 | |
| 809 | ret = wait_event_timeout(q6core_lcl.bus_bw_req_wait, |
| 810 | (q6core_lcl.bus_bw_resp_received == 1), |
| 811 | msecs_to_jiffies(TIMEOUT_MS)); |
| 812 | if (!ret) { |
| 813 | pr_err("%s: timeout. waited for memory_unmap\n", |
| 814 | __func__); |
| 815 | ret = -ETIME; |
| 816 | goto done; |
| 817 | } |
| 818 | done: |
| 819 | return ret; |
| 820 | } |
| 821 | |
| 822 | static int q6core_dereg_all_custom_topologies(void) |
| 823 | { |
| 824 | int ret = 0; |
| 825 | struct avcs_cmd_deregister_topologies dereg_top; |
| 826 | |
| 827 | memset(&dereg_top, 0, sizeof(dereg_top)); |
| 828 | dereg_top.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 829 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 830 | dereg_top.hdr.pkt_size = sizeof(dereg_top); |
| 831 | dereg_top.hdr.src_svc = APR_SVC_ADSP_CORE; |
| 832 | dereg_top.hdr.src_domain = APR_DOMAIN_APPS; |
| 833 | dereg_top.hdr.src_port = 0; |
| 834 | dereg_top.hdr.dest_svc = APR_SVC_ADSP_CORE; |
| 835 | dereg_top.hdr.dest_domain = APR_DOMAIN_ADSP; |
| 836 | dereg_top.hdr.dest_port = 0; |
| 837 | dereg_top.hdr.token = 0; |
| 838 | dereg_top.hdr.opcode = AVCS_CMD_DEREGISTER_TOPOLOGIES; |
| 839 | dereg_top.payload_addr_lsw = 0; |
| 840 | dereg_top.payload_addr_msw = 0; |
| 841 | dereg_top.mem_map_handle = 0; |
| 842 | dereg_top.payload_size = 0; |
| 843 | dereg_top.mode = AVCS_MODE_DEREGISTER_ALL_CUSTOM_TOPOLOGIES; |
| 844 | |
| 845 | q6core_lcl.bus_bw_resp_received = 0; |
| 846 | |
| 847 | pr_debug("%s: Deregister topologies mode %d\n", |
| 848 | __func__, dereg_top.mode); |
| 849 | |
| 850 | ret = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *) &dereg_top); |
| 851 | if (ret < 0) { |
| 852 | pr_err("%s: Deregister topologies failed %d\n", |
| 853 | __func__, ret); |
| 854 | goto done; |
| 855 | } |
| 856 | |
| 857 | ret = wait_event_timeout(q6core_lcl.bus_bw_req_wait, |
| 858 | (q6core_lcl.bus_bw_resp_received == 1), |
| 859 | msecs_to_jiffies(TIMEOUT_MS)); |
| 860 | if (!ret) { |
| 861 | pr_err("%s: wait_event timeout for Deregister topologies\n", |
| 862 | __func__); |
| 863 | goto done; |
| 864 | } |
| 865 | done: |
| 866 | return ret; |
| 867 | } |
| 868 | |
| 869 | static int q6core_send_custom_topologies(void) |
| 870 | { |
| 871 | int ret = 0; |
| 872 | int ret2 = 0; |
| 873 | struct cal_block_data *cal_block = NULL; |
| 874 | struct avcs_cmd_register_topologies reg_top; |
| 875 | |
| 876 | if (!q6core_is_adsp_ready()) { |
| 877 | pr_err("%s: ADSP is not ready!\n", __func__); |
| 878 | return -ENODEV; |
| 879 | } |
| 880 | |
| 881 | memset(®_top, 0, sizeof(reg_top)); |
| 882 | mutex_lock(&q6core_lcl.cal_data[CUST_TOP_CAL]->lock); |
| 883 | mutex_lock(&q6core_lcl.cmd_lock); |
| 884 | |
| 885 | cal_block = cal_utils_get_only_cal_block( |
| 886 | q6core_lcl.cal_data[CUST_TOP_CAL]); |
| 887 | if (cal_block == NULL) { |
| 888 | pr_debug("%s: cal block is NULL!\n", __func__); |
| 889 | goto unlock; |
| 890 | } |
| 891 | if (cal_block->cal_data.size <= 0) { |
| 892 | pr_debug("%s: cal size is %zd not sending\n", |
| 893 | __func__, cal_block->cal_data.size); |
| 894 | goto unlock; |
| 895 | } |
| 896 | |
| 897 | q6core_dereg_all_custom_topologies(); |
| 898 | |
| 899 | ret = q6core_map_memory_regions(&cal_block->cal_data.paddr, 0, |
| 900 | (uint32_t *)&cal_block->map_data.map_size, 1, |
| 901 | &cal_block->map_data.q6map_handle); |
| 902 | if (!ret) { |
| 903 | pr_err("%s: q6core_map_memory_regions failed\n", __func__); |
| 904 | goto unlock; |
| 905 | } |
| 906 | |
| 907 | reg_top.hdr.hdr_field = APR_HDR_FIELD(APR_MSG_TYPE_SEQ_CMD, |
| 908 | APR_HDR_LEN(APR_HDR_SIZE), APR_PKT_VER); |
| 909 | reg_top.hdr.pkt_size = sizeof(reg_top); |
| 910 | reg_top.hdr.src_svc = APR_SVC_ADSP_CORE; |
| 911 | reg_top.hdr.src_domain = APR_DOMAIN_APPS; |
| 912 | reg_top.hdr.src_port = 0; |
| 913 | reg_top.hdr.dest_svc = APR_SVC_ADSP_CORE; |
| 914 | reg_top.hdr.dest_domain = APR_DOMAIN_ADSP; |
| 915 | reg_top.hdr.dest_port = 0; |
| 916 | reg_top.hdr.token = 0; |
| 917 | reg_top.hdr.opcode = AVCS_CMD_REGISTER_TOPOLOGIES; |
| 918 | reg_top.payload_addr_lsw = |
| 919 | lower_32_bits(cal_block->cal_data.paddr); |
| 920 | reg_top.payload_addr_msw = |
| 921 | msm_audio_populate_upper_32_bits(cal_block->cal_data.paddr); |
| 922 | reg_top.mem_map_handle = cal_block->map_data.q6map_handle; |
| 923 | reg_top.payload_size = cal_block->cal_data.size; |
| 924 | |
| 925 | q6core_lcl.adsp_status = 0; |
| 926 | q6core_lcl.bus_bw_resp_received = 0; |
| 927 | |
| 928 | pr_debug("%s: Register topologies addr %pK, size %zd, map handle %d\n", |
| 929 | __func__, &cal_block->cal_data.paddr, cal_block->cal_data.size, |
| 930 | cal_block->map_data.q6map_handle); |
| 931 | |
| 932 | ret = apr_send_pkt(q6core_lcl.core_handle_q, (uint32_t *) ®_top); |
| 933 | if (ret < 0) { |
| 934 | pr_err("%s: Register topologies failed %d\n", |
| 935 | __func__, ret); |
| 936 | goto unmap; |
| 937 | } |
| 938 | |
| 939 | ret = wait_event_timeout(q6core_lcl.bus_bw_req_wait, |
| 940 | (q6core_lcl.bus_bw_resp_received == 1), |
| 941 | msecs_to_jiffies(TIMEOUT_MS)); |
| 942 | if (!ret) { |
| 943 | pr_err("%s: wait_event timeout for Register topologies\n", |
| 944 | __func__); |
| 945 | goto unmap; |
| 946 | } |
| 947 | |
| 948 | if (q6core_lcl.adsp_status < 0) |
| 949 | ret = q6core_lcl.adsp_status; |
| 950 | unmap: |
| 951 | ret2 = q6core_memory_unmap_regions(cal_block->map_data.q6map_handle); |
| 952 | if (!ret2) { |
| 953 | pr_err("%s: q6core_memory_unmap_regions failed for map handle %d\n", |
| 954 | __func__, cal_block->map_data.q6map_handle); |
| 955 | ret = ret2; |
| 956 | goto unlock; |
| 957 | } |
| 958 | |
| 959 | unlock: |
| 960 | mutex_unlock(&q6core_lcl.cmd_lock); |
| 961 | mutex_unlock(&q6core_lcl.cal_data[CUST_TOP_CAL]->lock); |
| 962 | |
| 963 | return ret; |
| 964 | } |
| 965 | |
| 966 | static int get_cal_type_index(int32_t cal_type) |
| 967 | { |
| 968 | int ret = -EINVAL; |
| 969 | |
| 970 | switch (cal_type) { |
| 971 | case AUDIO_CORE_METAINFO_CAL_TYPE: |
| 972 | ret = META_CAL; |
| 973 | break; |
| 974 | case CORE_CUSTOM_TOPOLOGIES_CAL_TYPE: |
| 975 | ret = CUST_TOP_CAL; |
| 976 | break; |
| 977 | default: |
| 978 | pr_err("%s: invalid cal type %d!\n", __func__, cal_type); |
| 979 | } |
| 980 | return ret; |
| 981 | } |
| 982 | |
| 983 | static int q6core_alloc_cal(int32_t cal_type, |
| 984 | size_t data_size, void *data) |
| 985 | { |
| 986 | int ret = 0; |
| 987 | int cal_index; |
| 988 | |
| 989 | cal_index = get_cal_type_index(cal_type); |
| 990 | if (cal_index < 0) { |
| 991 | pr_err("%s: could not get cal index %d!\n", |
| 992 | __func__, cal_index); |
| 993 | ret = -EINVAL; |
| 994 | goto done; |
| 995 | } |
| 996 | |
| 997 | |
| 998 | ret = cal_utils_alloc_cal(data_size, data, |
| 999 | q6core_lcl.cal_data[cal_index], 0, NULL); |
| 1000 | if (ret < 0) { |
| 1001 | pr_err("%s: cal_utils_alloc_block failed, ret = %d, cal type = %d!\n", |
| 1002 | __func__, ret, cal_type); |
| 1003 | goto done; |
| 1004 | } |
| 1005 | done: |
| 1006 | return ret; |
| 1007 | } |
| 1008 | |
| 1009 | static int q6core_dealloc_cal(int32_t cal_type, |
| 1010 | size_t data_size, void *data) |
| 1011 | { |
| 1012 | int ret = 0; |
| 1013 | int cal_index; |
| 1014 | |
| 1015 | cal_index = get_cal_type_index(cal_type); |
| 1016 | if (cal_index < 0) { |
| 1017 | pr_err("%s: could not get cal index %d!\n", |
| 1018 | __func__, cal_index); |
| 1019 | ret = -EINVAL; |
| 1020 | goto done; |
| 1021 | } |
| 1022 | |
| 1023 | |
| 1024 | ret = cal_utils_dealloc_cal(data_size, data, |
| 1025 | q6core_lcl.cal_data[cal_index]); |
| 1026 | if (ret < 0) { |
| 1027 | pr_err("%s: cal_utils_dealloc_block failed, ret = %d, cal type = %d!\n", |
| 1028 | __func__, ret, cal_type); |
| 1029 | goto done; |
| 1030 | } |
| 1031 | done: |
| 1032 | return ret; |
| 1033 | } |
| 1034 | |
| 1035 | static int q6core_set_cal(int32_t cal_type, |
| 1036 | size_t data_size, void *data) |
| 1037 | { |
| 1038 | int ret = 0; |
| 1039 | int cal_index; |
| 1040 | |
| 1041 | cal_index = get_cal_type_index(cal_type); |
| 1042 | if (cal_index < 0) { |
| 1043 | pr_err("%s: could not get cal index %d!\n", |
| 1044 | __func__, cal_index); |
| 1045 | ret = -EINVAL; |
| 1046 | goto done; |
| 1047 | } |
| 1048 | |
| 1049 | |
| 1050 | ret = cal_utils_set_cal(data_size, data, |
| 1051 | q6core_lcl.cal_data[cal_index], 0, NULL); |
| 1052 | if (ret < 0) { |
| 1053 | pr_err("%s: cal_utils_set_cal failed, ret = %d, cal type = %d!\n", |
| 1054 | __func__, ret, cal_type); |
| 1055 | goto done; |
| 1056 | } |
| 1057 | |
| 1058 | if (cal_index == CUST_TOP_CAL) |
| 1059 | ret = q6core_send_custom_topologies(); |
| 1060 | done: |
| 1061 | return ret; |
| 1062 | } |
| 1063 | |
| 1064 | static void q6core_delete_cal_data(void) |
| 1065 | { |
| 1066 | pr_debug("%s:\n", __func__); |
| 1067 | |
| 1068 | cal_utils_destroy_cal_types(CORE_MAX_CAL, q6core_lcl.cal_data); |
| 1069 | } |
| 1070 | |
| 1071 | |
| 1072 | static int q6core_init_cal_data(void) |
| 1073 | { |
| 1074 | int ret = 0; |
| 1075 | struct cal_type_info cal_type_info[] = { |
| 1076 | {{AUDIO_CORE_METAINFO_CAL_TYPE, |
| 1077 | {q6core_alloc_cal, q6core_dealloc_cal, NULL, |
| 1078 | q6core_set_cal, NULL, NULL} }, |
| 1079 | {NULL, NULL, cal_utils_match_buf_num} }, |
| 1080 | |
| 1081 | {{CORE_CUSTOM_TOPOLOGIES_CAL_TYPE, |
| 1082 | {q6core_alloc_cal, q6core_dealloc_cal, NULL, |
| 1083 | q6core_set_cal, NULL, NULL} }, |
| 1084 | {NULL, NULL, cal_utils_match_buf_num} } |
| 1085 | }; |
| 1086 | pr_debug("%s:\n", __func__); |
| 1087 | |
| 1088 | ret = cal_utils_create_cal_types(CORE_MAX_CAL, |
| 1089 | q6core_lcl.cal_data, cal_type_info); |
| 1090 | if (ret < 0) { |
| 1091 | pr_err("%s: could not create cal type!\n", |
| 1092 | __func__); |
| 1093 | goto err; |
| 1094 | } |
| 1095 | |
| 1096 | return ret; |
| 1097 | err: |
| 1098 | q6core_delete_cal_data(); |
| 1099 | return ret; |
| 1100 | } |
| 1101 | |
Laxminath Kasam | 8b1366a | 2017-10-05 01:44:16 +0530 | [diff] [blame] | 1102 | int __init core_init(void) |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1103 | { |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 1104 | memset(&q6core_lcl, 0, sizeof(struct q6core_str)); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1105 | init_waitqueue_head(&q6core_lcl.bus_bw_req_wait); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1106 | init_waitqueue_head(&q6core_lcl.cmd_req_wait); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 1107 | init_waitqueue_head(&q6core_lcl.avcs_fwk_ver_req_wait); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1108 | q6core_lcl.cmd_resp_received_flag = FLAG_NONE; |
| 1109 | mutex_init(&q6core_lcl.cmd_lock); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 1110 | mutex_init(&q6core_lcl.ver_lock); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1111 | |
| 1112 | q6core_init_cal_data(); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 1113 | |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1114 | return 0; |
| 1115 | } |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1116 | |
Asish Bhattacharya | 5faacb3 | 2017-12-04 17:23:15 +0530 | [diff] [blame] | 1117 | void core_exit(void) |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1118 | { |
| 1119 | mutex_destroy(&q6core_lcl.cmd_lock); |
Laxminath Kasam | 38070be | 2017-08-17 18:21:59 +0530 | [diff] [blame] | 1120 | mutex_destroy(&q6core_lcl.ver_lock); |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1121 | q6core_delete_cal_data(); |
| 1122 | } |
Asish Bhattacharya | 8e2277f | 2017-07-20 18:31:55 +0530 | [diff] [blame] | 1123 | MODULE_DESCRIPTION("ADSP core driver"); |
| 1124 | MODULE_LICENSE("GPL v2"); |