ak4641.c

Go to the documentation of this file.

/*
 * ak4641.c  --  AK4641 ALSA Soc Audio driver
 *
 * Copyright (C) 2008 Harald Welte <[email protected]>
 * Copyright (C) 2011 Dmitry Artamonow <[email protected]>
 *
 * Based on ak4535.c by Richard Purdie
 *
 * 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.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/gpio.h>
#include <linux/pm.h>
#include <linux/i2c.h>
#include <linux/slab.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/initval.h>
#include <sound/tlv.h>
#include <sound/ak4641.h>

#include "ak4641.h"

/* codec private data */
struct ak4641_priv {
    unsigned int sysclk;
    int deemph;
    int playback_fs;
};

/*
 * ak4641 register cache
 */
static const u8 ak4641_reg[AK4641_CACHEREGNUM] = {
    0x00, 0x80, 0x00, 0x80,
    0x02, 0x00, 0x11, 0x05,
    0x00, 0x00, 0x36, 0x10,
    0x00, 0x00, 0x57, 0x00,
    0x88, 0x88, 0x08, 0x08
};

static const int deemph_settings[] = {44100, 0, 48000, 32000};

static int ak4641_set_deemph(struct snd_soc_codec *codec)
{
    struct ak4641_priv *ak4641 = snd_soc_codec_get_drvdata(codec);
    int i, best = 0;

    for (i = 0 ; i < ARRAY_SIZE(deemph_settings); i++) {
        /* if deemphasis is on, select the nearest available rate */
        if (ak4641->deemph && deemph_settings[i] != 0 &&
            abs(deemph_settings[i] - ak4641->playback_fs) <
            abs(deemph_settings[best] - ak4641->playback_fs))
            best = i;

        if (!ak4641->deemph && deemph_settings[i] == 0)
            best = i;
    }

    dev_dbg(codec->dev, "Set deemphasis %d\n", best);

    return snd_soc_update_bits(codec, AK4641_DAC, 0x3, best);
}

static int ak4641_put_deemph(struct snd_kcontrol *kcontrol,
                struct snd_ctl_elem_value *ucontrol)
{
    struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
    struct ak4641_priv *ak4641 = snd_soc_codec_get_drvdata(codec);
    int deemph = ucontrol->value.enumerated.item[0];

    if (deemph > 1)
        return -EINVAL;

    ak4641->deemph = deemph;

    return ak4641_set_deemph(codec);
}

static int ak4641_get_deemph(struct snd_kcontrol *kcontrol,
                struct snd_ctl_elem_value *ucontrol)
{
    struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
    struct ak4641_priv *ak4641 = snd_soc_codec_get_drvdata(codec);

    ucontrol->value.enumerated.item[0] = ak4641->deemph;
    return 0;
};

static const char *ak4641_mono_out[] = {"(L + R)/2", "Hi-Z"};
static const char *ak4641_hp_out[] = {"Stereo", "Mono"};
static const char *ak4641_mic_select[] = {"Internal", "External"};
static const char *ak4641_mic_or_dac[] = {"Microphone", "Voice DAC"};


static const DECLARE_TLV_DB_SCALE(mono_gain_tlv, -1700, 2300, 0);
static const DECLARE_TLV_DB_SCALE(mic_boost_tlv, 0, 2000, 0);
static const DECLARE_TLV_DB_SCALE(eq_tlv, -1050, 150, 0);
static const DECLARE_TLV_DB_SCALE(master_tlv, -12750, 50, 0);
static const DECLARE_TLV_DB_SCALE(mic_stereo_sidetone_tlv, -2700, 300, 0);
static const DECLARE_TLV_DB_SCALE(mic_mono_sidetone_tlv, -400, 400, 0);
static const DECLARE_TLV_DB_SCALE(capture_tlv, -800, 50, 0);
static const DECLARE_TLV_DB_SCALE(alc_tlv, -800, 50, 0);
static const DECLARE_TLV_DB_SCALE(aux_in_tlv, -2100, 300, 0);


static const struct soc_enum ak4641_mono_out_enum =
    SOC_ENUM_SINGLE(AK4641_SIG1, 6, 2, ak4641_mono_out);
static const struct soc_enum ak4641_hp_out_enum =
    SOC_ENUM_SINGLE(AK4641_MODE2, 2, 2, ak4641_hp_out);
static const struct soc_enum ak4641_mic_select_enum =
    SOC_ENUM_SINGLE(AK4641_MIC, 1, 2, ak4641_mic_select);
static const struct soc_enum ak4641_mic_or_dac_enum =
    SOC_ENUM_SINGLE(AK4641_BTIF, 4, 2, ak4641_mic_or_dac);

static const struct snd_kcontrol_new ak4641_snd_controls[] = {
    SOC_ENUM("Mono 1 Output", ak4641_mono_out_enum),
    SOC_SINGLE_TLV("Mono 1 Gain Volume", AK4641_SIG1, 7, 1, 1,
                            mono_gain_tlv),
    SOC_ENUM("Headphone Output", ak4641_hp_out_enum),
    SOC_SINGLE_BOOL_EXT("Playback Deemphasis Switch", 0,
                    ak4641_get_deemph, ak4641_put_deemph),

    SOC_SINGLE_TLV("Mic Boost Volume", AK4641_MIC, 0, 1, 0, mic_boost_tlv),

    SOC_SINGLE("ALC Operation Time", AK4641_TIMER, 0, 3, 0),
    SOC_SINGLE("ALC Recovery Time", AK4641_TIMER, 2, 3, 0),
    SOC_SINGLE("ALC ZC Time", AK4641_TIMER, 4, 3, 0),

    SOC_SINGLE("ALC 1 Switch", AK4641_ALC1, 5, 1, 0),

    SOC_SINGLE_TLV("ALC Volume", AK4641_ALC2, 0, 71, 0, alc_tlv),
    SOC_SINGLE("Left Out Enable Switch", AK4641_SIG2, 1, 1, 0),
    SOC_SINGLE("Right Out Enable Switch", AK4641_SIG2, 0, 1, 0),

    SOC_SINGLE_TLV("Capture Volume", AK4641_PGA, 0, 71, 0, capture_tlv),

    SOC_DOUBLE_R_TLV("Master Playback Volume", AK4641_LATT,
                AK4641_RATT, 0, 255, 1, master_tlv),

    SOC_SINGLE_TLV("AUX In Volume", AK4641_VOL, 0, 15, 0, aux_in_tlv),

    SOC_SINGLE("Equalizer Switch", AK4641_DAC, 2, 1, 0),
    SOC_SINGLE_TLV("EQ1 100 Hz Volume", AK4641_EQLO, 0, 15, 1, eq_tlv),
    SOC_SINGLE_TLV("EQ2 250 Hz Volume", AK4641_EQLO, 4, 15, 1, eq_tlv),
    SOC_SINGLE_TLV("EQ3 1 kHz Volume", AK4641_EQMID, 0, 15, 1, eq_tlv),
    SOC_SINGLE_TLV("EQ4 3.5 kHz Volume", AK4641_EQMID, 4, 15, 1, eq_tlv),
    SOC_SINGLE_TLV("EQ5 10 kHz Volume", AK4641_EQHI, 0, 15, 1, eq_tlv),
};

/* Mono 1 Mixer */
static const struct snd_kcontrol_new ak4641_mono1_mixer_controls[] = {
    SOC_DAPM_SINGLE_TLV("Mic Mono Sidetone Volume", AK4641_VOL, 7, 1, 0,
                        mic_mono_sidetone_tlv),
    SOC_DAPM_SINGLE("Mic Mono Sidetone Switch", AK4641_SIG1, 4, 1, 0),
    SOC_DAPM_SINGLE("Mono Playback Switch", AK4641_SIG1, 5, 1, 0),
};

/* Stereo Mixer */
static const struct snd_kcontrol_new ak4641_stereo_mixer_controls[] = {
    SOC_DAPM_SINGLE_TLV("Mic Sidetone Volume", AK4641_VOL, 4, 7, 0,
                        mic_stereo_sidetone_tlv),
    SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4641_SIG2, 4, 1, 0),
    SOC_DAPM_SINGLE("Playback Switch", AK4641_SIG2, 7, 1, 0),
    SOC_DAPM_SINGLE("Aux Bypass Switch", AK4641_SIG2, 5, 1, 0),
};

/* Input Mixer */
static const struct snd_kcontrol_new ak4641_input_mixer_controls[] = {
    SOC_DAPM_SINGLE("Mic Capture Switch", AK4641_MIC, 2, 1, 0),
    SOC_DAPM_SINGLE("Aux Capture Switch", AK4641_MIC, 5, 1, 0),
};

/* Mic mux */
static const struct snd_kcontrol_new ak4641_mic_mux_control =
    SOC_DAPM_ENUM("Mic Select", ak4641_mic_select_enum);

/* Input mux */
static const struct snd_kcontrol_new ak4641_input_mux_control =
    SOC_DAPM_ENUM("Input Select", ak4641_mic_or_dac_enum);

/* mono 2 switch */
static const struct snd_kcontrol_new ak4641_mono2_control =
    SOC_DAPM_SINGLE("Switch", AK4641_SIG1, 0, 1, 0);

/* ak4641 dapm widgets */
static const struct snd_soc_dapm_widget ak4641_dapm_widgets[] = {
    SND_SOC_DAPM_MIXER("Stereo Mixer", SND_SOC_NOPM, 0, 0,
        &ak4641_stereo_mixer_controls[0],
        ARRAY_SIZE(ak4641_stereo_mixer_controls)),
    SND_SOC_DAPM_MIXER("Mono1 Mixer", SND_SOC_NOPM, 0, 0,
        &ak4641_mono1_mixer_controls[0],
        ARRAY_SIZE(ak4641_mono1_mixer_controls)),
    SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0,
        &ak4641_input_mixer_controls[0],
        ARRAY_SIZE(ak4641_input_mixer_controls)),
    SND_SOC_DAPM_MUX("Mic Mux", SND_SOC_NOPM, 0, 0,
        &ak4641_mic_mux_control),
    SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0,
        &ak4641_input_mux_control),
    SND_SOC_DAPM_SWITCH("Mono 2 Enable", SND_SOC_NOPM, 0, 0,
        &ak4641_mono2_control),

    SND_SOC_DAPM_OUTPUT("LOUT"),
    SND_SOC_DAPM_OUTPUT("ROUT"),
    SND_SOC_DAPM_OUTPUT("MOUT1"),
    SND_SOC_DAPM_OUTPUT("MOUT2"),
    SND_SOC_DAPM_OUTPUT("MICOUT"),

    SND_SOC_DAPM_ADC("ADC", "HiFi Capture", AK4641_PM1, 0, 0),
    SND_SOC_DAPM_PGA("Mic", AK4641_PM1, 1, 0, NULL, 0),
    SND_SOC_DAPM_PGA("AUX In", AK4641_PM1, 2, 0, NULL, 0),
    SND_SOC_DAPM_PGA("Mono Out", AK4641_PM1, 3, 0, NULL, 0),
    SND_SOC_DAPM_PGA("Line Out", AK4641_PM1, 4, 0, NULL, 0),

    SND_SOC_DAPM_DAC("DAC", "HiFi Playback", AK4641_PM2, 0, 0),
    SND_SOC_DAPM_PGA("Mono Out 2", AK4641_PM2, 3, 0, NULL, 0),

    SND_SOC_DAPM_ADC("Voice ADC", "Voice Capture", AK4641_BTIF, 0, 0),
    SND_SOC_DAPM_DAC("Voice DAC", "Voice Playback", AK4641_BTIF, 1, 0),

    SND_SOC_DAPM_MICBIAS("Mic Int Bias", AK4641_MIC, 3, 0),
    SND_SOC_DAPM_MICBIAS("Mic Ext Bias", AK4641_MIC, 4, 0),

    SND_SOC_DAPM_INPUT("MICIN"),
    SND_SOC_DAPM_INPUT("MICEXT"),
    SND_SOC_DAPM_INPUT("AUX"),
    SND_SOC_DAPM_INPUT("AIN"),
};

static const struct snd_soc_dapm_route ak4641_audio_map[] = {
    /* Stereo Mixer */
    {"Stereo Mixer", "Playback Switch", "DAC"},
    {"Stereo Mixer", "Mic Sidetone Switch", "Input Mux"},
    {"Stereo Mixer", "Aux Bypass Switch", "AUX In"},

    /* Mono 1 Mixer */
    {"Mono1 Mixer", "Mic Mono Sidetone Switch", "Input Mux"},
    {"Mono1 Mixer", "Mono Playback Switch", "DAC"},

    /* Mic */
    {"Mic", NULL, "AIN"},
    {"Mic Mux", "Internal", "Mic Int Bias"},
    {"Mic Mux", "External", "Mic Ext Bias"},
    {"Mic Int Bias", NULL, "MICIN"},
    {"Mic Ext Bias", NULL, "MICEXT"},
    {"MICOUT", NULL, "Mic Mux"},

    /* Input Mux */
    {"Input Mux", "Microphone", "Mic"},
    {"Input Mux", "Voice DAC", "Voice DAC"},

    /* Line Out */
    {"LOUT", NULL, "Line Out"},
    {"ROUT", NULL, "Line Out"},
    {"Line Out", NULL, "Stereo Mixer"},

    /* Mono 1 Out */
    {"MOUT1", NULL, "Mono Out"},
    {"Mono Out", NULL, "Mono1 Mixer"},

    /* Mono 2 Out */
    {"MOUT2", NULL, "Mono 2 Enable"},
    {"Mono 2 Enable", "Switch", "Mono Out 2"},
    {"Mono Out 2", NULL, "Stereo Mixer"},

    {"Voice ADC", NULL, "Mono 2 Enable"},

    /* Aux In */
    {"AUX In", NULL, "AUX"},

    /* ADC */
    {"ADC", NULL, "Input Mixer"},
    {"Input Mixer", "Mic Capture Switch", "Mic"},
    {"Input Mixer", "Aux Capture Switch", "AUX In"},
};

static int ak4641_set_dai_sysclk(struct snd_soc_dai *codec_dai,
    int clk_id, unsigned int freq, int dir)
{
    struct snd_soc_codec *codec = codec_dai->codec;
    struct ak4641_priv *ak4641 = snd_soc_codec_get_drvdata(codec);

    ak4641->sysclk = freq;
    return 0;
}

static int ak4641_i2s_hw_params(struct snd_pcm_substream *substream,
                 struct snd_pcm_hw_params *params,
                 struct snd_soc_dai *dai)
{
    struct snd_soc_codec *codec = dai->codec;
    struct ak4641_priv *ak4641 = snd_soc_codec_get_drvdata(codec);
    int rate = params_rate(params), fs = 256;
    u8 mode2;

    if (rate)
        fs = ak4641->sysclk / rate;
    else
        return -EINVAL;

    /* set fs */
    switch (fs) {
    case 1024:
        mode2 = (0x2 << 5);
        break;
    case 512:
        mode2 = (0x1 << 5);
        break;
    case 256:
        mode2 = (0x0 << 5);
        break;
    default:
        dev_err(codec->dev, "Error: unsupported fs=%d\n", fs);
        return -EINVAL;
    }

    snd_soc_update_bits(codec, AK4641_MODE2, (0x3 << 5), mode2);

    /* Update de-emphasis filter for the new rate */
    if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
        ak4641->playback_fs = rate;
        ak4641_set_deemph(codec);
    };

    return 0;
}

static int ak4641_pcm_set_dai_fmt(struct snd_soc_dai *codec_dai,
                  unsigned int fmt)
{
    struct snd_soc_codec *codec = codec_dai->codec;
    u8 btif;
    int ret;

    /* interface format */
    switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
    case SND_SOC_DAIFMT_I2S:
        btif = (0x3 << 5);
        break;
    case SND_SOC_DAIFMT_LEFT_J:
        btif = (0x2 << 5);
        break;
    case SND_SOC_DAIFMT_DSP_A:  /* MSB after FRM */
        btif = (0x0 << 5);
        break;
    case SND_SOC_DAIFMT_DSP_B:  /* MSB during FRM */
        btif = (0x1 << 5);
        break;
    default:
        return -EINVAL;
    }

    ret = snd_soc_update_bits(codec, AK4641_BTIF, (0x3 << 5), btif);
    if (ret < 0)
        return ret;

    return 0;
}

static int ak4641_i2s_set_dai_fmt(struct snd_soc_dai *codec_dai,
        unsigned int fmt)
{
    struct snd_soc_codec *codec = codec_dai->codec;
    u8 mode1 = 0;

    /* interface format */
    switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
    case SND_SOC_DAIFMT_I2S:
        mode1 = 0x02;
        break;
    case SND_SOC_DAIFMT_LEFT_J:
        mode1 = 0x01;
        break;
    default:
        return -EINVAL;
    }

    return snd_soc_write(codec, AK4641_MODE1, mode1);
}

static int ak4641_mute(struct snd_soc_dai *dai, int mute)
{
    struct snd_soc_codec *codec = dai->codec;

    return snd_soc_update_bits(codec, AK4641_DAC, 0x20, mute ? 0x20 : 0);
}

static int ak4641_set_bias_level(struct snd_soc_codec *codec,
    enum snd_soc_bias_level level)
{
    struct ak4641_platform_data *pdata = codec->dev->platform_data;
    int ret;

    switch (level) {
    case SND_SOC_BIAS_ON:
        /* unmute */
        snd_soc_update_bits(codec, AK4641_DAC, 0x20, 0);
        break;
    case SND_SOC_BIAS_PREPARE:
        /* mute */
        snd_soc_update_bits(codec, AK4641_DAC, 0x20, 0x20);
        break;
    case SND_SOC_BIAS_STANDBY:
        if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
            if (pdata && gpio_is_valid(pdata->gpio_power))
                gpio_set_value(pdata->gpio_power, 1);
            mdelay(1);
            if (pdata && gpio_is_valid(pdata->gpio_npdn))
                gpio_set_value(pdata->gpio_npdn, 1);
            mdelay(1);

            ret = snd_soc_cache_sync(codec);
            if (ret) {
                dev_err(codec->dev,
                    "Failed to sync cache: %d\n", ret);
                return ret;
            }
        }
        snd_soc_update_bits(codec, AK4641_PM1, 0x80, 0x80);
        snd_soc_update_bits(codec, AK4641_PM2, 0x80, 0);
        break;
    case SND_SOC_BIAS_OFF:
        snd_soc_update_bits(codec, AK4641_PM1, 0x80, 0);
        if (pdata && gpio_is_valid(pdata->gpio_npdn))
            gpio_set_value(pdata->gpio_npdn, 0);
        if (pdata && gpio_is_valid(pdata->gpio_power))
            gpio_set_value(pdata->gpio_power, 0);
        codec->cache_sync = 1;
        break;
    }
    codec->dapm.bias_level = level;
    return 0;
}

#define AK4641_RATES    (SNDRV_PCM_RATE_8000_48000)
#define AK4641_RATES_BT (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
             SNDRV_PCM_RATE_16000)
#define AK4641_FORMATS  (SNDRV_PCM_FMTBIT_S16_LE)

static const struct snd_soc_dai_ops ak4641_i2s_dai_ops = {
    .hw_params    = ak4641_i2s_hw_params,
    .set_fmt      = ak4641_i2s_set_dai_fmt,
    .digital_mute = ak4641_mute,
    .set_sysclk   = ak4641_set_dai_sysclk,
};

static const struct snd_soc_dai_ops ak4641_pcm_dai_ops = {
    .hw_params    = NULL, /* rates are controlled by BT chip */
    .set_fmt      = ak4641_pcm_set_dai_fmt,
    .digital_mute = ak4641_mute,
    .set_sysclk   = ak4641_set_dai_sysclk,
};

static struct snd_soc_dai_driver ak4641_dai[] = {
{
    .name = "ak4641-hifi",
    .id = 1,
    .playback = {
        .stream_name = "HiFi Playback",
        .channels_min = 1,
        .channels_max = 2,
        .rates = AK4641_RATES,
        .formats = AK4641_FORMATS,
    },
    .capture = {
        .stream_name = "HiFi Capture",
        .channels_min = 1,
        .channels_max = 2,
        .rates = AK4641_RATES,
        .formats = AK4641_FORMATS,
    },
    .ops = &ak4641_i2s_dai_ops,
    .symmetric_rates = 1,
},
{
    .name = "ak4641-voice",
    .id = 1,
    .playback = {
        .stream_name = "Voice Playback",
        .channels_min = 1,
        .channels_max = 1,
        .rates = AK4641_RATES_BT,
        .formats = AK4641_FORMATS,
    },
    .capture = {
        .stream_name = "Voice Capture",
        .channels_min = 1,
        .channels_max = 1,
        .rates = AK4641_RATES_BT,
        .formats = AK4641_FORMATS,
    },
    .ops = &ak4641_pcm_dai_ops,
    .symmetric_rates = 1,
},
};

static int ak4641_suspend(struct snd_soc_codec *codec)
{
    ak4641_set_bias_level(codec, SND_SOC_BIAS_OFF);
    return 0;
}

static int ak4641_resume(struct snd_soc_codec *codec)
{
    ak4641_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
    return 0;
}

static int ak4641_probe(struct snd_soc_codec *codec)
{
    int ret;

    ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
    if (ret != 0) {
        dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
        return ret;
    }

    /* power on device */
    ak4641_set_bias_level(codec, SND_SOC_BIAS_STANDBY);

    return 0;
}

static int ak4641_remove(struct snd_soc_codec *codec)
{
    ak4641_set_bias_level(codec, SND_SOC_BIAS_OFF);

    return 0;
}


static struct snd_soc_codec_driver soc_codec_dev_ak4641 = {
    .probe          = ak4641_probe,
    .remove         = ak4641_remove,
    .suspend        = ak4641_suspend,
    .resume         = ak4641_resume,
    .controls       = ak4641_snd_controls,
    .num_controls       = ARRAY_SIZE(ak4641_snd_controls),
    .dapm_widgets       = ak4641_dapm_widgets,
    .num_dapm_widgets   = ARRAY_SIZE(ak4641_dapm_widgets),
    .dapm_routes        = ak4641_audio_map,
    .num_dapm_routes    = ARRAY_SIZE(ak4641_audio_map),
    .set_bias_level     = ak4641_set_bias_level,
    .reg_cache_size     = ARRAY_SIZE(ak4641_reg),
    .reg_word_size      = sizeof(u8),
    .reg_cache_default  = ak4641_reg,
    .reg_cache_step     = 1,
};


static int __devinit ak4641_i2c_probe(struct i2c_client *i2c,
                      const struct i2c_device_id *id)
{
    struct ak4641_platform_data *pdata = i2c->dev.platform_data;
    struct ak4641_priv *ak4641;
    int ret;

    ak4641 = devm_kzalloc(&i2c->dev, sizeof(struct ak4641_priv),
                  GFP_KERNEL);
    if (!ak4641)
        return -ENOMEM;

    if (pdata) {
        if (gpio_is_valid(pdata->gpio_power)) {
            ret = gpio_request_one(pdata->gpio_power,
                    GPIOF_OUT_INIT_LOW, "ak4641 power");
            if (ret)
                goto err_out;
        }
        if (gpio_is_valid(pdata->gpio_npdn)) {
            ret = gpio_request_one(pdata->gpio_npdn,
                    GPIOF_OUT_INIT_LOW, "ak4641 npdn");
            if (ret)
                goto err_gpio;

            udelay(1); /* > 150 ns */
            gpio_set_value(pdata->gpio_npdn, 1);
        }
    }

    i2c_set_clientdata(i2c, ak4641);

    ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_ak4641,
                ak4641_dai, ARRAY_SIZE(ak4641_dai));
    if (ret != 0)
        goto err_gpio2;

    return 0;

err_gpio2:
    if (pdata) {
        if (gpio_is_valid(pdata->gpio_power))
            gpio_set_value(pdata->gpio_power, 0);
        if (gpio_is_valid(pdata->gpio_npdn))
            gpio_free(pdata->gpio_npdn);
    }
err_gpio:
    if (pdata && gpio_is_valid(pdata->gpio_power))
        gpio_free(pdata->gpio_power);
err_out:
    return ret;
}

static int __devexit ak4641_i2c_remove(struct i2c_client *i2c)
{
    struct ak4641_platform_data *pdata = i2c->dev.platform_data;

    snd_soc_unregister_codec(&i2c->dev);

    if (pdata) {
        if (gpio_is_valid(pdata->gpio_power)) {
            gpio_set_value(pdata->gpio_power, 0);
            gpio_free(pdata->gpio_power);
        }
        if (gpio_is_valid(pdata->gpio_npdn))
            gpio_free(pdata->gpio_npdn);
    }

    return 0;
}

static const struct i2c_device_id ak4641_i2c_id[] = {
    { "ak4641", 0 },
    { }
};
MODULE_DEVICE_TABLE(i2c, ak4641_i2c_id);

static struct i2c_driver ak4641_i2c_driver = {
    .driver = {
        .name = "ak4641",
        .owner = THIS_MODULE,
    },
    .probe =    ak4641_i2c_probe,
    .remove =   __devexit_p(ak4641_i2c_remove),
    .id_table = ak4641_i2c_id,
};

module_i2c_driver(ak4641_i2c_driver);

MODULE_DESCRIPTION("SoC AK4641 driver");
MODULE_AUTHOR("Harald Welte <[email protected]>");
MODULE_LICENSE("GPL");