audio_prm.c 19 KB

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