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