| /* |
| * harmony.c - Harmony machine ASoC driver |
| * |
| * Author: Stephen Warren <swarren@nvidia.com> |
| * Copyright (C) 2010 - NVIDIA, Inc. |
| * |
| * Based on code copyright/by: |
| * |
| * (c) 2009, 2010 Nvidia Graphics Pvt. Ltd. |
| * |
| * Copyright 2007 Wolfson Microelectronics PLC. |
| * Author: Graeme Gregory |
| * graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that 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, write to the Free Software |
| * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA |
| * 02110-1301 USA |
| * |
| */ |
| |
| #include <asm/mach-types.h> |
| #include <linux/module.h> |
| #include <sound/core.h> |
| #include <sound/pcm.h> |
| #include <sound/pcm_params.h> |
| #include <sound/soc.h> |
| |
| #include "tegra_das.h" |
| #include "tegra_i2s.h" |
| #include "tegra_pcm.h" |
| #include "tegra_asoc_utils.h" |
| |
| #define PREFIX "ASoC Harmony: " |
| |
| static struct platform_device *harmony_snd_device; |
| |
| static int harmony_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; |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| int srate, mclk, mclk_change; |
| int err; |
| |
| srate = params_rate(params); |
| switch (srate) { |
| case 64000: |
| case 88200: |
| case 96000: |
| mclk = 128 * srate; |
| break; |
| default: |
| mclk = 256 * srate; |
| break; |
| } |
| /* FIXME: Codec only requires >= 3MHz if OSR==0 */ |
| while (mclk < 6000000) |
| mclk *= 2; |
| |
| err = tegra_asoc_utils_set_rate(srate, mclk, &mclk_change); |
| if (err < 0) { |
| pr_err(PREFIX "Can't configure clocks\n"); |
| return err; |
| } |
| |
| err = snd_soc_dai_set_fmt(codec_dai, |
| SND_SOC_DAIFMT_I2S | |
| SND_SOC_DAIFMT_NB_NF | |
| SND_SOC_DAIFMT_CBS_CFS); |
| if (err < 0) { |
| pr_err(PREFIX "codec_dai fmt not set\n"); |
| return err; |
| } |
| |
| err = snd_soc_dai_set_fmt(cpu_dai, |
| SND_SOC_DAIFMT_I2S | |
| SND_SOC_DAIFMT_NB_NF | |
| SND_SOC_DAIFMT_CBS_CFS); |
| if (err < 0) { |
| pr_err(PREFIX "cpu_dai fmt not set\n"); |
| return err; |
| } |
| |
| if (mclk_change) { |
| err = snd_soc_dai_set_sysclk(codec_dai, 0, mclk, SND_SOC_CLOCK_IN); |
| if (err < 0) { |
| pr_err(PREFIX "codec_dai clock not set\n"); |
| return err; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static struct snd_soc_ops harmony_asoc_ops = { |
| .hw_params = harmony_asoc_hw_params, |
| }; |
| |
| static const struct snd_soc_dapm_widget harmony_dapm_widgets[] = { |
| SND_SOC_DAPM_HP("Headphone Jack", NULL), |
| SND_SOC_DAPM_MIC("Mic Jack", NULL), |
| }; |
| |
| static const struct snd_soc_dapm_route harmony_audio_map[] = { |
| {"Headphone Jack", NULL, "HPOUTR"}, |
| {"Headphone Jack", NULL, "HPOUTL"}, |
| {"Mic Bias", NULL, "Mic Jack"}, |
| {"IN1L", NULL, "Mic Bias"}, |
| }; |
| |
| static int harmony_asoc_init(struct snd_soc_pcm_runtime *rtd) |
| { |
| struct snd_soc_codec *codec = rtd->codec; |
| struct snd_soc_dapm_context *dapm = &codec->dapm; |
| |
| snd_soc_dapm_new_controls(dapm, harmony_dapm_widgets, |
| ARRAY_SIZE(harmony_dapm_widgets)); |
| |
| snd_soc_dapm_add_routes(dapm, harmony_audio_map, |
| ARRAY_SIZE(harmony_audio_map)); |
| |
| snd_soc_dapm_enable_pin(dapm, "Headphone Jack"); |
| snd_soc_dapm_enable_pin(dapm, "Mic Jack"); |
| snd_soc_dapm_sync(dapm); |
| |
| return 0; |
| } |
| |
| static struct snd_soc_dai_link harmony_wm8903_dai = { |
| .name = "WM8903", |
| .stream_name = "WM8903 PCM", |
| .codec_name = "wm8903-codec.0-001a", |
| .platform_name = "tegra-pcm-audio", |
| .cpu_dai_name = "tegra-i2s.0", |
| .codec_dai_name = "wm8903-hifi", |
| .init = harmony_asoc_init, |
| .ops = &harmony_asoc_ops, |
| }; |
| |
| static struct snd_soc_card snd_soc_harmony = { |
| .name = "tegra-harmony", |
| .dai_link = &harmony_wm8903_dai, |
| .num_links = 1, |
| }; |
| |
| static int __init harmony_soc_modinit(void) |
| { |
| int ret; |
| |
| if (!machine_is_harmony()) { |
| pr_err(PREFIX "Not running on Tegra Harmony!\n"); |
| return -ENODEV; |
| } |
| |
| ret = tegra_asoc_utils_init(); |
| if (ret) { |
| return ret; |
| } |
| |
| /* |
| * Create and register platform device |
| */ |
| harmony_snd_device = platform_device_alloc("soc-audio", -1); |
| if (harmony_snd_device == NULL) { |
| pr_err(PREFIX "platform_device_alloc failed\n"); |
| ret = -ENOMEM; |
| goto err_clock_utils; |
| } |
| |
| platform_set_drvdata(harmony_snd_device, &snd_soc_harmony); |
| |
| ret = platform_device_add(harmony_snd_device); |
| if (ret) { |
| pr_err(PREFIX "platform_device_add failed (%d)\n", |
| ret); |
| goto err_device_put; |
| } |
| |
| return 0; |
| |
| err_device_put: |
| platform_device_put(harmony_snd_device); |
| err_clock_utils: |
| tegra_asoc_utils_fini(); |
| return ret; |
| } |
| module_init(harmony_soc_modinit); |
| |
| static void __exit harmony_soc_modexit(void) |
| { |
| platform_device_unregister(harmony_snd_device); |
| |
| tegra_asoc_utils_fini(); |
| } |
| module_exit(harmony_soc_modexit); |
| |
| MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>"); |
| MODULE_DESCRIPTION("Harmony machine ASoC driver"); |
| MODULE_LICENSE("GPL"); |