swr-dmic.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
  4. */
  5. #include <linux/module.h>
  6. #include <linux/init.h>
  7. #include <linux/slab.h>
  8. #include <linux/platform_device.h>
  9. #include <linux/device.h>
  10. #include <linux/printk.h>
  11. #include <linux/bitops.h>
  12. #include <linux/regulator/consumer.h>
  13. #include <linux/pm_runtime.h>
  14. #include <linux/delay.h>
  15. #include <linux/kernel.h>
  16. #include <linux/gpio.h>
  17. #include <linux/of_gpio.h>
  18. #include <linux/of_platform.h>
  19. #include <linux/debugfs.h>
  20. #include <soc/soundwire.h>
  21. #include <sound/pcm.h>
  22. #include <sound/pcm_params.h>
  23. #include <sound/soc.h>
  24. #include <sound/soc-dapm.h>
  25. #include <sound/tlv.h>
  26. #include <asoc/msm-cdc-pinctrl.h>
  27. #include <asoc/msm-cdc-supply.h>
  28. #include <dt-bindings/sound/audio-codec-port-types.h>
  29. #include "wcd938x/wcd938x.h"
  30. #include "swr-dmic.h"
  31. #define NUM_ATTEMPTS 5
  32. #define SWRS_SCP_CONTROL 0x44
  33. static int swr_master_channel_map[] = {
  34. ZERO,
  35. SWRM_TX1_CH1,
  36. SWRM_TX1_CH2,
  37. SWRM_TX1_CH3,
  38. SWRM_TX1_CH4,
  39. SWRM_TX2_CH1,
  40. SWRM_TX2_CH2,
  41. SWRM_TX2_CH3,
  42. SWRM_TX2_CH4,
  43. SWRM_TX3_CH1,
  44. SWRM_TX3_CH2,
  45. SWRM_TX3_CH3,
  46. SWRM_TX3_CH4,
  47. SWRM_PCM_IN,
  48. };
  49. /*
  50. * Private data Structure for swr-dmic. All parameters related to
  51. * external mic codec needs to be defined here.
  52. */
  53. struct swr_dmic_priv {
  54. struct device *dev;
  55. struct swr_device *swr_slave;
  56. struct snd_soc_component *component;
  57. struct snd_soc_component_driver *driver;
  58. struct snd_soc_dai_driver *dai_driver;
  59. struct snd_soc_component *supply_component;
  60. u32 micb_num;
  61. struct device_node *wcd_handle;
  62. bool is_wcd_supply;
  63. int is_en_supply;
  64. int port_type;
  65. u8 tx_master_port_map[SWR_DMIC_MAX_PORTS];
  66. struct notifier_block nblock;
  67. };
  68. const char *codec_name_list[] = {
  69. "swr-dmic.01",
  70. "swr-dmic.02",
  71. "swr-dmic.03",
  72. "swr-dmic.04",
  73. };
  74. const char *dai_name_list[] = {
  75. "swr_dmic_tx0",
  76. "swr_dmic_tx1",
  77. "swr_dmic_tx2",
  78. "swr_dmic_tx3",
  79. };
  80. const char *aif_name_list[] = {
  81. "SWR_DMIC_AIF0 Capture",
  82. "SWR_DMIC_AIF1 Capture",
  83. "SWR_DMIC_AIF2 Capture",
  84. "SWR_DMIC_AIF3 Capture",
  85. };
  86. static int swr_dmic_reset(struct swr_device *pdev);
  87. static int swr_dmic_up(struct swr_device *pdev);
  88. static int swr_dmic_down(struct swr_device *pdev);
  89. static inline int swr_dmic_tx_get_slave_port_type_idx(const char *wname,
  90. unsigned int *port_idx)
  91. {
  92. u8 port_type;
  93. if (strnstr(wname, "HIFI", strlen(wname)))
  94. port_type = SWR_DMIC_HIFI_PORT;
  95. else if (strnstr(wname, "LP", strlen(wname)))
  96. port_type = SWR_DMIC_LP_PORT;
  97. else
  98. return -EINVAL;
  99. *port_idx = port_type;
  100. return 0;
  101. }
  102. static inline int swr_dmic_get_master_port_val(int port)
  103. {
  104. int i;
  105. for (i = 0; i < ARRAY_SIZE(swr_master_channel_map); i++)
  106. if (port == swr_master_channel_map[i])
  107. return i;
  108. return 0;
  109. }
  110. static int swr_dmic_tx_master_port_get(struct snd_kcontrol *kcontrol,
  111. struct snd_ctl_elem_value *ucontrol)
  112. {
  113. struct snd_soc_component *component =
  114. snd_soc_kcontrol_component(kcontrol);
  115. struct swr_dmic_priv *swr_dmic = snd_soc_component_get_drvdata(component);
  116. int ret = 0;
  117. int slave_port_idx;
  118. ret = swr_dmic_tx_get_slave_port_type_idx(kcontrol->id.name,
  119. &slave_port_idx);
  120. if (ret) {
  121. dev_dbg(component->dev, "%s: invalid port string\n", __func__);
  122. return ret;
  123. }
  124. swr_dmic->port_type = slave_port_idx;
  125. ucontrol->value.integer.value[0] =
  126. swr_dmic_get_master_port_val(
  127. swr_dmic->tx_master_port_map[slave_port_idx]);
  128. dev_dbg(component->dev, "%s: ucontrol->value.integer.value[0] = %ld\n",
  129. __func__, ucontrol->value.integer.value[0]);
  130. return 0;
  131. }
  132. static int swr_dmic_tx_master_port_put(struct snd_kcontrol *kcontrol,
  133. struct snd_ctl_elem_value *ucontrol)
  134. {
  135. struct snd_soc_component *component =
  136. snd_soc_kcontrol_component(kcontrol);
  137. struct swr_dmic_priv *swr_dmic = snd_soc_component_get_drvdata(component);
  138. int ret = 0;
  139. int slave_port_idx;
  140. ret = swr_dmic_tx_get_slave_port_type_idx(kcontrol->id.name,
  141. &slave_port_idx);
  142. if (ret) {
  143. dev_dbg(component->dev, "%s: invalid port string\n", __func__);
  144. return ret;
  145. }
  146. swr_dmic->port_type = slave_port_idx;
  147. swr_dmic->tx_master_port_map[slave_port_idx] =
  148. swr_master_channel_map[ucontrol->value.enumerated.item[0]];
  149. dev_dbg(component->dev, "%s: slv port id: %d, master_port_type: %d\n",
  150. __func__, slave_port_idx,
  151. swr_dmic->tx_master_port_map[slave_port_idx]);
  152. return 0;
  153. }
  154. static int swr_dmic_port_enable(struct snd_soc_dapm_widget *w,
  155. struct snd_kcontrol *kcontrol, int event)
  156. {
  157. int ret = 0;
  158. struct snd_soc_component *component =
  159. snd_soc_dapm_to_component(w->dapm);
  160. struct swr_dmic_priv *swr_dmic =
  161. snd_soc_component_get_drvdata(component);
  162. u8 ch_mask = 0x01; // only DpnChannelEN1 register is available
  163. u8 num_port = 1;
  164. u8 port_id = swr_dmic->port_type;
  165. u8 port_type = swr_dmic->tx_master_port_map[port_id];
  166. switch (event) {
  167. case SND_SOC_DAPM_POST_PMU:
  168. ret = swr_slvdev_datapath_control(swr_dmic->swr_slave,
  169. swr_dmic->swr_slave->dev_num, true);
  170. break;
  171. case SND_SOC_DAPM_PRE_PMD:
  172. ret = swr_disconnect_port(swr_dmic->swr_slave,
  173. &port_id, num_port, &ch_mask, &port_type);
  174. break;
  175. };
  176. return ret;
  177. }
  178. static int dmic_swr_ctrl(struct snd_soc_dapm_widget *w,
  179. struct snd_kcontrol *kcontrol, int event)
  180. {
  181. int ret = 0;
  182. struct snd_soc_component *component =
  183. snd_soc_dapm_to_component(w->dapm);
  184. struct swr_dmic_priv *swr_dmic =
  185. snd_soc_component_get_drvdata(component);
  186. u8 num_ch = 1;
  187. u8 ch_mask = 0x01; // only DpnChannelEN1 register is available
  188. u32 ch_rate = SWR_CLK_RATE_4P8MHZ;
  189. u8 num_port = 1;
  190. u8 port_type = 0;
  191. u8 port_id = swr_dmic->port_type;
  192. /*
  193. * Port 1 is high quality / 2.4 or 3.072 Mbps
  194. * Port 2 is listen low power / 0.6 or 0.768 Mbps
  195. */
  196. if(swr_dmic->port_type == SWR_DMIC_HIFI_PORT)
  197. ch_rate = SWR_CLK_RATE_2P4MHZ;
  198. else
  199. ch_rate = SWR_CLK_RATE_0P6MHZ;
  200. port_type = swr_dmic->tx_master_port_map[port_id];
  201. dev_dbg(component->dev, "%s port_type: %d event: %d\n", __func__,
  202. port_type, event);
  203. switch (event) {
  204. case SND_SOC_DAPM_PRE_PMU:
  205. ret = swr_connect_port(swr_dmic->swr_slave, &port_id,
  206. num_port, &ch_mask, &ch_rate,
  207. &num_ch, &port_type);
  208. break;
  209. case SND_SOC_DAPM_POST_PMD:
  210. ret = swr_slvdev_datapath_control(swr_dmic->swr_slave,
  211. swr_dmic->swr_slave->dev_num, false);
  212. break;
  213. };
  214. return ret;
  215. }
  216. static const char * const tx_master_port_text[] = {
  217. "ZERO", "SWRM_TX1_CH1", "SWRM_TX1_CH2", "SWRM_TX1_CH3", "SWRM_TX1_CH4",
  218. "SWRM_TX2_CH1", "SWRM_TX2_CH2", "SWRM_TX2_CH3", "SWRM_TX2_CH4",
  219. "SWRM_TX3_CH1", "SWRM_TX3_CH2", "SWRM_TX3_CH3", "SWRM_TX3_CH4",
  220. "SWRM_PCM_IN",
  221. };
  222. static const struct soc_enum tx_master_port_enum =
  223. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tx_master_port_text),
  224. tx_master_port_text);
  225. static const struct snd_kcontrol_new swr_dmic_snd_controls[] = {
  226. SOC_ENUM_EXT("HIFI PortMap", tx_master_port_enum,
  227. swr_dmic_tx_master_port_get, swr_dmic_tx_master_port_put),
  228. SOC_ENUM_EXT("LP PortMap", tx_master_port_enum,
  229. swr_dmic_tx_master_port_get, swr_dmic_tx_master_port_put),
  230. };
  231. static const struct snd_kcontrol_new dmic_switch[] = {
  232. SOC_DAPM_SINGLE("Switch", SND_SOC_NOPM, 0, 1, 0)
  233. };
  234. static const struct snd_soc_dapm_widget swr_dmic_dapm_widgets[] = {
  235. SND_SOC_DAPM_MIXER_E("SWR_DMIC_MIXER", SND_SOC_NOPM, 0, 0,
  236. dmic_switch, ARRAY_SIZE(dmic_switch), dmic_swr_ctrl,
  237. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  238. SND_SOC_DAPM_INPUT("SWR_DMIC"),
  239. SND_SOC_DAPM_OUT_DRV_E("SMIC_PORT_EN", SND_SOC_NOPM, 0, 0, NULL, 0,
  240. swr_dmic_port_enable,
  241. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
  242. SND_SOC_DAPM_OUTPUT("SWR_DMIC_OUTPUT"),
  243. };
  244. static const struct snd_soc_dapm_route swr_dmic_audio_map[] = {
  245. {"SWR_DMIC_MIXER", "Switch", "SWR_DMIC"},
  246. {"SMIC_PORT_EN", NULL, "SWR_DMIC_MIXER"},
  247. {"SWR_DMIC_OUTPUT", NULL, "SMIC_PORT_EN"},
  248. };
  249. static int swr_dmic_codec_probe(struct snd_soc_component *component)
  250. {
  251. struct swr_dmic_priv *swr_dmic =
  252. snd_soc_component_get_drvdata(component);
  253. struct snd_soc_dapm_context *dapm =
  254. snd_soc_component_get_dapm(component);
  255. char w_name[100];
  256. if (!swr_dmic)
  257. return -EINVAL;
  258. swr_dmic->component = component;
  259. snd_soc_dapm_ignore_suspend(dapm,
  260. swr_dmic->dai_driver->capture.stream_name);
  261. memset(w_name, 0, 100);
  262. strlcpy(w_name, component->name_prefix, 100);
  263. strlcat(w_name, " SWR_DMIC", 100);
  264. snd_soc_dapm_ignore_suspend(dapm, w_name);
  265. memset(w_name, 0, 100);
  266. strlcpy(w_name, component->name_prefix, 100);
  267. strlcat(w_name, " SMIC_SUPPLY", 100);
  268. snd_soc_dapm_ignore_suspend(dapm, w_name);
  269. memset(w_name, 0, 100);
  270. strlcpy(w_name, component->name_prefix, 100);
  271. strlcat(w_name, " SMIC_PORT_EN", 100);
  272. snd_soc_dapm_ignore_suspend(dapm, w_name);
  273. memset(w_name, 0, 100);
  274. strlcpy(w_name, component->name_prefix, 100);
  275. strlcat(w_name, " SWR_DMIC_OUTPUT", 100);
  276. snd_soc_dapm_ignore_suspend(dapm, w_name);
  277. snd_soc_dapm_sync(dapm);
  278. return 0;
  279. }
  280. static void swr_dmic_codec_remove(struct snd_soc_component *component)
  281. {
  282. struct swr_dmic_priv *swr_dmic =
  283. snd_soc_component_get_drvdata(component);
  284. swr_dmic->component = NULL;
  285. return;
  286. }
  287. static const struct snd_soc_component_driver soc_codec_dev_swr_dmic = {
  288. .name = NULL,
  289. .probe = swr_dmic_codec_probe,
  290. .remove = swr_dmic_codec_remove,
  291. .controls = swr_dmic_snd_controls,
  292. .num_controls = ARRAY_SIZE(swr_dmic_snd_controls),
  293. .dapm_widgets = swr_dmic_dapm_widgets,
  294. .num_dapm_widgets = ARRAY_SIZE(swr_dmic_dapm_widgets),
  295. .dapm_routes = swr_dmic_audio_map,
  296. .num_dapm_routes = ARRAY_SIZE(swr_dmic_audio_map),
  297. };
  298. static int enable_wcd_codec_supply(struct swr_dmic_priv *swr_dmic, bool enable)
  299. {
  300. int rc = 0;
  301. int micb_num = swr_dmic->micb_num;
  302. struct snd_soc_component *component = swr_dmic->supply_component;
  303. if (!component) {
  304. pr_err("%s: component is NULL\n", __func__);
  305. return -EINVAL;
  306. }
  307. dev_dbg(component->dev, "%s: supply %d micbias: %d enable: %d\n",
  308. __func__, swr_dmic->is_en_supply, micb_num, enable);
  309. if (enable)
  310. rc = wcd938x_codec_force_enable_micbias_v2(component,
  311. SND_SOC_DAPM_PRE_PMU, micb_num);
  312. else
  313. rc = wcd938x_codec_force_enable_micbias_v2(component,
  314. SND_SOC_DAPM_POST_PMD, micb_num);
  315. return rc;
  316. }
  317. static int swr_dmic_parse_supply(struct device_node *np,
  318. struct swr_dmic_priv *swr_dmic)
  319. {
  320. struct platform_device *pdev = NULL;
  321. if (!np || !swr_dmic)
  322. return -EINVAL;
  323. pdev = of_find_device_by_node(np);
  324. if (!pdev)
  325. return -EINVAL;
  326. swr_dmic->supply_component = snd_soc_lookup_component(&pdev->dev, NULL);
  327. return 0;
  328. }
  329. static struct snd_soc_dai_driver swr_dmic_dai[] = {
  330. {
  331. .name = "",
  332. .id = 0,
  333. .capture = {
  334. .stream_name = "",
  335. .rates = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |
  336. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |
  337. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000),
  338. .formats = (SNDRV_PCM_FMTBIT_S16_LE |
  339. SNDRV_PCM_FMTBIT_S24_LE |
  340. SNDRV_PCM_FMTBIT_S32_LE),
  341. .rate_max = 192000,
  342. .rate_min = 8000,
  343. .channels_min = 1,
  344. .channels_max = 2,
  345. },
  346. },
  347. };
  348. static int swr_dmic_event_notify(struct notifier_block *block,
  349. unsigned long val,
  350. void *data)
  351. {
  352. u16 event = (val & 0xffff);
  353. int ret = 0;
  354. struct swr_dmic_priv *swr_dmic = container_of(block,
  355. struct swr_dmic_priv,
  356. nblock);
  357. switch (event) {
  358. case WCD938X_EVT_SSR_DOWN:
  359. ret = swr_dmic_down(swr_dmic->swr_slave);
  360. break;
  361. case WCD938X_EVT_SSR_UP:
  362. ret = swr_dmic_up(swr_dmic->swr_slave);
  363. if (!ret)
  364. ret = swr_dmic_reset(swr_dmic->swr_slave);
  365. break;
  366. }
  367. return ret;
  368. }
  369. static int swr_dmic_probe(struct swr_device *pdev)
  370. {
  371. int ret = 0;
  372. int i = 0;
  373. u8 swr_devnum = 0;
  374. int dev_index = -1;
  375. char* prefix_name = NULL;
  376. struct swr_dmic_priv *swr_dmic = NULL;
  377. const char *swr_dmic_name_prefix_of = NULL;
  378. const char *swr_dmic_codec_name_of = NULL;
  379. struct snd_soc_component *component = NULL;
  380. int num_retry = NUM_ATTEMPTS;
  381. swr_dmic = devm_kzalloc(&pdev->dev, sizeof(struct swr_dmic_priv),
  382. GFP_KERNEL);
  383. if (!swr_dmic)
  384. return -ENOMEM;
  385. ret = of_property_read_u32(pdev->dev.of_node, "qcom,swr-dmic-supply",
  386. &swr_dmic->micb_num);
  387. if (ret) {
  388. dev_dbg(&pdev->dev, "%s: Looking up %s property in node %s failed\n",
  389. __func__, "qcom,swr-dmic-supply",
  390. pdev->dev.of_node->full_name);
  391. goto err;
  392. }
  393. swr_dmic->wcd_handle = of_parse_phandle(pdev->dev.of_node,
  394. "qcom,wcd-handle", 0);
  395. if (!swr_dmic->wcd_handle) {
  396. dev_dbg(&pdev->dev, "%s: no wcd handle listed\n",
  397. __func__);
  398. swr_dmic->is_wcd_supply = false;
  399. } else {
  400. swr_dmic_parse_supply(swr_dmic->wcd_handle, swr_dmic);
  401. swr_dmic->is_wcd_supply = true;
  402. }
  403. if (swr_dmic->is_wcd_supply) {
  404. ret = enable_wcd_codec_supply(swr_dmic, true);
  405. if (ret) {
  406. ret = -EPROBE_DEFER;
  407. goto err;
  408. }
  409. ++swr_dmic->is_en_supply;
  410. }
  411. swr_set_dev_data(pdev, swr_dmic);
  412. swr_dmic->swr_slave = pdev;
  413. ret = of_property_read_string(pdev->dev.of_node, "qcom,swr-dmic-prefix",
  414. &swr_dmic_name_prefix_of);
  415. if (ret) {
  416. dev_dbg(&pdev->dev, "%s: Looking up %s property in node %s failed\n",
  417. __func__, "qcom,swr-dmic-prefix",
  418. pdev->dev.of_node->full_name);
  419. goto dev_err;
  420. }
  421. ret = of_property_read_string(pdev->dev.of_node, "qcom,codec-name",
  422. &swr_dmic_codec_name_of);
  423. if (ret) {
  424. dev_dbg(&pdev->dev, "%s: Looking up %s property in node %s failed\n",
  425. __func__, "qcom,codec-name",
  426. pdev->dev.of_node->full_name);
  427. goto dev_err;
  428. }
  429. /*
  430. * Add 5msec delay to provide sufficient time for
  431. * soundwire auto enumeration of slave devices as
  432. * as per HW requirement.
  433. */
  434. usleep_range(5000, 5010);
  435. do {
  436. /* Add delay for soundwire enumeration */
  437. usleep_range(100, 110);
  438. ret = swr_get_logical_dev_num(pdev, pdev->addr, &swr_devnum);
  439. } while (ret && --num_retry);
  440. if (ret) {
  441. dev_info(&pdev->dev,
  442. "%s get devnum %d for dev addr %llx failed\n",
  443. __func__, swr_devnum, pdev->addr);
  444. ret = -EPROBE_DEFER;
  445. goto dev_err;
  446. }
  447. pdev->dev_num = swr_devnum;
  448. swr_dmic->driver = devm_kzalloc(&pdev->dev,
  449. sizeof(struct snd_soc_component_driver), GFP_KERNEL);
  450. if (!swr_dmic->driver) {
  451. ret = -ENOMEM;
  452. goto dev_err;
  453. }
  454. memcpy(swr_dmic->driver, &soc_codec_dev_swr_dmic,
  455. sizeof(struct snd_soc_component_driver));
  456. for (i = 0; i < ARRAY_SIZE(codec_name_list); i++) {
  457. if (!strcmp(swr_dmic_codec_name_of, codec_name_list[i])) {
  458. dev_index = i;
  459. break;
  460. }
  461. }
  462. if (dev_index < 0) {
  463. ret = -EINVAL;
  464. goto dev_err;
  465. }
  466. swr_dmic->driver->name = codec_name_list[dev_index];
  467. swr_dmic->dai_driver = devm_kzalloc(&pdev->dev,
  468. sizeof(struct snd_soc_dai_driver), GFP_KERNEL);
  469. if (!swr_dmic->dai_driver) {
  470. ret = -ENOMEM;
  471. goto dev_err;
  472. }
  473. memcpy(swr_dmic->dai_driver, swr_dmic_dai,
  474. sizeof(struct snd_soc_dai_driver));
  475. swr_dmic->dai_driver->id = dev_index;
  476. swr_dmic->dai_driver->name = dai_name_list[dev_index];
  477. swr_dmic->dai_driver->capture.stream_name = aif_name_list[dev_index];
  478. /* Number of DAI's used is 1 */
  479. ret = snd_soc_register_component(&pdev->dev, swr_dmic->driver,
  480. swr_dmic->dai_driver, 1);
  481. if (ret) {
  482. dev_err(&pdev->dev, "%s: Codec registration failed\n",
  483. __func__);
  484. goto dev_err;
  485. }
  486. component = snd_soc_lookup_component(&pdev->dev,
  487. swr_dmic->driver->name);
  488. if (!component) {
  489. dev_err(&pdev->dev, "%s: could not find swr_dmic component\n",
  490. __func__);
  491. goto dev_err;
  492. }
  493. swr_dmic->component = component;
  494. prefix_name = devm_kzalloc(&pdev->dev,
  495. strlen(swr_dmic_name_prefix_of) + 1,
  496. GFP_KERNEL);
  497. if (!prefix_name) {
  498. ret = -ENOMEM;
  499. goto dev_err;
  500. }
  501. strlcpy(prefix_name, swr_dmic_name_prefix_of,
  502. strlen(swr_dmic_name_prefix_of) + 1);
  503. component->name_prefix = prefix_name;
  504. swr_dmic->nblock.notifier_call = swr_dmic_event_notify;
  505. wcd938x_swr_dmic_register_notifier(swr_dmic->supply_component,
  506. &swr_dmic->nblock, true);
  507. return 0;
  508. dev_err:
  509. if (swr_dmic->is_en_supply == 1) {
  510. enable_wcd_codec_supply(swr_dmic, false);
  511. --swr_dmic->is_en_supply;
  512. }
  513. swr_dmic->is_wcd_supply = false;
  514. swr_dmic->wcd_handle = NULL;
  515. swr_remove_device(pdev);
  516. err:
  517. return ret;
  518. }
  519. static int swr_dmic_remove(struct swr_device *pdev)
  520. {
  521. struct swr_dmic_priv *swr_dmic;
  522. swr_dmic = swr_get_dev_data(pdev);
  523. if (!swr_dmic) {
  524. dev_err(&pdev->dev, "%s: swr_dmic is NULL\n", __func__);
  525. return -EINVAL;
  526. }
  527. if (swr_dmic->is_en_supply == 1) {
  528. enable_wcd_codec_supply(swr_dmic, false);
  529. --swr_dmic->is_en_supply;
  530. }
  531. snd_soc_unregister_component(&pdev->dev);
  532. swr_set_dev_data(pdev, NULL);
  533. return 0;
  534. }
  535. static int swr_dmic_up(struct swr_device *pdev)
  536. {
  537. int ret = 0;
  538. struct swr_dmic_priv *swr_dmic;
  539. swr_dmic = swr_get_dev_data(pdev);
  540. if (!swr_dmic) {
  541. dev_err(&pdev->dev, "%s: swr_dmic is NULL\n", __func__);
  542. return -EINVAL;
  543. }
  544. ++swr_dmic->is_en_supply;
  545. if (swr_dmic->is_en_supply == 1)
  546. ret = enable_wcd_codec_supply(swr_dmic, true);
  547. return ret;
  548. }
  549. static int swr_dmic_down(struct swr_device *pdev)
  550. {
  551. struct swr_dmic_priv *swr_dmic;
  552. int ret = 0;
  553. swr_dmic = swr_get_dev_data(pdev);
  554. if (!swr_dmic) {
  555. dev_err(&pdev->dev, "%s: swr_dmic is NULL\n", __func__);
  556. return -EINVAL;
  557. }
  558. dev_dbg(&pdev->dev, "%s: is_en_supply: %d\n",
  559. __func__, swr_dmic->is_en_supply);
  560. --swr_dmic->is_en_supply;
  561. if (swr_dmic->is_en_supply < 0) {
  562. dev_warn(&pdev->dev, "%s: mismatch in supply count %d\n",
  563. __func__, swr_dmic->is_en_supply);
  564. swr_dmic->is_en_supply = 0;
  565. goto done;
  566. }
  567. if (!swr_dmic->is_en_supply)
  568. enable_wcd_codec_supply(swr_dmic, false);
  569. done:
  570. return ret;
  571. }
  572. static int swr_dmic_reset(struct swr_device *pdev)
  573. {
  574. struct swr_dmic_priv *swr_dmic;
  575. u8 retry = NUM_ATTEMPTS;
  576. u8 devnum = 0;
  577. swr_dmic = swr_get_dev_data(pdev);
  578. if (!swr_dmic) {
  579. dev_err(&pdev->dev, "%s: swr_dmic is NULL\n", __func__);
  580. return -EINVAL;
  581. }
  582. while (swr_get_logical_dev_num(pdev, pdev->addr, &devnum) && retry--) {
  583. /* Retry after 1 msec delay */
  584. usleep_range(1000, 1100);
  585. }
  586. pdev->dev_num = devnum;
  587. dev_dbg(&pdev->dev, "%s: devnum: %d\n", __func__, devnum);
  588. return 0;
  589. }
  590. #ifdef CONFIG_PM_SLEEP
  591. static int swr_dmic_suspend(struct device *dev)
  592. {
  593. dev_dbg(dev, "%s: system suspend\n", __func__);
  594. return 0;
  595. }
  596. static int swr_dmic_resume(struct device *dev)
  597. {
  598. struct swr_dmic_priv *swr_dmic = swr_get_dev_data(to_swr_device(dev));
  599. if (!swr_dmic) {
  600. dev_err(dev, "%s: swr_dmic private data is NULL\n", __func__);
  601. return -EINVAL;
  602. }
  603. dev_dbg(dev, "%s: system resume\n", __func__);
  604. return 0;
  605. }
  606. #endif /* CONFIG_PM_SLEEP */
  607. static const struct dev_pm_ops swr_dmic_pm_ops = {
  608. SET_SYSTEM_SLEEP_PM_OPS(swr_dmic_suspend, swr_dmic_resume)
  609. };
  610. static const struct swr_device_id swr_dmic_id[] = {
  611. {"swr-dmic", 0},
  612. {}
  613. };
  614. static const struct of_device_id swr_dmic_dt_match[] = {
  615. {
  616. .compatible = "qcom,swr-dmic",
  617. },
  618. {}
  619. };
  620. static struct swr_driver swr_dmic_driver = {
  621. .driver = {
  622. .name = "swr-dmic",
  623. .owner = THIS_MODULE,
  624. .pm = &swr_dmic_pm_ops,
  625. .of_match_table = swr_dmic_dt_match,
  626. },
  627. .probe = swr_dmic_probe,
  628. .remove = swr_dmic_remove,
  629. .id_table = swr_dmic_id,
  630. };
  631. static int __init swr_dmic_init(void)
  632. {
  633. return swr_driver_register(&swr_dmic_driver);
  634. }
  635. static void __exit swr_dmic_exit(void)
  636. {
  637. swr_driver_unregister(&swr_dmic_driver);
  638. }
  639. module_init(swr_dmic_init);
  640. module_exit(swr_dmic_exit);
  641. MODULE_DESCRIPTION("SWR DMIC driver");
  642. MODULE_LICENSE("GPL v2");