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