imx-sgtl5000.c 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226
  1. // SPDX-License-Identifier: GPL-2.0+
  2. //
  3. // Copyright 2012 Freescale Semiconductor, Inc.
  4. // Copyright 2012 Linaro Ltd.
  5. #include <linux/module.h>
  6. #include <linux/of.h>
  7. #include <linux/of_platform.h>
  8. #include <linux/i2c.h>
  9. #include <linux/clk.h>
  10. #include <sound/soc.h>
  11. #include "../codecs/sgtl5000.h"
  12. #include "imx-audmux.h"
  13. #define DAI_NAME_SIZE 32
  14. struct imx_sgtl5000_data {
  15. struct snd_soc_dai_link dai;
  16. struct snd_soc_card card;
  17. char codec_dai_name[DAI_NAME_SIZE];
  18. char platform_name[DAI_NAME_SIZE];
  19. struct clk *codec_clk;
  20. unsigned int clk_frequency;
  21. };
  22. static int imx_sgtl5000_dai_init(struct snd_soc_pcm_runtime *rtd)
  23. {
  24. struct imx_sgtl5000_data *data = snd_soc_card_get_drvdata(rtd->card);
  25. struct device *dev = rtd->card->dev;
  26. int ret;
  27. ret = snd_soc_dai_set_sysclk(asoc_rtd_to_codec(rtd, 0), SGTL5000_SYSCLK,
  28. data->clk_frequency, SND_SOC_CLOCK_IN);
  29. if (ret) {
  30. dev_err(dev, "could not set codec driver clock params\n");
  31. return ret;
  32. }
  33. return 0;
  34. }
  35. static const struct snd_soc_dapm_widget imx_sgtl5000_dapm_widgets[] = {
  36. SND_SOC_DAPM_MIC("Mic Jack", NULL),
  37. SND_SOC_DAPM_LINE("Line In Jack", NULL),
  38. SND_SOC_DAPM_HP("Headphone Jack", NULL),
  39. SND_SOC_DAPM_SPK("Line Out Jack", NULL),
  40. SND_SOC_DAPM_SPK("Ext Spk", NULL),
  41. };
  42. static int imx_sgtl5000_probe(struct platform_device *pdev)
  43. {
  44. struct device_node *np = pdev->dev.of_node;
  45. struct device_node *ssi_np, *codec_np;
  46. struct platform_device *ssi_pdev;
  47. struct i2c_client *codec_dev;
  48. struct imx_sgtl5000_data *data = NULL;
  49. struct snd_soc_dai_link_component *comp;
  50. int int_port, ext_port;
  51. int ret;
  52. ret = of_property_read_u32(np, "mux-int-port", &int_port);
  53. if (ret) {
  54. dev_err(&pdev->dev, "mux-int-port missing or invalid\n");
  55. return ret;
  56. }
  57. ret = of_property_read_u32(np, "mux-ext-port", &ext_port);
  58. if (ret) {
  59. dev_err(&pdev->dev, "mux-ext-port missing or invalid\n");
  60. return ret;
  61. }
  62. /*
  63. * The port numbering in the hardware manual starts at 1, while
  64. * the audmux API expects it starts at 0.
  65. */
  66. int_port--;
  67. ext_port--;
  68. ret = imx_audmux_v2_configure_port(int_port,
  69. IMX_AUDMUX_V2_PTCR_SYN |
  70. IMX_AUDMUX_V2_PTCR_TFSEL(ext_port) |
  71. IMX_AUDMUX_V2_PTCR_TCSEL(ext_port) |
  72. IMX_AUDMUX_V2_PTCR_TFSDIR |
  73. IMX_AUDMUX_V2_PTCR_TCLKDIR,
  74. IMX_AUDMUX_V2_PDCR_RXDSEL(ext_port));
  75. if (ret) {
  76. dev_err(&pdev->dev, "audmux internal port setup failed\n");
  77. return ret;
  78. }
  79. ret = imx_audmux_v2_configure_port(ext_port,
  80. IMX_AUDMUX_V2_PTCR_SYN,
  81. IMX_AUDMUX_V2_PDCR_RXDSEL(int_port));
  82. if (ret) {
  83. dev_err(&pdev->dev, "audmux external port setup failed\n");
  84. return ret;
  85. }
  86. ssi_np = of_parse_phandle(pdev->dev.of_node, "ssi-controller", 0);
  87. codec_np = of_parse_phandle(pdev->dev.of_node, "audio-codec", 0);
  88. if (!ssi_np || !codec_np) {
  89. dev_err(&pdev->dev, "phandle missing or invalid\n");
  90. ret = -EINVAL;
  91. goto fail;
  92. }
  93. ssi_pdev = of_find_device_by_node(ssi_np);
  94. if (!ssi_pdev) {
  95. dev_dbg(&pdev->dev, "failed to find SSI platform device\n");
  96. ret = -EPROBE_DEFER;
  97. goto fail;
  98. }
  99. put_device(&ssi_pdev->dev);
  100. codec_dev = of_find_i2c_device_by_node(codec_np);
  101. if (!codec_dev) {
  102. dev_dbg(&pdev->dev, "failed to find codec platform device\n");
  103. ret = -EPROBE_DEFER;
  104. goto fail;
  105. }
  106. data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
  107. if (!data) {
  108. ret = -ENOMEM;
  109. goto fail;
  110. }
  111. comp = devm_kzalloc(&pdev->dev, 3 * sizeof(*comp), GFP_KERNEL);
  112. if (!comp) {
  113. ret = -ENOMEM;
  114. goto fail;
  115. }
  116. data->codec_clk = clk_get(&codec_dev->dev, NULL);
  117. if (IS_ERR(data->codec_clk)) {
  118. ret = PTR_ERR(data->codec_clk);
  119. goto fail;
  120. }
  121. data->clk_frequency = clk_get_rate(data->codec_clk);
  122. data->dai.cpus = &comp[0];
  123. data->dai.codecs = &comp[1];
  124. data->dai.platforms = &comp[2];
  125. data->dai.num_cpus = 1;
  126. data->dai.num_codecs = 1;
  127. data->dai.num_platforms = 1;
  128. data->dai.name = "HiFi";
  129. data->dai.stream_name = "HiFi";
  130. data->dai.codecs->dai_name = "sgtl5000";
  131. data->dai.codecs->of_node = codec_np;
  132. data->dai.cpus->of_node = ssi_np;
  133. data->dai.platforms->of_node = ssi_np;
  134. data->dai.init = &imx_sgtl5000_dai_init;
  135. data->dai.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
  136. SND_SOC_DAIFMT_CBM_CFM;
  137. data->card.dev = &pdev->dev;
  138. ret = snd_soc_of_parse_card_name(&data->card, "model");
  139. if (ret)
  140. goto fail;
  141. ret = snd_soc_of_parse_audio_routing(&data->card, "audio-routing");
  142. if (ret)
  143. goto fail;
  144. data->card.num_links = 1;
  145. data->card.owner = THIS_MODULE;
  146. data->card.dai_link = &data->dai;
  147. data->card.dapm_widgets = imx_sgtl5000_dapm_widgets;
  148. data->card.num_dapm_widgets = ARRAY_SIZE(imx_sgtl5000_dapm_widgets);
  149. platform_set_drvdata(pdev, &data->card);
  150. snd_soc_card_set_drvdata(&data->card, data);
  151. ret = devm_snd_soc_register_card(&pdev->dev, &data->card);
  152. if (ret) {
  153. if (ret != -EPROBE_DEFER)
  154. dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n",
  155. ret);
  156. goto fail;
  157. }
  158. of_node_put(ssi_np);
  159. of_node_put(codec_np);
  160. return 0;
  161. fail:
  162. if (data && !IS_ERR(data->codec_clk))
  163. clk_put(data->codec_clk);
  164. of_node_put(ssi_np);
  165. of_node_put(codec_np);
  166. return ret;
  167. }
  168. static int imx_sgtl5000_remove(struct platform_device *pdev)
  169. {
  170. struct snd_soc_card *card = platform_get_drvdata(pdev);
  171. struct imx_sgtl5000_data *data = snd_soc_card_get_drvdata(card);
  172. clk_put(data->codec_clk);
  173. return 0;
  174. }
  175. static const struct of_device_id imx_sgtl5000_dt_ids[] = {
  176. { .compatible = "fsl,imx-audio-sgtl5000", },
  177. { /* sentinel */ }
  178. };
  179. MODULE_DEVICE_TABLE(of, imx_sgtl5000_dt_ids);
  180. static struct platform_driver imx_sgtl5000_driver = {
  181. .driver = {
  182. .name = "imx-sgtl5000",
  183. .pm = &snd_soc_pm_ops,
  184. .of_match_table = imx_sgtl5000_dt_ids,
  185. },
  186. .probe = imx_sgtl5000_probe,
  187. .remove = imx_sgtl5000_remove,
  188. };
  189. module_platform_driver(imx_sgtl5000_driver);
  190. MODULE_AUTHOR("Shawn Guo <shawn.guo@linaro.org>");
  191. MODULE_DESCRIPTION("Freescale i.MX SGTL5000 ASoC machine driver");
  192. MODULE_LICENSE("GPL v2");
  193. MODULE_ALIAS("platform:imx-sgtl5000");