audio_prm.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2019-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/slab.h>
  7. #include <linux/wait.h>
  8. #include <linux/kernel.h>
  9. #include <linux/module.h>
  10. #include <linux/sched.h>
  11. #include <linux/delay.h>
  12. #include <linux/jiffies.h>
  13. #include <linux/of.h>
  14. #include <linux/of_platform.h>
  15. #include <ipc/gpr-lite.h>
  16. #include <soc/snd_event.h>
  17. #include <dsp/audio_prm.h>
  18. #include <dsp/spf-core.h>
  19. #include <dsp/audio_notifier.h>
  20. #define TIMEOUT_MS 500
  21. #define MAX_RETRY_COUNT 3
  22. #define APM_READY_WAIT_DURATION 2
  23. #define GPR_SEND_PKT_APM_TIMEOUT_MS 0
  24. struct audio_prm {
  25. struct gpr_device *adev;
  26. wait_queue_head_t wait;
  27. struct mutex lock;
  28. bool resp_received;
  29. atomic_t state;
  30. atomic_t status;
  31. int lpi_pcm_logging_enable;
  32. bool is_adsp_up;
  33. };
  34. static struct audio_prm g_prm;
  35. static bool is_apm_ready_check_done = false;
  36. static int audio_prm_callback(struct gpr_device *adev, void *data)
  37. {
  38. struct gpr_hdr *hdr = (struct gpr_hdr *)data;
  39. uint32_t *payload = GPR_PKT_GET_PAYLOAD(uint32_t, data);
  40. //dev_err(&adev->dev, "%s: Payload %x", __func__, hdr->opcode);
  41. switch (hdr->opcode) {
  42. case GPR_IBASIC_RSP_RESULT:
  43. pr_err("%s: Failed response received",__func__);
  44. atomic_set(&g_prm.status, payload[1]);
  45. g_prm.resp_received = true;
  46. break;
  47. case PRM_CMD_RSP_REQUEST_HW_RSC:
  48. case PRM_CMD_RSP_RELEASE_HW_RSC:
  49. /* payload[1] contains the error status for response */
  50. if (payload[1] != 0) {
  51. atomic_set(&g_prm.status, payload[1]);
  52. pr_err("%s: cmd = 0x%x returned error = 0x%x\n",
  53. __func__, payload[0], payload[1]);
  54. }
  55. g_prm.resp_received = true;
  56. /* payload[0] contains the param_ID for response */
  57. switch (payload[0]) {
  58. case PARAM_ID_RSC_AUDIO_HW_CLK:
  59. case PARAM_ID_RSC_LPASS_CORE:
  60. case PARAM_ID_RSC_HW_CORE:
  61. if (payload[1] != 0)
  62. pr_err("%s: PRM command failed with error %d\n",
  63. __func__, payload[1]);
  64. atomic_set(&g_prm.state, payload[1]);
  65. break;
  66. default:
  67. pr_err("%s: hit default case",__func__);
  68. };
  69. break;
  70. default:
  71. break;
  72. };
  73. if (g_prm.resp_received)
  74. wake_up(&g_prm.wait);
  75. return 0;
  76. }
  77. static int prm_gpr_send_pkt(struct gpr_pkt *pkt, wait_queue_head_t *wait)
  78. {
  79. int ret = 0;
  80. int retry;
  81. mutex_lock(&g_prm.lock);
  82. pr_debug("%s: enter",__func__);
  83. if (wait)
  84. atomic_set(&g_prm.state, 1);
  85. atomic_set(&g_prm.status, 0);
  86. if (g_prm.adev == NULL) {
  87. pr_err("%s: apr is unregistered\n", __func__);
  88. mutex_unlock(&g_prm.lock);
  89. return -ENODEV;
  90. }
  91. if (!is_apm_ready_check_done && g_prm.is_adsp_up &&
  92. (gpr_get_q6_state() == GPR_SUBSYS_LOADED)) {
  93. pr_info("%s: apm ready check not done\n", __func__);
  94. retry = 0;
  95. while (!spf_core_is_apm_ready(GPR_SEND_PKT_APM_TIMEOUT_MS) &&
  96. retry < MAX_RETRY_COUNT) {
  97. msleep(APM_READY_WAIT_DURATION);
  98. ++retry;
  99. }
  100. is_apm_ready_check_done = true;
  101. pr_info("%s: apm ready check done\n", __func__);
  102. }
  103. g_prm.resp_received = false;
  104. ret = gpr_send_pkt(g_prm.adev, pkt);
  105. if (ret < 0) {
  106. pr_err("%s: packet not transmitted %d\n", __func__, ret);
  107. mutex_unlock(&g_prm.lock);
  108. return ret;
  109. }
  110. if (wait) {
  111. ret = wait_event_timeout(g_prm.wait,
  112. (g_prm.resp_received),
  113. msecs_to_jiffies(2 * TIMEOUT_MS));
  114. if (!ret) {
  115. pr_err("%s: pkt send timeout\n", __func__);
  116. ret = -ETIMEDOUT;
  117. } else if (atomic_read(&g_prm.status) > 0) {
  118. pr_err("%s: DSP returned error %d\n", __func__,
  119. atomic_read(&g_prm.status));
  120. ret = -EINVAL;
  121. } else {
  122. ret = 0;
  123. }
  124. }
  125. pr_debug("%s: exit",__func__);
  126. mutex_unlock(&g_prm.lock);
  127. return ret;
  128. }
  129. void audio_prm_set_lpi_logging_status(int lpi_pcm_logging_enable)
  130. {
  131. g_prm.lpi_pcm_logging_enable = lpi_pcm_logging_enable;
  132. }
  133. EXPORT_SYMBOL(audio_prm_set_lpi_logging_status);
  134. /**
  135. */
  136. int audio_prm_set_lpass_hw_core_req(struct clk_cfg *cfg, uint32_t hw_core_id, uint8_t enable)
  137. {
  138. struct gpr_pkt *pkt;
  139. prm_cmd_request_hw_core_t prm_rsc_request;
  140. int ret = 0;
  141. uint32_t size;
  142. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_hw_core_t);
  143. pkt = kzalloc(size, GFP_KERNEL);
  144. if (!pkt)
  145. return -ENOMEM;
  146. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  147. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  148. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  149. pkt->hdr.src_port = GPR_SVC_ASM;
  150. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  151. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  152. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  153. pkt->hdr.token = 0; /* TBD */
  154. if (enable)
  155. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  156. else
  157. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  158. //pr_err("%s: clk_id %d size of cmd_req %ld \n",__func__, cfg->clk_id, sizeof(prm_cmd_request_hw_core_t));
  159. prm_rsc_request.payload_header.payload_address_lsw = 0;
  160. prm_rsc_request.payload_header.payload_address_msw = 0;
  161. prm_rsc_request.payload_header.mem_map_handle = 0;
  162. prm_rsc_request.payload_header.payload_size = sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t);
  163. /** Populate the param payload */
  164. prm_rsc_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  165. prm_rsc_request.module_payload_0.error_code = 0;
  166. prm_rsc_request.module_payload_0.param_id = PARAM_ID_RSC_HW_CORE;
  167. prm_rsc_request.module_payload_0.param_size =
  168. sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  169. prm_rsc_request.hw_core_id = hw_core_id; // HW_CORE_ID_LPASS;
  170. memcpy(&pkt->payload, &prm_rsc_request, sizeof(prm_cmd_request_hw_core_t));
  171. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  172. kfree(pkt);
  173. return ret;
  174. }
  175. EXPORT_SYMBOL(audio_prm_set_lpass_hw_core_req);
  176. /**
  177. * prm_set_lpass_clk_cfg() - Set PRM clock
  178. *
  179. * Return: 0 if clock set is success
  180. */
  181. static int audio_prm_set_lpass_clk_cfg_req(struct clk_cfg *cfg)
  182. {
  183. struct gpr_pkt *pkt;
  184. prm_cmd_request_rsc_t prm_rsc_request;
  185. int ret = 0;
  186. uint32_t size;
  187. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_rsc_t);
  188. pkt = kzalloc(size, GFP_KERNEL);
  189. if (!pkt)
  190. return -ENOMEM;
  191. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  192. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  193. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  194. pkt->hdr.src_port = GPR_SVC_ASM;
  195. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  196. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  197. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  198. pkt->hdr.token = 0; /* TBD */
  199. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  200. //pr_err("%s: clk_id %d size of cmd_req %ld \n",__func__, cfg->clk_id, sizeof(prm_cmd_request_rsc_t));
  201. prm_rsc_request.payload_header.payload_address_lsw = 0;
  202. prm_rsc_request.payload_header.payload_address_msw = 0;
  203. prm_rsc_request.payload_header.mem_map_handle = 0;
  204. prm_rsc_request.payload_header.payload_size = sizeof(prm_cmd_request_rsc_t) - sizeof(apm_cmd_header_t);
  205. /** Populate the param payload */
  206. prm_rsc_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  207. prm_rsc_request.module_payload_0.error_code = 0;
  208. prm_rsc_request.module_payload_0.param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
  209. prm_rsc_request.module_payload_0.param_size =
  210. sizeof(prm_cmd_request_rsc_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  211. prm_rsc_request.num_clk_id_t.num_clock_id = MAX_AUD_HW_CLK_NUM_REQ;
  212. prm_rsc_request.clock_ids_t[0].clock_id = cfg->clk_id;
  213. prm_rsc_request.clock_ids_t[0].clock_freq = cfg->clk_freq_in_hz;
  214. prm_rsc_request.clock_ids_t[0].clock_attri = cfg->clk_attri;
  215. /*
  216. * Set TX RCG to RCO if lpi pcm logging is enabled and any one of the
  217. * tx core clocks are enabled
  218. */
  219. if (g_prm.lpi_pcm_logging_enable &&
  220. ((cfg->clk_id == CLOCK_ID_TX_CORE_MCLK) ||
  221. (cfg->clk_id == CLOCK_ID_WSA_CORE_TX_MCLK) ||
  222. (cfg->clk_id == CLOCK_ID_WSA2_CORE_TX_MCLK) ||
  223. (cfg->clk_id == CLOCK_ID_RX_CORE_TX_MCLK)))
  224. prm_rsc_request.clock_ids_t[0].clock_root = CLOCK_ROOT_SRC_RCO;
  225. else
  226. prm_rsc_request.clock_ids_t[0].clock_root = cfg->clk_root;
  227. memcpy(&pkt->payload, &prm_rsc_request, sizeof(prm_cmd_request_rsc_t));
  228. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  229. kfree(pkt);
  230. return ret;
  231. }
  232. static int audio_prm_set_lpass_clk_cfg_rel(struct clk_cfg *cfg)
  233. {
  234. struct gpr_pkt *pkt;
  235. prm_cmd_release_rsc_t prm_rsc_release;
  236. int ret = 0;
  237. uint32_t size;
  238. size = GPR_HDR_SIZE + sizeof(prm_cmd_release_rsc_t);
  239. pkt = kzalloc(size, GFP_KERNEL);
  240. if (!pkt)
  241. return -ENOMEM;
  242. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  243. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  244. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  245. pkt->hdr.src_port = GPR_SVC_ASM;
  246. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  247. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  248. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  249. pkt->hdr.token = 0; /* TBD */
  250. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  251. //pr_err("%s: clk_id %d size of cmd_req %ld \n",__func__, cfg->clk_id, sizeof(prm_cmd_release_rsc_t));
  252. prm_rsc_release.payload_header.payload_address_lsw = 0;
  253. prm_rsc_release.payload_header.payload_address_msw = 0;
  254. prm_rsc_release.payload_header.mem_map_handle = 0;
  255. prm_rsc_release.payload_header.payload_size = sizeof(prm_cmd_release_rsc_t) - sizeof(apm_cmd_header_t);
  256. /** Populate the param payload */
  257. prm_rsc_release.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  258. prm_rsc_release.module_payload_0.error_code = 0;
  259. prm_rsc_release.module_payload_0.param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
  260. prm_rsc_release.module_payload_0.param_size =
  261. sizeof(prm_cmd_release_rsc_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  262. prm_rsc_release.num_clk_id_t.num_clock_id = MAX_AUD_HW_CLK_NUM_REQ;
  263. prm_rsc_release.clock_ids_t[0].clock_id = cfg->clk_id;
  264. memcpy(&pkt->payload, &prm_rsc_release, sizeof(prm_cmd_release_rsc_t));
  265. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  266. kfree(pkt);
  267. return ret;
  268. }
  269. /**
  270. * audio_prm_set_cdc_earpa_duty_cycling_req() - send codec reg values
  271. * for codec duty cycling.
  272. *
  273. * Return: 0 if reg passing is success.
  274. */
  275. int audio_prm_set_cdc_earpa_duty_cycling_req(struct prm_earpa_hw_intf_config *earpa_config,
  276. uint32_t enable)
  277. {
  278. struct gpr_pkt *pkt;
  279. prm_cmd_request_cdc_duty_cycling_t prm_rsc_request_reg_info;
  280. int ret = 0;
  281. uint32_t size;
  282. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_cdc_duty_cycling_t);
  283. pkt = kzalloc(size, GFP_KERNEL);
  284. if (!pkt)
  285. return -ENOMEM;
  286. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  287. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  288. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  289. pkt->hdr.src_port = GPR_SVC_ASM;
  290. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  291. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  292. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  293. pkt->hdr.token = 0;
  294. if (enable)
  295. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  296. else
  297. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  298. memset(&prm_rsc_request_reg_info, 0, sizeof(prm_cmd_request_cdc_duty_cycling_t));
  299. prm_rsc_request_reg_info.payload_header.payload_address_lsw = 0;
  300. prm_rsc_request_reg_info.payload_header.payload_address_msw = 0;
  301. prm_rsc_request_reg_info.payload_header.mem_map_handle = 0;
  302. prm_rsc_request_reg_info.payload_header.payload_size =
  303. sizeof(prm_cmd_request_cdc_duty_cycling_t) - sizeof(apm_cmd_header_t);
  304. /* Populate the param payload */
  305. prm_rsc_request_reg_info.module_payload_0.module_instance_id =
  306. PRM_MODULE_INSTANCE_ID;
  307. prm_rsc_request_reg_info.module_payload_0.error_code = 0;
  308. prm_rsc_request_reg_info.module_payload_0.param_id =
  309. PARAM_ID_RSC_HW_CODEC_REG_INFO;
  310. prm_rsc_request_reg_info.module_payload_0.param_size =
  311. sizeof(prm_cmd_request_cdc_duty_cycling_t) -
  312. sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  313. prm_rsc_request_reg_info.hw_codec_reg_info_t.num_reg_info_t = MAX_EARPA_REG;
  314. /* Setting up DIGITAL Mute register value */
  315. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_id =
  316. HW_CODEC_DIG_REG_ID_MUTE_CTRL;
  317. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_addr_msw = 0;
  318. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_addr_lsw =
  319. earpa_config->ear_pa_hw_reg_cfg.lpass_cdc_rx0_rx_path_ctl_phy_addr;
  320. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].num_ops =
  321. MAX_EARPA_CDC_DUTY_CYC_OPERATION;
  322. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[0].hw_codec_op_id =
  323. HW_CODEC_OP_DIG_MUTE_ENABLE;
  324. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[0].hw_codec_op_value =
  325. DIG_MUTE_ENABLE;
  326. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[1].hw_codec_op_id =
  327. HW_CODEC_OP_DIG_MUTE_DISABLE;
  328. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[1].hw_codec_op_value =
  329. DIG_MUTE_DISABLE;
  330. /* Setting up LPASS_PA_REG Values */
  331. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_id =
  332. HW_CODEC_ANALOG_REG_ID_CMD_FIFO_WRITE;
  333. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_addr_msw = 0;
  334. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_addr_lsw =
  335. earpa_config->ear_pa_hw_reg_cfg.lpass_wr_fifo_reg_phy_addr;
  336. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].num_ops =
  337. MAX_EARPA_CDC_DUTY_CYC_OPERATION;
  338. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[0].hw_codec_op_id =
  339. HW_CODEC_OP_ANA_PGA_ENABLE;
  340. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[0].hw_codec_op_value =
  341. earpa_config->ear_pa_pkd_cfg.ear_pa_enable_pkd_reg_addr;
  342. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[1].hw_codec_op_id =
  343. HW_CODEC_OP_ANA_PGA_DISABLE;
  344. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[1].hw_codec_op_value =
  345. earpa_config->ear_pa_pkd_cfg.ear_pa_disable_pkd_reg_addr;
  346. memcpy(&pkt->payload, &prm_rsc_request_reg_info, sizeof(prm_cmd_request_cdc_duty_cycling_t));
  347. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  348. kfree(pkt);
  349. return ret;
  350. }
  351. EXPORT_SYMBOL(audio_prm_set_cdc_earpa_duty_cycling_req);
  352. int audio_prm_set_vote_against_sleep(uint8_t enable)
  353. {
  354. int ret = 0;
  355. struct gpr_pkt *pkt;
  356. prm_cmd_request_hw_core_t prm_rsc_request;
  357. uint32_t size;
  358. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_hw_core_t);
  359. pkt = kzalloc(size, GFP_KERNEL);
  360. if (!pkt)
  361. return -ENOMEM;
  362. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  363. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  364. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  365. pkt->hdr.src_port = GPR_SVC_ASM;
  366. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  367. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  368. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  369. pkt->hdr.token = 0; /* TBD */
  370. if (enable)
  371. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  372. else
  373. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  374. prm_rsc_request.payload_header.payload_address_lsw = 0;
  375. prm_rsc_request.payload_header.payload_address_msw = 0;
  376. prm_rsc_request.payload_header.mem_map_handle = 0;
  377. prm_rsc_request.payload_header.payload_size = sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t);
  378. /** Populate the param payload */
  379. prm_rsc_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  380. prm_rsc_request.module_payload_0.error_code = 0;
  381. prm_rsc_request.module_payload_0.param_id = PARAM_ID_RSC_HW_CORE;
  382. prm_rsc_request.module_payload_0.param_size =
  383. sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  384. prm_rsc_request.hw_core_id = HW_CORE_ID_LPASS;
  385. memcpy(&pkt->payload, &prm_rsc_request, sizeof(prm_cmd_request_hw_core_t));
  386. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  387. if (ret < 0) {
  388. pr_err("%s: Unable to send packet %d\n", __func__, ret);
  389. }
  390. kfree(pkt);
  391. return ret;
  392. }
  393. EXPORT_SYMBOL(audio_prm_set_vote_against_sleep);
  394. int audio_prm_set_lpass_clk_cfg (struct clk_cfg *clk, uint8_t enable)
  395. {
  396. int ret = 0;
  397. if (enable)
  398. ret = audio_prm_set_lpass_clk_cfg_req (clk);
  399. else
  400. ret = audio_prm_set_lpass_clk_cfg_rel (clk);
  401. return ret;
  402. }
  403. EXPORT_SYMBOL(audio_prm_set_lpass_clk_cfg);
  404. static int audio_prm_service_cb(struct notifier_block *this,
  405. unsigned long opcode, void *data)
  406. {
  407. pr_info("%s: Service opcode 0x%lx\n", __func__, opcode);
  408. switch (opcode) {
  409. case AUDIO_NOTIFIER_SERVICE_DOWN:
  410. mutex_lock(&g_prm.lock);
  411. pr_debug("%s: making apm_ready check false\n", __func__);
  412. is_apm_ready_check_done = false;
  413. g_prm.is_adsp_up = false;
  414. mutex_unlock(&g_prm.lock);
  415. break;
  416. case AUDIO_NOTIFIER_SERVICE_UP:
  417. mutex_lock(&g_prm.lock);
  418. g_prm.is_adsp_up = true;
  419. mutex_unlock(&g_prm.lock);
  420. break;
  421. default:
  422. break;
  423. }
  424. return NOTIFY_OK;
  425. }
  426. static struct notifier_block service_nb = {
  427. .notifier_call = audio_prm_service_cb,
  428. .priority = -INT_MAX,
  429. };
  430. static int audio_prm_probe(struct gpr_device *adev)
  431. {
  432. int ret = 0;
  433. if (!audio_notifier_probe_status()) {
  434. pr_err("%s: Audio notify probe not completed, defer audio prm probe\n",
  435. __func__);
  436. return -EPROBE_DEFER;
  437. }
  438. ret = audio_notifier_register("audio_prm", AUDIO_NOTIFIER_ADSP_DOMAIN,
  439. &service_nb);
  440. if (ret < 0) {
  441. if (ret != -EPROBE_DEFER)
  442. pr_err("%s: Audio notifier register failed ret = %d\n",
  443. __func__, ret);
  444. return ret;
  445. }
  446. dev_set_drvdata(&adev->dev, &g_prm);
  447. g_prm.adev = adev;
  448. init_waitqueue_head(&g_prm.wait);
  449. g_prm.is_adsp_up = true;
  450. pr_err("%s: prm probe success\n", __func__);
  451. return ret;
  452. }
  453. static int audio_prm_remove(struct gpr_device *adev)
  454. {
  455. int ret = 0;
  456. audio_notifier_deregister("audio_prm");
  457. mutex_lock(&g_prm.lock);
  458. g_prm.is_adsp_up = false;
  459. g_prm.adev = NULL;
  460. mutex_unlock(&g_prm.lock);
  461. return ret;
  462. }
  463. static const struct of_device_id audio_prm_device_id[] = {
  464. { .compatible = "qcom,audio_prm" },
  465. {},
  466. };
  467. MODULE_DEVICE_TABLE(of, audio_prm_device_id);
  468. static struct gpr_driver qcom_audio_prm_driver = {
  469. .probe = audio_prm_probe,
  470. .remove = audio_prm_remove,
  471. .callback = audio_prm_callback,
  472. .driver = {
  473. .name = "qcom-audio_prm",
  474. .of_match_table = of_match_ptr(audio_prm_device_id),
  475. },
  476. };
  477. static int __init audio_prm_module_init(void)
  478. {
  479. int ret;
  480. ret = gpr_driver_register(&qcom_audio_prm_driver);
  481. if (ret)
  482. pr_err("%s: gpr driver register failed = %d\n", __func__, ret);
  483. mutex_init(&g_prm.lock);
  484. return ret;
  485. }
  486. static void __exit audio_prm_module_exit(void)
  487. {
  488. mutex_destroy(&g_prm.lock);
  489. gpr_driver_unregister(&qcom_audio_prm_driver);
  490. }
  491. module_init(audio_prm_module_init);
  492. module_exit(audio_prm_module_exit);
  493. MODULE_DESCRIPTION("audio prm");
  494. MODULE_LICENSE("GPL v2");