1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/module.h>
16#include <linux/platform_device.h>
17#include <linux/slab.h>
18#include <linux/gpio.h>
19#include <linux/of_gpio.h>
20
21#include <sound/core.h>
22#include <sound/jack.h>
23#include <sound/pcm.h>
24#include <sound/pcm_params.h>
25#include <sound/soc.h>
26
27#include "../codecs/rt5640.h"
28
29#include "tegra_asoc_utils.h"
30
31#define DRV_NAME "tegra-snd-rt5640"
32
33struct tegra_rt5640 {
34 struct tegra_asoc_utils_data util_data;
35 int gpio_hp_det;
36 enum of_gpio_flags gpio_hp_det_flags;
37};
38
39static int tegra_rt5640_asoc_hw_params(struct snd_pcm_substream *substream,
40 struct snd_pcm_hw_params *params)
41{
42 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
43 struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
44 struct snd_soc_card *card = rtd->card;
45 struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(card);
46 int srate, mclk;
47 int err;
48
49 srate = params_rate(params);
50 mclk = 256 * srate;
51
52 err = tegra_asoc_utils_set_rate(&machine->util_data, srate, mclk);
53 if (err < 0) {
54 dev_err(card->dev, "Can't configure clocks\n");
55 return err;
56 }
57
58 err = snd_soc_dai_set_sysclk(codec_dai, RT5640_SCLK_S_MCLK, mclk,
59 SND_SOC_CLOCK_IN);
60 if (err < 0) {
61 dev_err(card->dev, "codec_dai clock not set\n");
62 return err;
63 }
64
65 return 0;
66}
67
68static const struct snd_soc_ops tegra_rt5640_ops = {
69 .hw_params = tegra_rt5640_asoc_hw_params,
70};
71
72static struct snd_soc_jack tegra_rt5640_hp_jack;
73
74static struct snd_soc_jack_pin tegra_rt5640_hp_jack_pins[] = {
75 {
76 .pin = "Headphones",
77 .mask = SND_JACK_HEADPHONE,
78 },
79};
80
81static struct snd_soc_jack_gpio tegra_rt5640_hp_jack_gpio = {
82 .name = "Headphone detection",
83 .report = SND_JACK_HEADPHONE,
84 .debounce_time = 150,
85 .invert = 1,
86};
87
88static const struct snd_soc_dapm_widget tegra_rt5640_dapm_widgets[] = {
89 SND_SOC_DAPM_HP("Headphones", NULL),
90 SND_SOC_DAPM_SPK("Speakers", NULL),
91 SND_SOC_DAPM_MIC("Mic Jack", NULL),
92};
93
94static const struct snd_kcontrol_new tegra_rt5640_controls[] = {
95 SOC_DAPM_PIN_SWITCH("Speakers"),
96};
97
98static int tegra_rt5640_asoc_init(struct snd_soc_pcm_runtime *rtd)
99{
100 struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(rtd->card);
101
102 snd_soc_card_jack_new(rtd->card, "Headphones", SND_JACK_HEADPHONE,
103 &tegra_rt5640_hp_jack, tegra_rt5640_hp_jack_pins,
104 ARRAY_SIZE(tegra_rt5640_hp_jack_pins));
105
106 if (gpio_is_valid(machine->gpio_hp_det)) {
107 tegra_rt5640_hp_jack_gpio.gpio = machine->gpio_hp_det;
108 tegra_rt5640_hp_jack_gpio.invert =
109 !!(machine->gpio_hp_det_flags & OF_GPIO_ACTIVE_LOW);
110 snd_soc_jack_add_gpios(&tegra_rt5640_hp_jack,
111 1,
112 &tegra_rt5640_hp_jack_gpio);
113 }
114
115 return 0;
116}
117
118SND_SOC_DAILINK_DEFS(aif1,
119 DAILINK_COMP_ARRAY(COMP_EMPTY()),
120 DAILINK_COMP_ARRAY(COMP_CODEC(NULL, "rt5640-aif1")),
121 DAILINK_COMP_ARRAY(COMP_EMPTY()));
122
123static struct snd_soc_dai_link tegra_rt5640_dai = {
124 .name = "RT5640",
125 .stream_name = "RT5640 PCM",
126 .init = tegra_rt5640_asoc_init,
127 .ops = &tegra_rt5640_ops,
128 .dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
129 SND_SOC_DAIFMT_CBS_CFS,
130 SND_SOC_DAILINK_REG(aif1),
131};
132
133static struct snd_soc_card snd_soc_tegra_rt5640 = {
134 .name = "tegra-rt5640",
135 .driver_name = "tegra",
136 .owner = THIS_MODULE,
137 .dai_link = &tegra_rt5640_dai,
138 .num_links = 1,
139 .controls = tegra_rt5640_controls,
140 .num_controls = ARRAY_SIZE(tegra_rt5640_controls),
141 .dapm_widgets = tegra_rt5640_dapm_widgets,
142 .num_dapm_widgets = ARRAY_SIZE(tegra_rt5640_dapm_widgets),
143 .fully_routed = true,
144};
145
146static int tegra_rt5640_probe(struct platform_device *pdev)
147{
148 struct device_node *np = pdev->dev.of_node;
149 struct snd_soc_card *card = &snd_soc_tegra_rt5640;
150 struct tegra_rt5640 *machine;
151 int ret;
152
153 machine = devm_kzalloc(&pdev->dev,
154 sizeof(struct tegra_rt5640), GFP_KERNEL);
155 if (!machine)
156 return -ENOMEM;
157
158 card->dev = &pdev->dev;
159 snd_soc_card_set_drvdata(card, machine);
160
161 machine->gpio_hp_det = of_get_named_gpio_flags(
162 np, "nvidia,hp-det-gpios", 0, &machine->gpio_hp_det_flags);
163 if (machine->gpio_hp_det == -EPROBE_DEFER)
164 return -EPROBE_DEFER;
165
166 ret = snd_soc_of_parse_card_name(card, "nvidia,model");
167 if (ret)
168 return ret;
169
170 ret = snd_soc_of_parse_audio_routing(card, "nvidia,audio-routing");
171 if (ret)
172 return ret;
173
174 tegra_rt5640_dai.codecs->of_node = of_parse_phandle(np,
175 "nvidia,audio-codec", 0);
176 if (!tegra_rt5640_dai.codecs->of_node) {
177 dev_err(&pdev->dev,
178 "Property 'nvidia,audio-codec' missing or invalid\n");
179 return -EINVAL;
180 }
181
182 tegra_rt5640_dai.cpus->of_node = of_parse_phandle(np,
183 "nvidia,i2s-controller", 0);
184 if (!tegra_rt5640_dai.cpus->of_node) {
185 dev_err(&pdev->dev,
186 "Property 'nvidia,i2s-controller' missing or invalid\n");
187 return -EINVAL;
188 }
189
190 tegra_rt5640_dai.platforms->of_node = tegra_rt5640_dai.cpus->of_node;
191
192 ret = tegra_asoc_utils_init(&machine->util_data, &pdev->dev);
193 if (ret)
194 return ret;
195
196 ret = devm_snd_soc_register_card(&pdev->dev, card);
197 if (ret)
198 return dev_err_probe(&pdev->dev, ret,
199 "snd_soc_register_card failed\n");
200
201 return 0;
202}
203
204static const struct of_device_id tegra_rt5640_of_match[] = {
205 { .compatible = "nvidia,tegra-audio-rt5640", },
206 {},
207};
208
209static struct platform_driver tegra_rt5640_driver = {
210 .driver = {
211 .name = DRV_NAME,
212 .pm = &snd_soc_pm_ops,
213 .of_match_table = tegra_rt5640_of_match,
214 },
215 .probe = tegra_rt5640_probe,
216};
217module_platform_driver(tegra_rt5640_driver);
218
219MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
220MODULE_DESCRIPTION("Tegra+RT5640 machine ASoC driver");
221MODULE_LICENSE("GPL v2");
222MODULE_ALIAS("platform:" DRV_NAME);
223MODULE_DEVICE_TABLE(of, tegra_rt5640_of_match);
224
