treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / tegra / tegra_rt5640.c
blobd46915a3ec4cbae90cf0c12322ee2dc8b7fd16b2
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * tegra_rt5640.c - Tegra machine ASoC driver for boards using RT5640 codec.
5 * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
7 * Based on code copyright/by:
9 * Copyright (C) 2010-2012 - NVIDIA, Inc.
10 * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.lauchpad.net>
11 * (c) 2009, 2010 Nvidia Graphics Pvt. Ltd.
12 * Copyright 2007 Wolfson Microelectronics PLC.
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>
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>
27 #include "../codecs/rt5640.h"
29 #include "tegra_asoc_utils.h"
31 #define DRV_NAME "tegra-snd-rt5640"
33 struct tegra_rt5640 {
34 struct tegra_asoc_utils_data util_data;
35 int gpio_hp_det;
36 enum of_gpio_flags gpio_hp_det_flags;
39 static int tegra_rt5640_asoc_hw_params(struct snd_pcm_substream *substream,
40 struct snd_pcm_hw_params *params)
42 struct snd_soc_pcm_runtime *rtd = substream->private_data;
43 struct snd_soc_dai *codec_dai = rtd->codec_dai;
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;
49 srate = params_rate(params);
50 mclk = 256 * srate;
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;
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;
65 return 0;
68 static const struct snd_soc_ops tegra_rt5640_ops = {
69 .hw_params = tegra_rt5640_asoc_hw_params,
72 static struct snd_soc_jack tegra_rt5640_hp_jack;
74 static struct snd_soc_jack_pin tegra_rt5640_hp_jack_pins[] = {
76 .pin = "Headphones",
77 .mask = SND_JACK_HEADPHONE,
81 static 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,
88 static 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),
94 static const struct snd_kcontrol_new tegra_rt5640_controls[] = {
95 SOC_DAPM_PIN_SWITCH("Speakers"),
98 static int tegra_rt5640_asoc_init(struct snd_soc_pcm_runtime *rtd)
100 struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(rtd->card);
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));
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,
112 &tegra_rt5640_hp_jack_gpio);
115 return 0;
118 SND_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()));
123 static 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),
133 static struct snd_soc_card snd_soc_tegra_rt5640 = {
134 .name = "tegra-rt5640",
135 .owner = THIS_MODULE,
136 .dai_link = &tegra_rt5640_dai,
137 .num_links = 1,
138 .controls = tegra_rt5640_controls,
139 .num_controls = ARRAY_SIZE(tegra_rt5640_controls),
140 .dapm_widgets = tegra_rt5640_dapm_widgets,
141 .num_dapm_widgets = ARRAY_SIZE(tegra_rt5640_dapm_widgets),
142 .fully_routed = true,
145 static int tegra_rt5640_probe(struct platform_device *pdev)
147 struct device_node *np = pdev->dev.of_node;
148 struct snd_soc_card *card = &snd_soc_tegra_rt5640;
149 struct tegra_rt5640 *machine;
150 int ret;
152 machine = devm_kzalloc(&pdev->dev,
153 sizeof(struct tegra_rt5640), GFP_KERNEL);
154 if (!machine)
155 return -ENOMEM;
157 card->dev = &pdev->dev;
158 snd_soc_card_set_drvdata(card, machine);
160 machine->gpio_hp_det = of_get_named_gpio_flags(
161 np, "nvidia,hp-det-gpios", 0, &machine->gpio_hp_det_flags);
162 if (machine->gpio_hp_det == -EPROBE_DEFER)
163 return -EPROBE_DEFER;
165 ret = snd_soc_of_parse_card_name(card, "nvidia,model");
166 if (ret)
167 goto err;
169 ret = snd_soc_of_parse_audio_routing(card, "nvidia,audio-routing");
170 if (ret)
171 goto err;
173 tegra_rt5640_dai.codecs->of_node = of_parse_phandle(np,
174 "nvidia,audio-codec", 0);
175 if (!tegra_rt5640_dai.codecs->of_node) {
176 dev_err(&pdev->dev,
177 "Property 'nvidia,audio-codec' missing or invalid\n");
178 ret = -EINVAL;
179 goto err;
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 ret = -EINVAL;
188 goto err;
191 tegra_rt5640_dai.platforms->of_node = tegra_rt5640_dai.cpus->of_node;
193 ret = tegra_asoc_utils_init(&machine->util_data, &pdev->dev);
194 if (ret)
195 goto err;
197 ret = snd_soc_register_card(card);
198 if (ret) {
199 dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n",
200 ret);
201 goto err_fini_utils;
204 return 0;
206 err_fini_utils:
207 tegra_asoc_utils_fini(&machine->util_data);
208 err:
209 return ret;
212 static int tegra_rt5640_remove(struct platform_device *pdev)
214 struct snd_soc_card *card = platform_get_drvdata(pdev);
215 struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(card);
217 snd_soc_unregister_card(card);
219 tegra_asoc_utils_fini(&machine->util_data);
221 return 0;
224 static const struct of_device_id tegra_rt5640_of_match[] = {
225 { .compatible = "nvidia,tegra-audio-rt5640", },
229 static struct platform_driver tegra_rt5640_driver = {
230 .driver = {
231 .name = DRV_NAME,
232 .pm = &snd_soc_pm_ops,
233 .of_match_table = tegra_rt5640_of_match,
235 .probe = tegra_rt5640_probe,
236 .remove = tegra_rt5640_remove,
238 module_platform_driver(tegra_rt5640_driver);
240 MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
241 MODULE_DESCRIPTION("Tegra+RT5640 machine ASoC driver");
242 MODULE_LICENSE("GPL v2");
243 MODULE_ALIAS("platform:" DRV_NAME);
244 MODULE_DEVICE_TABLE(of, tegra_rt5640_of_match);