audio_prm.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2019-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2022-2023 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. u32 prm_sleep_api_supported;
  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. case PARAM_ID_RSC_CPU_LPR:
  62. if (payload[1] != 0)
  63. pr_err("%s: PRM command failed with error %d\n",
  64. __func__, payload[1]);
  65. atomic_set(&g_prm.state, payload[1]);
  66. break;
  67. default:
  68. pr_err("%s: hit default case",__func__);
  69. };
  70. break;
  71. default:
  72. break;
  73. };
  74. if (g_prm.resp_received)
  75. wake_up(&g_prm.wait);
  76. return 0;
  77. }
  78. static int prm_gpr_send_pkt(struct gpr_pkt *pkt, wait_queue_head_t *wait)
  79. {
  80. int ret = 0;
  81. int retry;
  82. mutex_lock(&g_prm.lock);
  83. pr_debug("%s: enter",__func__);
  84. if (wait)
  85. atomic_set(&g_prm.state, 1);
  86. atomic_set(&g_prm.status, 0);
  87. if (g_prm.adev == NULL) {
  88. pr_err("%s: apr is unregistered\n", __func__);
  89. mutex_unlock(&g_prm.lock);
  90. return -ENODEV;
  91. }
  92. if (!is_apm_ready_check_done && g_prm.is_adsp_up &&
  93. (gpr_get_q6_state() == GPR_SUBSYS_LOADED)) {
  94. pr_info("%s: apm ready check not done\n", __func__);
  95. retry = 0;
  96. while (!spf_core_is_apm_ready() && 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. static int _audio_prm_set_lpass_cpu_lpr_req(uint8_t enable)
  135. {
  136. struct gpr_pkt *pkt;
  137. struct prm_cpu_lpr_request_t prm_lpr_request;
  138. int ret = 0;
  139. uint32_t size;
  140. size = GPR_HDR_SIZE + sizeof(struct prm_cpu_lpr_request_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. prm_lpr_request.payload_header.payload_address_lsw = 0;
  157. prm_lpr_request.payload_header.payload_address_msw = 0;
  158. prm_lpr_request.payload_header.mem_map_handle = 0;
  159. prm_lpr_request.payload_header.payload_size = sizeof(struct prm_cpu_lpr_request_t) -
  160. sizeof(apm_cmd_header_t);
  161. /** Populate the param payload */
  162. prm_lpr_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  163. prm_lpr_request.module_payload_0.error_code = 0;
  164. prm_lpr_request.module_payload_0.param_id = PARAM_ID_RSC_CPU_LPR;
  165. prm_lpr_request.module_payload_0.param_size =
  166. sizeof(struct prm_cpu_lpr_request_t) -
  167. sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  168. prm_lpr_request.lpr_state = LPR_CPU_SS_SLEEP_DISABLED;
  169. memcpy(&pkt->payload, &prm_lpr_request, sizeof(struct prm_cpu_lpr_request_t));
  170. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  171. kfree(pkt);
  172. return ret;
  173. }
  174. /**
  175. */
  176. int _audio_prm_set_lpass_hw_core_req(uint32_t hw_core_id, uint8_t enable)
  177. {
  178. struct gpr_pkt *pkt;
  179. prm_cmd_request_hw_core_t prm_rsc_request;
  180. int ret = 0;
  181. uint32_t size;
  182. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_hw_core_t);
  183. pkt = kzalloc(size, GFP_KERNEL);
  184. if (!pkt)
  185. return -ENOMEM;
  186. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  187. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  188. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  189. pkt->hdr.src_port = GPR_SVC_ASM;
  190. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  191. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  192. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  193. pkt->hdr.token = 0; /* TBD */
  194. if (enable)
  195. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  196. else
  197. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  198. prm_rsc_request.payload_header.payload_address_lsw = 0;
  199. prm_rsc_request.payload_header.payload_address_msw = 0;
  200. prm_rsc_request.payload_header.mem_map_handle = 0;
  201. prm_rsc_request.payload_header.payload_size = sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t);
  202. /** Populate the param payload */
  203. prm_rsc_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  204. prm_rsc_request.module_payload_0.error_code = 0;
  205. prm_rsc_request.module_payload_0.param_id = PARAM_ID_RSC_HW_CORE;
  206. prm_rsc_request.module_payload_0.param_size =
  207. sizeof(prm_cmd_request_hw_core_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  208. prm_rsc_request.hw_core_id = hw_core_id;
  209. memcpy(&pkt->payload, &prm_rsc_request, sizeof(prm_cmd_request_hw_core_t));
  210. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  211. kfree(pkt);
  212. return ret;
  213. }
  214. int audio_prm_set_lpass_hw_core_req(struct clk_cfg *cfg, uint32_t hw_core_id, uint8_t enable)
  215. {
  216. if (hw_core_id == HW_CORE_ID_LPASS) {
  217. if (g_prm.prm_sleep_api_supported)
  218. return _audio_prm_set_lpass_cpu_lpr_req(enable);
  219. else
  220. return _audio_prm_set_lpass_hw_core_req(hw_core_id, enable);
  221. }
  222. return _audio_prm_set_lpass_hw_core_req(hw_core_id, enable);
  223. }
  224. EXPORT_SYMBOL(audio_prm_set_lpass_hw_core_req);
  225. /**
  226. * prm_set_lpass_clk_cfg() - Set PRM clock
  227. *
  228. * Return: 0 if clock set is success
  229. */
  230. static int audio_prm_set_lpass_clk_cfg_req(struct clk_cfg *cfg)
  231. {
  232. struct gpr_pkt *pkt;
  233. prm_cmd_request_rsc_t prm_rsc_request;
  234. int ret = 0;
  235. uint32_t size;
  236. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_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_REQUEST_HW_RSC;
  249. //pr_err("%s: clk_id %d size of cmd_req %ld \n",__func__, cfg->clk_id, sizeof(prm_cmd_request_rsc_t));
  250. prm_rsc_request.payload_header.payload_address_lsw = 0;
  251. prm_rsc_request.payload_header.payload_address_msw = 0;
  252. prm_rsc_request.payload_header.mem_map_handle = 0;
  253. prm_rsc_request.payload_header.payload_size = sizeof(prm_cmd_request_rsc_t) - sizeof(apm_cmd_header_t);
  254. /** Populate the param payload */
  255. prm_rsc_request.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  256. prm_rsc_request.module_payload_0.error_code = 0;
  257. prm_rsc_request.module_payload_0.param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
  258. prm_rsc_request.module_payload_0.param_size =
  259. sizeof(prm_cmd_request_rsc_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  260. prm_rsc_request.num_clk_id_t.num_clock_id = MAX_AUD_HW_CLK_NUM_REQ;
  261. prm_rsc_request.clock_ids_t[0].clock_id = cfg->clk_id;
  262. prm_rsc_request.clock_ids_t[0].clock_freq = cfg->clk_freq_in_hz;
  263. prm_rsc_request.clock_ids_t[0].clock_attri = cfg->clk_attri;
  264. /*
  265. * Set TX RCG to RCO if lpi pcm logging is enabled and any one of the
  266. * tx core clocks are enabled
  267. */
  268. if (g_prm.lpi_pcm_logging_enable &&
  269. ((cfg->clk_id == CLOCK_ID_TX_CORE_MCLK) ||
  270. (cfg->clk_id == CLOCK_ID_WSA_CORE_TX_MCLK) ||
  271. (cfg->clk_id == CLOCK_ID_WSA2_CORE_TX_MCLK) ||
  272. (cfg->clk_id == CLOCK_ID_RX_CORE_TX_MCLK)))
  273. prm_rsc_request.clock_ids_t[0].clock_root = CLOCK_ROOT_SRC_RCO;
  274. else
  275. prm_rsc_request.clock_ids_t[0].clock_root = cfg->clk_root;
  276. memcpy(&pkt->payload, &prm_rsc_request, sizeof(prm_cmd_request_rsc_t));
  277. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  278. kfree(pkt);
  279. return ret;
  280. }
  281. static int audio_prm_set_lpass_clk_cfg_rel(struct clk_cfg *cfg)
  282. {
  283. struct gpr_pkt *pkt;
  284. prm_cmd_release_rsc_t prm_rsc_release;
  285. int ret = 0;
  286. uint32_t size;
  287. size = GPR_HDR_SIZE + sizeof(prm_cmd_release_rsc_t);
  288. pkt = kzalloc(size, GFP_KERNEL);
  289. if (!pkt)
  290. return -ENOMEM;
  291. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  292. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  293. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  294. pkt->hdr.src_port = GPR_SVC_ASM;
  295. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  296. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  297. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  298. pkt->hdr.token = 0; /* TBD */
  299. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  300. //pr_err("%s: clk_id %d size of cmd_req %ld \n",__func__, cfg->clk_id, sizeof(prm_cmd_release_rsc_t));
  301. prm_rsc_release.payload_header.payload_address_lsw = 0;
  302. prm_rsc_release.payload_header.payload_address_msw = 0;
  303. prm_rsc_release.payload_header.mem_map_handle = 0;
  304. prm_rsc_release.payload_header.payload_size = sizeof(prm_cmd_release_rsc_t) - sizeof(apm_cmd_header_t);
  305. /** Populate the param payload */
  306. prm_rsc_release.module_payload_0.module_instance_id = PRM_MODULE_INSTANCE_ID;
  307. prm_rsc_release.module_payload_0.error_code = 0;
  308. prm_rsc_release.module_payload_0.param_id = PARAM_ID_RSC_AUDIO_HW_CLK;
  309. prm_rsc_release.module_payload_0.param_size =
  310. sizeof(prm_cmd_release_rsc_t) - sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  311. prm_rsc_release.num_clk_id_t.num_clock_id = MAX_AUD_HW_CLK_NUM_REQ;
  312. prm_rsc_release.clock_ids_t[0].clock_id = cfg->clk_id;
  313. memcpy(&pkt->payload, &prm_rsc_release, sizeof(prm_cmd_release_rsc_t));
  314. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  315. kfree(pkt);
  316. return ret;
  317. }
  318. /**
  319. * audio_prm_set_cdc_earpa_duty_cycling_req() - send codec reg values
  320. * for codec duty cycling.
  321. *
  322. * Return: 0 if reg passing is success.
  323. */
  324. int audio_prm_set_cdc_earpa_duty_cycling_req(struct prm_earpa_hw_intf_config *earpa_config,
  325. uint32_t enable)
  326. {
  327. struct gpr_pkt *pkt;
  328. prm_cmd_request_cdc_duty_cycling_t prm_rsc_request_reg_info;
  329. int ret = 0;
  330. uint32_t size;
  331. size = GPR_HDR_SIZE + sizeof(prm_cmd_request_cdc_duty_cycling_t);
  332. pkt = kzalloc(size, GFP_KERNEL);
  333. if (!pkt)
  334. return -ENOMEM;
  335. pkt->hdr.header = GPR_SET_FIELD(GPR_PKT_VERSION, GPR_PKT_VER) |
  336. GPR_SET_FIELD(GPR_PKT_HEADER_SIZE, GPR_PKT_HEADER_WORD_SIZE_V) |
  337. GPR_SET_FIELD(GPR_PKT_PACKET_SIZE, size);
  338. pkt->hdr.src_port = GPR_SVC_ASM;
  339. pkt->hdr.dst_port = PRM_MODULE_INSTANCE_ID;
  340. pkt->hdr.dst_domain_id = GPR_IDS_DOMAIN_ID_ADSP_V;
  341. pkt->hdr.src_domain_id = GPR_IDS_DOMAIN_ID_APPS_V;
  342. pkt->hdr.token = 0;
  343. if (enable)
  344. pkt->hdr.opcode = PRM_CMD_REQUEST_HW_RSC;
  345. else
  346. pkt->hdr.opcode = PRM_CMD_RELEASE_HW_RSC;
  347. memset(&prm_rsc_request_reg_info, 0, sizeof(prm_cmd_request_cdc_duty_cycling_t));
  348. prm_rsc_request_reg_info.payload_header.payload_address_lsw = 0;
  349. prm_rsc_request_reg_info.payload_header.payload_address_msw = 0;
  350. prm_rsc_request_reg_info.payload_header.mem_map_handle = 0;
  351. prm_rsc_request_reg_info.payload_header.payload_size =
  352. sizeof(prm_cmd_request_cdc_duty_cycling_t) - sizeof(apm_cmd_header_t);
  353. /* Populate the param payload */
  354. prm_rsc_request_reg_info.module_payload_0.module_instance_id =
  355. PRM_MODULE_INSTANCE_ID;
  356. prm_rsc_request_reg_info.module_payload_0.error_code = 0;
  357. prm_rsc_request_reg_info.module_payload_0.param_id =
  358. PARAM_ID_RSC_HW_CODEC_REG_INFO;
  359. prm_rsc_request_reg_info.module_payload_0.param_size =
  360. sizeof(prm_cmd_request_cdc_duty_cycling_t) -
  361. sizeof(apm_cmd_header_t) - sizeof(apm_module_param_data_t);
  362. prm_rsc_request_reg_info.hw_codec_reg_info_t.num_reg_info_t = MAX_EARPA_REG;
  363. /* Setting up DIGITAL Mute register value */
  364. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_id =
  365. HW_CODEC_DIG_REG_ID_MUTE_CTRL;
  366. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_addr_msw = 0;
  367. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_reg_addr_lsw =
  368. earpa_config->ear_pa_hw_reg_cfg.lpass_cdc_rx0_rx_path_ctl_phy_addr;
  369. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].num_ops =
  370. MAX_EARPA_CDC_DUTY_CYC_OPERATION;
  371. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[0].hw_codec_op_id =
  372. HW_CODEC_OP_DIG_MUTE_ENABLE;
  373. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[0].hw_codec_op_value =
  374. DIG_MUTE_ENABLE;
  375. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[1].hw_codec_op_id =
  376. HW_CODEC_OP_DIG_MUTE_DISABLE;
  377. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[0].hw_codec_op[1].hw_codec_op_value =
  378. DIG_MUTE_DISABLE;
  379. /* Setting up LPASS_PA_REG Values */
  380. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_id =
  381. HW_CODEC_ANALOG_REG_ID_CMD_FIFO_WRITE;
  382. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_addr_msw = 0;
  383. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_reg_addr_lsw =
  384. earpa_config->ear_pa_hw_reg_cfg.lpass_wr_fifo_reg_phy_addr;
  385. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].num_ops =
  386. MAX_EARPA_CDC_DUTY_CYC_OPERATION;
  387. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[0].hw_codec_op_id =
  388. HW_CODEC_OP_ANA_PGA_ENABLE;
  389. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[0].hw_codec_op_value =
  390. earpa_config->ear_pa_pkd_cfg.ear_pa_enable_pkd_reg_addr;
  391. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[1].hw_codec_op_id =
  392. HW_CODEC_OP_ANA_PGA_DISABLE;
  393. prm_rsc_request_reg_info.hw_codec_reg_info_t.hw_codec_reg[1].hw_codec_op[1].hw_codec_op_value =
  394. earpa_config->ear_pa_pkd_cfg.ear_pa_disable_pkd_reg_addr;
  395. memcpy(&pkt->payload, &prm_rsc_request_reg_info, sizeof(prm_cmd_request_cdc_duty_cycling_t));
  396. ret = prm_gpr_send_pkt(pkt, &g_prm.wait);
  397. kfree(pkt);
  398. return ret;
  399. }
  400. EXPORT_SYMBOL(audio_prm_set_cdc_earpa_duty_cycling_req);
  401. int audio_prm_set_vote_against_sleep(uint8_t enable)
  402. {
  403. if (g_prm.prm_sleep_api_supported)
  404. return _audio_prm_set_lpass_cpu_lpr_req(enable);
  405. else
  406. return _audio_prm_set_lpass_hw_core_req(HW_CORE_ID_LPASS, enable);
  407. }
  408. EXPORT_SYMBOL(audio_prm_set_vote_against_sleep);
  409. int audio_prm_set_lpass_clk_cfg (struct clk_cfg *clk, uint8_t enable)
  410. {
  411. int ret = 0;
  412. if (enable)
  413. ret = audio_prm_set_lpass_clk_cfg_req (clk);
  414. else
  415. ret = audio_prm_set_lpass_clk_cfg_rel (clk);
  416. return ret;
  417. }
  418. EXPORT_SYMBOL(audio_prm_set_lpass_clk_cfg);
  419. static int audio_prm_service_cb(struct notifier_block *this,
  420. unsigned long opcode, void *data)
  421. {
  422. pr_info("%s: Service opcode 0x%lx\n", __func__, opcode);
  423. switch (opcode) {
  424. case AUDIO_NOTIFIER_SERVICE_DOWN:
  425. mutex_lock(&g_prm.lock);
  426. pr_debug("%s: making apm_ready check false\n", __func__);
  427. is_apm_ready_check_done = false;
  428. g_prm.is_adsp_up = false;
  429. mutex_unlock(&g_prm.lock);
  430. break;
  431. case AUDIO_NOTIFIER_SERVICE_UP:
  432. mutex_lock(&g_prm.lock);
  433. g_prm.is_adsp_up = true;
  434. mutex_unlock(&g_prm.lock);
  435. break;
  436. default:
  437. break;
  438. }
  439. return NOTIFY_OK;
  440. }
  441. static struct notifier_block service_nb = {
  442. .notifier_call = audio_prm_service_cb,
  443. .priority = -INT_MAX,
  444. };
  445. static int audio_prm_probe(struct gpr_device *adev)
  446. {
  447. int ret = 0;
  448. struct device *dev = &adev->dev;
  449. if (!audio_notifier_probe_status()) {
  450. pr_err("%s: Audio notify probe not completed, defer audio prm probe\n",
  451. __func__);
  452. return -EPROBE_DEFER;
  453. }
  454. ret = audio_notifier_register("audio_prm", AUDIO_NOTIFIER_ADSP_DOMAIN,
  455. &service_nb);
  456. if (ret < 0) {
  457. if (ret != -EPROBE_DEFER)
  458. pr_err("%s: Audio notifier register failed ret = %d\n",
  459. __func__, ret);
  460. return ret;
  461. }
  462. dev_set_drvdata(&adev->dev, &g_prm);
  463. ret = of_property_read_u32(dev->of_node,
  464. "qcom,sleep-api-supported", &g_prm.prm_sleep_api_supported);
  465. if (ret < 0)
  466. pr_debug("%s: sleep API not supported\n", __func__);
  467. g_prm.adev = adev;
  468. init_waitqueue_head(&g_prm.wait);
  469. g_prm.is_adsp_up = true;
  470. pr_err("%s: prm probe success, Sleep API supported :%d\n",
  471. __func__, g_prm.prm_sleep_api_supported);
  472. return ret;
  473. }
  474. static int audio_prm_remove(struct gpr_device *adev)
  475. {
  476. int ret = 0;
  477. audio_notifier_deregister("audio_prm");
  478. mutex_lock(&g_prm.lock);
  479. g_prm.is_adsp_up = false;
  480. g_prm.adev = NULL;
  481. mutex_unlock(&g_prm.lock);
  482. return ret;
  483. }
  484. static const struct of_device_id audio_prm_device_id[] = {
  485. { .compatible = "qcom,audio_prm" },
  486. {},
  487. };
  488. MODULE_DEVICE_TABLE(of, audio_prm_device_id);
  489. static struct gpr_driver qcom_audio_prm_driver = {
  490. .probe = audio_prm_probe,
  491. .remove = audio_prm_remove,
  492. .callback = audio_prm_callback,
  493. .driver = {
  494. .name = "qcom-audio_prm",
  495. .of_match_table = of_match_ptr(audio_prm_device_id),
  496. },
  497. };
  498. static int __init audio_prm_module_init(void)
  499. {
  500. int ret;
  501. ret = gpr_driver_register(&qcom_audio_prm_driver);
  502. if (ret)
  503. pr_err("%s: gpr driver register failed = %d\n", __func__, ret);
  504. mutex_init(&g_prm.lock);
  505. return ret;
  506. }
  507. static void __exit audio_prm_module_exit(void)
  508. {
  509. mutex_destroy(&g_prm.lock);
  510. gpr_driver_unregister(&qcom_audio_prm_driver);
  511. }
  512. module_init(audio_prm_module_init);
  513. module_exit(audio_prm_module_exit);
  514. MODULE_DESCRIPTION("audio prm");
  515. MODULE_LICENSE("GPL v2");