1 files changed, 723 insertions, 0 deletions

diff --git a/sound/soc/tegra/tegra_max98095.c b/sound/soc/tegra/tegra_max98095.c
new file mode 100644
index 00000000000..2104ba849cd
--- /dev/null
+++ b/sound/soc/tegra/tegra_max98095.c
@@ -0,0 +1,723 @@
+/*
+ * tegra_max98095.c - Tegra machine ASoC driver for boards using MAX98095 codec.
+ *
+ * Author: Ravindra Lokhande <rlokhande@nvidia.com>
+ * Copyright (C) 2012 - NVIDIA, Inc.
+ *
+ * Based on version from Sumit Bhattacharya <sumitb@nvidia.com>
+ *
+ * Based on code copyright/by:
+ *
+ * (c) 2010, 2011, 2012 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 <linux/platform_device.h>
+#include <linux/slab.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
+#ifdef CONFIG_SWITCH
+#include <linux/switch.h>
+#endif
+
+#include <mach/tegra_asoc_pdata.h>
+
+#include <sound/core.h>
+#include <sound/jack.h>
+#include <sound/pcm.h>
+#include <sound/pcm_params.h>
+#include <sound/soc.h>
+
+#include "../codecs/max98095.h"
+
+#include "tegra_pcm.h"
+#include "tegra_asoc_utils.h"
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+#include "tegra30_ahub.h"
+#include "tegra30_i2s.h"
+#include "tegra30_dam.h"
+#endif
+
+#define DRV_NAME "tegra-snd-max98095"
+
+#define GPIO_SPKR_EN    BIT(0)
+#define GPIO_HP_MUTE    BIT(1)
+#define GPIO_INT_MIC_EN BIT(2)
+#define GPIO_EXT_MIC_EN BIT(3)
+
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+const char *tegra_max98095_i2s_dai_name[TEGRA30_NR_I2S_IFC] = {
+        "tegra30-i2s.0",
+        "tegra30-i2s.1",
+        "tegra30-i2s.2",
+        "tegra30-i2s.3",
+        "tegra30-i2s.4",
+};
+#endif
+
+struct tegra_max98095 {
+        struct tegra_asoc_utils_data util_data;
+        struct tegra_asoc_platform_data *pdata;
+        int gpio_requested;
+        bool init_done;
+        int is_call_mode;
+        int is_device_bt;
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        struct codec_config codec_info[NUM_I2S_DEVICES];
+#endif
+        enum snd_soc_bias_level bias_level;
+};
+
+
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+static int tegra_max98095_set_dam_cif(int dam_ifc, int srate,
+                        int channels, int bit_size)
+{
+        tegra30_dam_set_samplerate(dam_ifc, TEGRA30_DAM_CHOUT,
+                                srate);
+        tegra30_dam_set_samplerate(dam_ifc, TEGRA30_DAM_CHIN1,
+                                srate);
+        tegra30_dam_set_acif(dam_ifc, TEGRA30_DAM_CHIN1,
+                channels, bit_size, channels,
+                                bit_size);
+        tegra30_dam_set_acif(dam_ifc, TEGRA30_DAM_CHOUT,
+                channels, bit_size, channels,
+                                bit_size);
+
+        return 0;
+}
+#endif
+
+static int tegra_max98095_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;
+        struct snd_soc_codec *codec = rtd->codec;
+        struct snd_soc_card *card = codec->card;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        struct tegra30_i2s *i2s = snd_soc_dai_get_drvdata(cpu_dai);
+#endif
+        unsigned int srate, mclk, sample_size;
+        int err;
+
+        switch (params_format(params)) {
+        case SNDRV_PCM_FORMAT_S16_LE:
+                sample_size = 16;
+                break;
+        default:
+                return -EINVAL;
+        }
+
+        srate = params_rate(params);
+        switch (srate) {
+        case 8000:
+        case 16000:
+        case 24000:
+        case 32000:
+        case 48000:
+        case 64000:
+        case 96000:
+                mclk = 12288000;
+                break;
+        case 11025:
+        case 22050:
+        case 44100:
+        case 88200:
+                mclk = 11289600;
+                break;
+        default:
+                mclk = 12000000;
+                break;
+        }
+
+        err = tegra_asoc_utils_set_rate(&machine->util_data, srate, mclk);
+        if (err < 0) {
+                if (!(machine->util_data.set_mclk % mclk))
+                        mclk = machine->util_data.set_mclk;
+                else {
+                        dev_err(card->dev, "Can't configure clocks\n");
+                        return err;
+                }
+        }
+
+        tegra_asoc_utils_lock_clk_rate(&machine->util_data, 1);
+
+        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) {
+                dev_err(card->dev, "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) {
+                dev_err(card->dev, "cpu_dai fmt not set\n");
+                return err;
+        }
+
+        err = snd_soc_dai_set_sysclk(codec_dai, 0, mclk,
+                                        SND_SOC_CLOCK_IN);
+        if (err < 0) {
+                dev_err(card->dev, "codec_dai clock not set\n");
+                return err;
+        }
+
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+                tegra_max98095_set_dam_cif(i2s->dam_ifc, srate,
+                                params_channels(params), sample_size);
+#endif
+
+        return 0;
+}
+
+static int tegra_spdif_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_card *card = rtd->card;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+        unsigned int srate, mclk, min_mclk;
+        int err;
+
+        srate = params_rate(params);
+        switch (srate) {
+        case 11025:
+        case 22050:
+        case 44100:
+        case 88200:
+                mclk = 11289600;
+                break;
+        case 8000:
+        case 16000:
+        case 32000:
+        case 48000:
+        case 64000:
+        case 96000:
+                mclk = 12288000;
+                break;
+        default:
+                return -EINVAL;
+        }
+        min_mclk = 128 * srate;
+
+        err = tegra_asoc_utils_set_rate(&machine->util_data, srate, mclk);
+        if (err < 0) {
+                if (!(machine->util_data.set_mclk % min_mclk))
+                        mclk = machine->util_data.set_mclk;
+                else {
+                        dev_err(card->dev, "Can't configure clocks\n");
+                        return err;
+                }
+        }
+
+        tegra_asoc_utils_lock_clk_rate(&machine->util_data, 1);
+
+
+
+        return 0;
+}
+
+static int tegra_hw_free(struct snd_pcm_substream *substream)
+{
+        struct snd_soc_pcm_runtime *rtd = substream->private_data;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(rtd->card);
+
+        tegra_asoc_utils_lock_clk_rate(&machine->util_data, 0);
+
+        return 0;
+}
+
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+static int tegra_max98095_startup(struct snd_pcm_substream *substream)
+{
+        struct snd_soc_pcm_runtime *rtd = substream->private_data;
+        struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
+        struct tegra30_i2s *i2s = snd_soc_dai_get_drvdata(cpu_dai);
+
+        if ((substream->stream != SNDRV_PCM_STREAM_PLAYBACK) ||
+                !(i2s->is_dam_used))
+                return 0;
+
+        /*dam configuration*/
+        if (!i2s->dam_ch_refcount)
+                i2s->dam_ifc = tegra30_dam_allocate_controller();
+
+        tegra30_dam_allocate_channel(i2s->dam_ifc, TEGRA30_DAM_CHIN1);
+        i2s->dam_ch_refcount++;
+        tegra30_dam_enable_clock(i2s->dam_ifc);
+        tegra30_dam_set_gain(i2s->dam_ifc, TEGRA30_DAM_CHIN1, 0x1000);
+
+        tegra30_ahub_set_rx_cif_source(TEGRA30_AHUB_RXCIF_DAM0_RX1 +
+                        (i2s->dam_ifc*2), i2s->txcif);
+
+        /*
+        *make the dam tx to i2s rx connection if this is the only client
+        *using i2s for playback
+        */
+        if (i2s->playback_ref_count == 1)
+                tegra30_ahub_set_rx_cif_source(
+                        TEGRA30_AHUB_RXCIF_I2S0_RX0 + i2s->id,
+                        TEGRA30_AHUB_TXCIF_DAM0_TX0 + i2s->dam_ifc);
+
+        /* enable the dam*/
+        tegra30_dam_enable(i2s->dam_ifc, TEGRA30_DAM_ENABLE,
+                        TEGRA30_DAM_CHIN1);
+
+        return 0;
+}
+
+static void tegra_max98095_shutdown(struct snd_pcm_substream *substream)
+{
+        struct snd_soc_pcm_runtime *rtd = substream->private_data;
+        struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
+        struct tegra30_i2s *i2s = snd_soc_dai_get_drvdata(cpu_dai);
+
+        if ((substream->stream != SNDRV_PCM_STREAM_PLAYBACK) ||
+                !(i2s->is_dam_used))
+                return;
+
+        /* disable the dam*/
+        tegra30_dam_enable(i2s->dam_ifc, TEGRA30_DAM_DISABLE,
+                        TEGRA30_DAM_CHIN1);
+
+        /* disconnect the ahub connections*/
+        tegra30_ahub_unset_rx_cif_source(TEGRA30_AHUB_RXCIF_DAM0_RX1 +
+                                (i2s->dam_ifc*2));
+
+        /* disable the dam and free the controller */
+        tegra30_dam_disable_clock(i2s->dam_ifc);
+        tegra30_dam_free_channel(i2s->dam_ifc, TEGRA30_DAM_CHIN1);
+        i2s->dam_ch_refcount--;
+        if (!i2s->dam_ch_refcount)
+                tegra30_dam_free_controller(i2s->dam_ifc);
+
+        return;
+}
+#endif
+
+static struct snd_soc_ops tegra_max98095_ops = {
+        .hw_params = tegra_max98095_hw_params,
+        .hw_free = tegra_hw_free,
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        .startup = tegra_max98095_startup,
+        .shutdown = tegra_max98095_shutdown,
+#endif
+};
+
+static struct snd_soc_ops tegra_spdif_ops = {
+        .hw_params = tegra_spdif_hw_params,
+        .hw_free = tegra_hw_free,
+};
+
+static struct snd_soc_jack tegra_max98095_hp_jack;
+
+#ifdef CONFIG_SWITCH
+static struct switch_dev wired_switch_dev = {
+        .name = "h2w",
+};
+
+/* These values are copied from WiredAccessoryObserver */
+enum headset_state {
+        BIT_NO_HEADSET = 0,
+        BIT_HEADSET = (1 << 0),
+        BIT_HEADSET_NO_MIC = (1 << 1),
+};
+
+static int headset_switch_notify(struct notifier_block *self,
+        unsigned long action, void *dev)
+{
+        int state = 0;
+
+        switch (action) {
+        case SND_JACK_HEADPHONE:
+                state |= BIT_HEADSET_NO_MIC;
+                break;
+        case SND_JACK_HEADSET:
+                state |= BIT_HEADSET;
+                break;
+        default:
+                state |= BIT_NO_HEADSET;
+        }
+
+        switch_set_state(&wired_switch_dev, state);
+
+        return NOTIFY_OK;
+}
+
+static struct notifier_block headset_switch_nb = {
+        .notifier_call = headset_switch_notify,
+};
+#else
+static struct snd_soc_jack_pin tegra_max98095_hp_jack_pins[] = {
+        {
+                .pin = "Headphone Jack",
+                .mask = SND_JACK_HEADPHONE,
+        },
+};
+#endif
+
+static int tegra_max98095_event_int_spk(struct snd_soc_dapm_widget *w,
+                                        struct snd_kcontrol *k, int event)
+{
+        struct snd_soc_dapm_context *dapm = w->dapm;
+        struct snd_soc_card *card = dapm->card;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+        struct tegra_asoc_platform_data *pdata = machine->pdata;
+
+        if (!(machine->gpio_requested & GPIO_SPKR_EN))
+                return 0;
+
+        gpio_set_value_cansleep(pdata->gpio_spkr_en,
+                                SND_SOC_DAPM_EVENT_ON(event));
+
+        return 0;
+}
+
+static int tegra_max98095_event_hp(struct snd_soc_dapm_widget *w,
+                                        struct snd_kcontrol *k, int event)
+{
+        struct snd_soc_dapm_context *dapm = w->dapm;
+        struct snd_soc_card *card = dapm->card;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+        struct tegra_asoc_platform_data *pdata = machine->pdata;
+
+        if (!(machine->gpio_requested & GPIO_HP_MUTE))
+                return 0;
+
+        gpio_set_value_cansleep(pdata->gpio_hp_mute,
+                                !SND_SOC_DAPM_EVENT_ON(event));
+
+        return 0;
+}
+
+static const struct snd_soc_dapm_widget tegra_max98095_dapm_widgets[] = {
+        SND_SOC_DAPM_SPK("Int Spk", tegra_max98095_event_int_spk),
+        SND_SOC_DAPM_HP("Headphone Jack", tegra_max98095_event_hp),
+        SND_SOC_DAPM_MIC("Mic Jack", NULL),
+        SND_SOC_DAPM_INPUT("Int Mic"),
+        SND_SOC_DAPM_LINE("Line In", NULL),
+};
+
+static const struct snd_soc_dapm_route enterprise_audio_map[] = {
+        {"Int Spk", NULL, "SPKL"},
+        {"Int Spk", NULL, "SPKR"},
+        {"Headphone Jack", NULL, "HPL"},
+        {"Headphone Jack", NULL, "HPR"},
+        {"MICBIAS2", NULL, "Mic Jack"},
+        {"MIC2", NULL, "MICBIAS2"},
+        {"MIC1", NULL, "Int Mic"},
+        {"MIC1", NULL, "MICBIAS1"},
+        {"INB1", NULL, "Line In"},
+        {"INB2", NULL, "Line In"},
+};
+
+static const struct snd_kcontrol_new tegra_max98095_controls[] = {
+        SOC_DAPM_PIN_SWITCH("Int Spk"),
+        SOC_DAPM_PIN_SWITCH("Headphone Jack"),
+        SOC_DAPM_PIN_SWITCH("Mic Jack"),
+        SOC_DAPM_PIN_SWITCH("Int Mic"),
+        SOC_DAPM_PIN_SWITCH("LineIn"),
+};
+
+static int tegra_max98095_init(struct snd_soc_pcm_runtime *rtd)
+{
+        struct snd_soc_codec *codec = rtd->codec;
+        struct snd_soc_dapm_context *dapm = &codec->dapm;
+        struct snd_soc_card *card = codec->card;
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+        struct tegra_asoc_platform_data *pdata = machine->pdata;
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        struct tegra30_i2s *i2s = snd_soc_dai_get_drvdata(rtd->cpu_dai);
+#endif
+        int ret;
+
+#ifndef CONFIG_ARCH_TEGRA_2x_SOC
+        if (machine->codec_info[BASEBAND].i2s_id != -1)
+                i2s->is_dam_used = true;
+#endif
+
+        if (machine->init_done)
+                return 0;
+
+        machine->init_done = true;
+
+        if (gpio_is_valid(pdata->gpio_spkr_en)) {
+                ret = gpio_request(pdata->gpio_spkr_en, "spkr_en");
+                if (ret) {
+                        dev_err(card->dev, "cannot get spkr_en gpio\n");
+                        return ret;
+                }
+                machine->gpio_requested |= GPIO_SPKR_EN;
+
+                gpio_direction_output(pdata->gpio_spkr_en, 0);
+        }
+
+        if (gpio_is_valid(pdata->gpio_hp_mute)) {
+                ret = gpio_request(pdata->gpio_hp_mute, "hp_mute");
+                if (ret) {
+                        dev_err(card->dev, "cannot get hp_mute gpio\n");
+                        return ret;
+                }
+                machine->gpio_requested |= GPIO_HP_MUTE;
+
+                gpio_direction_output(pdata->gpio_hp_mute, 0);
+        }
+
+        if (gpio_is_valid(pdata->gpio_int_mic_en)) {
+                ret = gpio_request(pdata->gpio_int_mic_en, "int_mic_en");
+                if (ret) {
+                        dev_err(card->dev, "cannot get int_mic_en gpio\n");
+                        return ret;
+                }
+                machine->gpio_requested |= GPIO_INT_MIC_EN;
+
+                /* Disable int mic; enable signal is active-high */
+                gpio_direction_output(pdata->gpio_int_mic_en, 0);
+        }
+
+        if (gpio_is_valid(pdata->gpio_ext_mic_en)) {
+                ret = gpio_request(pdata->gpio_ext_mic_en, "ext_mic_en");
+                if (ret) {
+                        dev_err(card->dev, "cannot get ext_mic_en gpio\n");
+                        return ret;
+                }
+                machine->gpio_requested |= GPIO_EXT_MIC_EN;
+
+                /* Enable ext mic; enable signal is active-low */
+                gpio_direction_output(pdata->gpio_ext_mic_en, 0);
+        }
+
+        ret = snd_soc_add_controls(codec, tegra_max98095_controls,
+                                   ARRAY_SIZE(tegra_max98095_controls));
+        if (ret < 0)
+                return ret;
+
+        snd_soc_dapm_new_controls(dapm, tegra_max98095_dapm_widgets,
+                        ARRAY_SIZE(tegra_max98095_dapm_widgets));
+
+        snd_soc_dapm_add_routes(dapm, enterprise_audio_map,
+                        ARRAY_SIZE(enterprise_audio_map));
+
+        ret = snd_soc_jack_new(codec, "Headset Jack", SND_JACK_HEADSET,
+                        &tegra_max98095_hp_jack);
+        if (ret < 0)
+                return ret;
+
+#ifdef CONFIG_SWITCH
+        snd_soc_jack_notifier_register(&tegra_max98095_hp_jack,
+                &headset_switch_nb);
+#else /*gpio based headset detection*/
+        snd_soc_jack_add_pins(&tegra_max98095_hp_jack,
+                ARRAY_SIZE(tegra_max98095_hp_jack_pins),
+                tegra_max98095_hp_jack_pins);
+#endif
+
+        /* max98095_headset_detect(codec, &tegra_max98095_hp_jack,
+                SND_JACK_HEADSET); */
+
+        snd_soc_dapm_nc_pin(dapm, "INA1");
+        snd_soc_dapm_nc_pin(dapm, "INA2");
+        snd_soc_dapm_nc_pin(dapm, "INB1");
+        snd_soc_dapm_nc_pin(dapm, "INB2");
+        snd_soc_dapm_sync(dapm);
+
+        return 0;
+}
+
+static struct snd_soc_dai_link tegra_max98095_dai[] = {
+        {
+                .name = "MAX98095",
+                .stream_name = "MAX98095 HIFI",
+                .codec_name = "max98095.4-0010",
+                .platform_name = "tegra-pcm-audio",
+                .cpu_dai_name = "tegra30-i2s.1",
+                .codec_dai_name = "HiFi",
+                .init = tegra_max98095_init,
+                .ops = &tegra_max98095_ops,
+        },
+        {
+                .name = "SPDIF",
+                .stream_name = "SPDIF PCM",
+                .codec_name = "spdif-dit.0",
+                .platform_name = "tegra-pcm-audio",
+                .cpu_dai_name = "tegra30-spdif",
+                .codec_dai_name = "dit-hifi",
+                .ops = &tegra_spdif_ops,
+        },
+};
+
+static int tegra30_soc_set_bias_level(struct snd_soc_card *card,
+                                        enum snd_soc_bias_level level)
+{
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+
+        if (machine->bias_level == SND_SOC_BIAS_OFF &&
+                level != SND_SOC_BIAS_OFF)
+                tegra_asoc_utils_clk_enable(&machine->util_data);
+
+        machine->bias_level = level;
+
+        return 0;
+}
+
+static int tegra30_soc_set_bias_level_post(struct snd_soc_card *card,
+                                        enum snd_soc_bias_level level)
+{
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+
+        if (level == SND_SOC_BIAS_OFF)
+                tegra_asoc_utils_clk_disable(&machine->util_data);
+
+        return 0 ;
+}
+
+static struct snd_soc_card snd_soc_tegra_max98095 = {
+        .name = "tegra-max98095",
+        .dai_link = tegra_max98095_dai,
+        .num_links = ARRAY_SIZE(tegra_max98095_dai),
+        .set_bias_level = tegra30_soc_set_bias_level,
+        .set_bias_level_post = tegra30_soc_set_bias_level_post,
+};
+
+static __devinit int tegra_max98095_driver_probe(struct platform_device *pdev)
+{
+        struct snd_soc_card *card = &snd_soc_tegra_max98095;
+        struct tegra_max98095 *machine;
+        struct tegra_asoc_platform_data *pdata;
+        int ret;
+
+        pdata = pdev->dev.platform_data;
+        if (!pdata) {
+                dev_err(&pdev->dev, "No platform data supplied\n");
+                return -EINVAL;
+        }
+
+        machine = kzalloc(sizeof(struct tegra_max98095), GFP_KERNEL);
+        if (!machine) {
+                dev_err(&pdev->dev, "Can't allocate tegra_max98095 struct\n");
+                return -ENOMEM;
+        }
+
+        machine->pdata = pdata;
+
+        ret = tegra_asoc_utils_init(&machine->util_data, &pdev->dev);
+        if (ret)
+                goto err_free_machine;
+
+        card->dev = &pdev->dev;
+        platform_set_drvdata(pdev, card);
+        snd_soc_card_set_drvdata(card, machine);
+
+#ifdef CONFIG_SWITCH
+        /* Add h2w switch class support */
+        ret = switch_dev_register(&wired_switch_dev);
+        if (ret < 0) {
+                dev_err(&pdev->dev, "not able to register switch device\n");
+                goto err_fini_utils;
+        }
+#endif
+
+        ret = snd_soc_register_card(card);
+        if (ret) {
+                dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n",
+                        ret);
+                goto err_switch_unregister;
+        }
+
+        return 0;
+
+err_switch_unregister:
+#ifdef CONFIG_SWITCH
+        switch_dev_unregister(&wired_switch_dev);
+#endif
+err_fini_utils:
+        tegra_asoc_utils_fini(&machine->util_data);
+err_free_machine:
+        kfree(machine);
+        return ret;
+}
+
+static int __devexit tegra_max98095_driver_remove(struct platform_device *pdev)
+{
+        struct snd_soc_card *card = platform_get_drvdata(pdev);
+        struct tegra_max98095 *machine = snd_soc_card_get_drvdata(card);
+        struct tegra_asoc_platform_data *pdata = machine->pdata;
+
+        snd_soc_unregister_card(card);
+
+#ifdef CONFIG_SWITCH
+        switch_dev_unregister(&wired_switch_dev);
+#endif
+
+        tegra_asoc_utils_fini(&machine->util_data);
+
+        if (machine->gpio_requested & GPIO_EXT_MIC_EN)
+                gpio_free(pdata->gpio_ext_mic_en);
+        if (machine->gpio_requested & GPIO_INT_MIC_EN)
+                gpio_free(pdata->gpio_int_mic_en);
+        if (machine->gpio_requested & GPIO_HP_MUTE)
+                gpio_free(pdata->gpio_hp_mute);
+        if (machine->gpio_requested & GPIO_SPKR_EN)
+                gpio_free(pdata->gpio_spkr_en);
+
+        kfree(machine);
+
+        return 0;
+}
+
+static struct platform_driver tegra_max98095_driver = {
+        .driver = {
+                .name = DRV_NAME,
+                .owner = THIS_MODULE,
+                .pm = &snd_soc_pm_ops,
+        },
+        .probe = tegra_max98095_driver_probe,
+        .remove = __devexit_p(tegra_max98095_driver_remove),
+};
+
+static int __init tegra_max98095_modinit(void)
+{
+        return platform_driver_register(&tegra_max98095_driver);
+}
+module_init(tegra_max98095_modinit);
+
+static void __exit tegra_max98095_modexit(void)
+{
+        platform_driver_unregister(&tegra_max98095_driver);
+}
+module_exit(tegra_max98095_modexit);
+
+MODULE_AUTHOR("Ravindra Lokhande <rlokhande@nvidia.com>");
+MODULE_DESCRIPTION("Tegra+MAX98095 machine ASoC driver");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:" DRV_NAME);