2013-06-13 01:35:34 +08:00
|
|
|
/*
|
|
|
|
* tegra_rt5640.c - Tegra machine ASoC driver for boards using WM8903 codec.
|
|
|
|
*
|
|
|
|
* Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*
|
|
|
|
* Based on code copyright/by:
|
|
|
|
*
|
|
|
|
* Copyright (C) 2010-2012 - NVIDIA, Inc.
|
|
|
|
* Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.lauchpad.net>
|
|
|
|
* (c) 2009, 2010 Nvidia Graphics Pvt. Ltd.
|
|
|
|
* Copyright 2007 Wolfson Microelectronics PLC.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/gpio.h>
|
|
|
|
#include <linux/of_gpio.h>
|
|
|
|
|
|
|
|
#include <sound/core.h>
|
|
|
|
#include <sound/jack.h>
|
|
|
|
#include <sound/pcm.h>
|
|
|
|
#include <sound/pcm_params.h>
|
|
|
|
#include <sound/soc.h>
|
|
|
|
|
|
|
|
#include "../codecs/rt5640.h"
|
|
|
|
|
|
|
|
#include "tegra_asoc_utils.h"
|
|
|
|
|
|
|
|
#define DRV_NAME "tegra-snd-rt5640"
|
|
|
|
|
|
|
|
struct tegra_rt5640 {
|
|
|
|
struct tegra_asoc_utils_data util_data;
|
|
|
|
int gpio_hp_det;
|
|
|
|
};
|
|
|
|
|
|
|
|
static int tegra_rt5640_asoc_hw_params(struct snd_pcm_substream *substream,
|
|
|
|
struct snd_pcm_hw_params *params)
|
|
|
|
{
|
|
|
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
|
|
|
struct snd_soc_dai *codec_dai = rtd->codec_dai;
|
2014-07-18 04:01:06 +08:00
|
|
|
struct snd_soc_card *card = rtd->card;
|
2013-06-13 01:35:34 +08:00
|
|
|
struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(card);
|
|
|
|
int srate, mclk;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
srate = params_rate(params);
|
|
|
|
mclk = 256 * srate;
|
|
|
|
|
|
|
|
err = tegra_asoc_utils_set_rate(&machine->util_data, srate, mclk);
|
|
|
|
if (err < 0) {
|
|
|
|
dev_err(card->dev, "Can't configure clocks\n");
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = snd_soc_dai_set_sysclk(codec_dai, RT5640_SCLK_S_MCLK, mclk,
|
|
|
|
SND_SOC_CLOCK_IN);
|
|
|
|
if (err < 0) {
|
|
|
|
dev_err(card->dev, "codec_dai clock not set\n");
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct snd_soc_ops tegra_rt5640_ops = {
|
|
|
|
.hw_params = tegra_rt5640_asoc_hw_params,
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct snd_soc_jack tegra_rt5640_hp_jack;
|
|
|
|
|
|
|
|
static struct snd_soc_jack_pin tegra_rt5640_hp_jack_pins[] = {
|
|
|
|
{
|
|
|
|
.pin = "Headphones",
|
|
|
|
.mask = SND_JACK_HEADPHONE,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct snd_soc_jack_gpio tegra_rt5640_hp_jack_gpio = {
|
|
|
|
.name = "Headphone detection",
|
|
|
|
.report = SND_JACK_HEADPHONE,
|
|
|
|
.debounce_time = 150,
|
|
|
|
.invert = 1,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct snd_soc_dapm_widget tegra_rt5640_dapm_widgets[] = {
|
|
|
|
SND_SOC_DAPM_HP("Headphones", NULL),
|
|
|
|
SND_SOC_DAPM_SPK("Speakers", NULL),
|
2013-08-15 04:26:29 +08:00
|
|
|
SND_SOC_DAPM_MIC("Mic Jack", NULL),
|
2013-06-13 01:35:34 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static const struct snd_kcontrol_new tegra_rt5640_controls[] = {
|
|
|
|
SOC_DAPM_PIN_SWITCH("Speakers"),
|
|
|
|
};
|
|
|
|
|
|
|
|
static int tegra_rt5640_asoc_init(struct snd_soc_pcm_runtime *rtd)
|
|
|
|
{
|
|
|
|
struct snd_soc_dai *codec_dai = rtd->codec_dai;
|
|
|
|
struct snd_soc_codec *codec = codec_dai->codec;
|
2014-07-18 04:01:06 +08:00
|
|
|
struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(rtd->card);
|
2013-06-13 01:35:34 +08:00
|
|
|
|
|
|
|
snd_soc_jack_new(codec, "Headphones", SND_JACK_HEADPHONE,
|
|
|
|
&tegra_rt5640_hp_jack);
|
|
|
|
snd_soc_jack_add_pins(&tegra_rt5640_hp_jack,
|
|
|
|
ARRAY_SIZE(tegra_rt5640_hp_jack_pins),
|
|
|
|
tegra_rt5640_hp_jack_pins);
|
|
|
|
|
|
|
|
if (gpio_is_valid(machine->gpio_hp_det)) {
|
|
|
|
tegra_rt5640_hp_jack_gpio.gpio = machine->gpio_hp_det;
|
|
|
|
snd_soc_jack_add_gpios(&tegra_rt5640_hp_jack,
|
|
|
|
1,
|
|
|
|
&tegra_rt5640_hp_jack_gpio);
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
ASoC: tegra: free jack GPIOs before the sound card is freed
snd_soc_jack_add_gpios() schedules a work queue item to poll the GPIO to
generate an initial jack status report. If sound card initialization
fails, that work item needs to be cancelled, so it doesn't run after the
card has been freed. Specifically, freeing the card calls
snd_jack_dev_free() which calls snd_jack_dev_disconnect() which sets
jack->input_dev = NULL, and input_dev is used by snd_jack_report(), which
is called from the work queue item.
snd_soc_jack_free_gpios() cancels the work item. The Tegra ASoC machine
drivers do call this function in the platform driver remove() callback.
However, this happens after the sound card is freed, at least when the
card is freed due to errors late during snd_soc_instantiate_card(). This
leaves a window where the work item can execute after the card is freed.
In next-20140522, sound card initialization does fail for unrelated
reasons, and hits the problem described above.
To solve this, fix the Tegra ASoC machine drivers to clean up the Jack
GPIOs during the snd_soc_card's .remove() callback, which is executed
before the overall card object is freed. also, gGuard the cleanup call
based on whether we actually setup up the GPIOs in the first place.
Ideally, we'd do the cleanup in a struct snd_soc_dai_link .fini/remove
function to match where the GPIOs get set up. However, there is no such
callback.
This change fixes all Tegra machine drivers. By code inspection, I
believe some non-Tegra machine drivers have the same issue. I'll send a
patch for that separately, once this is reviewed.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Mark Brown <broonie@linaro.org>
2014-05-23 06:14:53 +08:00
|
|
|
static int tegra_rt5640_card_remove(struct snd_soc_card *card)
|
|
|
|
{
|
|
|
|
struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(card);
|
|
|
|
|
|
|
|
if (gpio_is_valid(machine->gpio_hp_det)) {
|
|
|
|
snd_soc_jack_free_gpios(&tegra_rt5640_hp_jack, 1,
|
|
|
|
&tegra_rt5640_hp_jack_gpio);
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-06-13 01:35:34 +08:00
|
|
|
static struct snd_soc_dai_link tegra_rt5640_dai = {
|
|
|
|
.name = "RT5640",
|
|
|
|
.stream_name = "RT5640 PCM",
|
|
|
|
.codec_dai_name = "rt5640-aif1",
|
|
|
|
.init = tegra_rt5640_asoc_init,
|
|
|
|
.ops = &tegra_rt5640_ops,
|
|
|
|
.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
|
|
|
|
SND_SOC_DAIFMT_CBS_CFS,
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct snd_soc_card snd_soc_tegra_rt5640 = {
|
|
|
|
.name = "tegra-rt5640",
|
|
|
|
.owner = THIS_MODULE,
|
ASoC: tegra: free jack GPIOs before the sound card is freed
snd_soc_jack_add_gpios() schedules a work queue item to poll the GPIO to
generate an initial jack status report. If sound card initialization
fails, that work item needs to be cancelled, so it doesn't run after the
card has been freed. Specifically, freeing the card calls
snd_jack_dev_free() which calls snd_jack_dev_disconnect() which sets
jack->input_dev = NULL, and input_dev is used by snd_jack_report(), which
is called from the work queue item.
snd_soc_jack_free_gpios() cancels the work item. The Tegra ASoC machine
drivers do call this function in the platform driver remove() callback.
However, this happens after the sound card is freed, at least when the
card is freed due to errors late during snd_soc_instantiate_card(). This
leaves a window where the work item can execute after the card is freed.
In next-20140522, sound card initialization does fail for unrelated
reasons, and hits the problem described above.
To solve this, fix the Tegra ASoC machine drivers to clean up the Jack
GPIOs during the snd_soc_card's .remove() callback, which is executed
before the overall card object is freed. also, gGuard the cleanup call
based on whether we actually setup up the GPIOs in the first place.
Ideally, we'd do the cleanup in a struct snd_soc_dai_link .fini/remove
function to match where the GPIOs get set up. However, there is no such
callback.
This change fixes all Tegra machine drivers. By code inspection, I
believe some non-Tegra machine drivers have the same issue. I'll send a
patch for that separately, once this is reviewed.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Mark Brown <broonie@linaro.org>
2014-05-23 06:14:53 +08:00
|
|
|
.remove = tegra_rt5640_card_remove,
|
2013-06-13 01:35:34 +08:00
|
|
|
.dai_link = &tegra_rt5640_dai,
|
|
|
|
.num_links = 1,
|
|
|
|
.controls = tegra_rt5640_controls,
|
|
|
|
.num_controls = ARRAY_SIZE(tegra_rt5640_controls),
|
|
|
|
.dapm_widgets = tegra_rt5640_dapm_widgets,
|
|
|
|
.num_dapm_widgets = ARRAY_SIZE(tegra_rt5640_dapm_widgets),
|
|
|
|
.fully_routed = true,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int tegra_rt5640_probe(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
struct device_node *np = pdev->dev.of_node;
|
|
|
|
struct snd_soc_card *card = &snd_soc_tegra_rt5640;
|
|
|
|
struct tegra_rt5640 *machine;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
machine = devm_kzalloc(&pdev->dev,
|
|
|
|
sizeof(struct tegra_rt5640), GFP_KERNEL);
|
|
|
|
if (!machine) {
|
|
|
|
dev_err(&pdev->dev, "Can't allocate tegra_rt5640\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
card->dev = &pdev->dev;
|
|
|
|
platform_set_drvdata(pdev, card);
|
|
|
|
snd_soc_card_set_drvdata(card, machine);
|
|
|
|
|
|
|
|
machine->gpio_hp_det = of_get_named_gpio(np, "nvidia,hp-det-gpios", 0);
|
|
|
|
if (machine->gpio_hp_det == -EPROBE_DEFER)
|
|
|
|
return -EPROBE_DEFER;
|
|
|
|
|
|
|
|
ret = snd_soc_of_parse_card_name(card, "nvidia,model");
|
|
|
|
if (ret)
|
|
|
|
goto err;
|
|
|
|
|
|
|
|
ret = snd_soc_of_parse_audio_routing(card, "nvidia,audio-routing");
|
|
|
|
if (ret)
|
|
|
|
goto err;
|
|
|
|
|
|
|
|
tegra_rt5640_dai.codec_of_node = of_parse_phandle(np,
|
|
|
|
"nvidia,audio-codec", 0);
|
|
|
|
if (!tegra_rt5640_dai.codec_of_node) {
|
|
|
|
dev_err(&pdev->dev,
|
|
|
|
"Property 'nvidia,audio-codec' missing or invalid\n");
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
|
|
|
tegra_rt5640_dai.cpu_of_node = of_parse_phandle(np,
|
|
|
|
"nvidia,i2s-controller", 0);
|
|
|
|
if (!tegra_rt5640_dai.cpu_of_node) {
|
|
|
|
dev_err(&pdev->dev,
|
|
|
|
"Property 'nvidia,i2s-controller' missing or invalid\n");
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
|
|
|
tegra_rt5640_dai.platform_of_node = tegra_rt5640_dai.cpu_of_node;
|
|
|
|
|
|
|
|
ret = tegra_asoc_utils_init(&machine->util_data, &pdev->dev);
|
|
|
|
if (ret)
|
|
|
|
goto err;
|
|
|
|
|
|
|
|
ret = snd_soc_register_card(card);
|
|
|
|
if (ret) {
|
|
|
|
dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n",
|
|
|
|
ret);
|
|
|
|
goto err_fini_utils;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
err_fini_utils:
|
|
|
|
tegra_asoc_utils_fini(&machine->util_data);
|
|
|
|
err:
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_rt5640_remove(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
struct snd_soc_card *card = platform_get_drvdata(pdev);
|
|
|
|
struct tegra_rt5640 *machine = snd_soc_card_get_drvdata(card);
|
|
|
|
|
|
|
|
snd_soc_unregister_card(card);
|
|
|
|
|
|
|
|
tegra_asoc_utils_fini(&machine->util_data);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct of_device_id tegra_rt5640_of_match[] = {
|
|
|
|
{ .compatible = "nvidia,tegra-audio-rt5640", },
|
|
|
|
{},
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct platform_driver tegra_rt5640_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = DRV_NAME,
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.pm = &snd_soc_pm_ops,
|
|
|
|
.of_match_table = tegra_rt5640_of_match,
|
|
|
|
},
|
|
|
|
.probe = tegra_rt5640_probe,
|
|
|
|
.remove = tegra_rt5640_remove,
|
|
|
|
};
|
|
|
|
module_platform_driver(tegra_rt5640_driver);
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
|
|
|
|
MODULE_DESCRIPTION("Tegra+RT5640 machine ASoC driver");
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
|
|
MODULE_ALIAS("platform:" DRV_NAME);
|
|
|
|
MODULE_DEVICE_TABLE(of, tegra_rt5640_of_match);
|