[funini.com] -> [kei@sodan] -> Kernel Reading

root/sound/soc/codecs/ak4535.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. ak4535_read_reg_cache
  2. ak4535_read
  3. ak4535_write_reg_cache
  4. ak4535_write
  5. ak4535_sync
  6. ak4535_add_controls
  7. ak4535_add_widgets
  8. ak4535_set_dai_sysclk
  9. ak4535_hw_params
  10. ak4535_set_dai_fmt
  11. ak4535_mute
  12. ak4535_set_bias_level
  13. ak4535_suspend
  14. ak4535_resume
  15. ak4535_init
  16. ak4535_i2c_probe
  17. ak4535_i2c_remove
  18. ak4535_add_i2c_device
  19. ak4535_probe
  20. ak4535_remove

/*
 * ak4535.c  --  AK4535 ALSA Soc Audio driver
 *
 * Copyright 2005 Openedhand Ltd.
 *
 * Author: Richard Purdie <richard@openedhand.com>
 *
 * Based on wm8753.c by Liam Girdwood
 *
 * 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/moduleparam.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/i2c.h>
#include <linux/platform_device.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/soc-dapm.h>
#include <sound/initval.h>

#include "ak4535.h"

#define AK4535_VERSION "0.3"

struct snd_soc_codec_device soc_codec_dev_ak4535;

/* codec private data */
struct ak4535_priv {
        unsigned int sysclk;
};

/*
 * ak4535 register cache
 */
static const u16 ak4535_reg[AK4535_CACHEREGNUM] = {
    0x0000, 0x0080, 0x0000, 0x0003,
    0x0002, 0x0000, 0x0011, 0x0001,
    0x0000, 0x0040, 0x0036, 0x0010,
    0x0000, 0x0000, 0x0057, 0x0000,
};

/*
 * read ak4535 register cache
 */
static inline unsigned int ak4535_read_reg_cache(struct snd_soc_codec *codec,
        unsigned int reg)
{
        u16 *cache = codec->reg_cache;
        if (reg >= AK4535_CACHEREGNUM)
                return -1;
        return cache[reg];
}

static inline unsigned int ak4535_read(struct snd_soc_codec *codec,
        unsigned int reg)
{
        u8 data;
        data = reg;

        if (codec->hw_write(codec->control_data, &data, 1) != 1)
                return -EIO;

        if (codec->hw_read(codec->control_data, &data, 1) != 1)
                return -EIO;

        return data;
};

/*
 * write ak4535 register cache
 */
static inline void ak4535_write_reg_cache(struct snd_soc_codec *codec,
        u16 reg, unsigned int value)
{
        u16 *cache = codec->reg_cache;
        if (reg >= AK4535_CACHEREGNUM)
                return;
        cache[reg] = value;
}

/*
 * write to the AK4535 register space
 */
static int ak4535_write(struct snd_soc_codec *codec, unsigned int reg,
        unsigned int value)
{
        u8 data[2];

        /* data is
         *   D15..D8 AK4535 register offset
         *   D7...D0 register data
         */
        data[0] = reg & 0xff;
        data[1] = value & 0xff;

        ak4535_write_reg_cache(codec, reg, value);
        if (codec->hw_write(codec->control_data, data, 2) == 2)
                return 0;
        else
                return -EIO;
}

static int ak4535_sync(struct snd_soc_codec *codec)
{
        u16 *cache = codec->reg_cache;
        int i, r = 0;

        for (i = 0; i < AK4535_CACHEREGNUM; i++)
                r |= ak4535_write(codec, i, cache[i]);

        return r;
};

static const char *ak4535_mono_gain[] = {"+6dB", "-17dB"};
static const char *ak4535_mono_out[] = {"(L + R)/2", "Hi-Z"};
static const char *ak4535_hp_out[] = {"Stereo", "Mono"};
static const char *ak4535_deemp[] = {"44.1kHz", "Off", "48kHz", "32kHz"};
static const char *ak4535_mic_select[] = {"Internal", "External"};

static const struct soc_enum ak4535_enum[] = {
        SOC_ENUM_SINGLE(AK4535_SIG1, 7, 2, ak4535_mono_gain),
        SOC_ENUM_SINGLE(AK4535_SIG1, 6, 2, ak4535_mono_out),
        SOC_ENUM_SINGLE(AK4535_MODE2, 2, 2, ak4535_hp_out),
        SOC_ENUM_SINGLE(AK4535_DAC, 0, 4, ak4535_deemp),
        SOC_ENUM_SINGLE(AK4535_MIC, 1, 2, ak4535_mic_select),
};

static const struct snd_kcontrol_new ak4535_snd_controls[] = {
        SOC_SINGLE("ALC2 Switch", AK4535_SIG1, 1, 1, 0),
        SOC_ENUM("Mono 1 Output", ak4535_enum[1]),
        SOC_ENUM("Mono 1 Gain", ak4535_enum[0]),
        SOC_ENUM("Headphone Output", ak4535_enum[2]),
        SOC_ENUM("Playback Deemphasis", ak4535_enum[3]),
        SOC_SINGLE("Bass Volume", AK4535_DAC, 2, 3, 0),
        SOC_SINGLE("Mic Boost (+20dB) Switch", AK4535_MIC, 0, 1, 0),
        SOC_ENUM("Mic Select", ak4535_enum[4]),
        SOC_SINGLE("ALC Operation Time", AK4535_TIMER, 0, 3, 0),
        SOC_SINGLE("ALC Recovery Time", AK4535_TIMER, 2, 3, 0),
        SOC_SINGLE("ALC ZC Time", AK4535_TIMER, 4, 3, 0),
        SOC_SINGLE("ALC 1 Switch", AK4535_ALC1, 5, 1, 0),
        SOC_SINGLE("ALC 2 Switch", AK4535_ALC1, 6, 1, 0),
        SOC_SINGLE("ALC Volume", AK4535_ALC2, 0, 127, 0),
        SOC_SINGLE("Capture Volume", AK4535_PGA, 0, 127, 0),
        SOC_SINGLE("Left Playback Volume", AK4535_LATT, 0, 127, 1),
        SOC_SINGLE("Right Playback Volume", AK4535_RATT, 0, 127, 1),
        SOC_SINGLE("AUX Bypass Volume", AK4535_VOL, 0, 15, 0),
        SOC_SINGLE("Mic Sidetone Volume", AK4535_VOL, 4, 7, 0),
};

/* add non dapm controls */
static int ak4535_add_controls(struct snd_soc_codec *codec)
{
        int err, i;

        for (i = 0; i < ARRAY_SIZE(ak4535_snd_controls); i++) {
                err = snd_ctl_add(codec->card,
                        snd_soc_cnew(&ak4535_snd_controls[i], codec, NULL));
                if (err < 0)
                        return err;
        }

        return 0;
}

/* Mono 1 Mixer */
static const struct snd_kcontrol_new ak4535_mono1_mixer_controls[] = {
        SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG1, 4, 1, 0),
        SOC_DAPM_SINGLE("Mono Playback Switch", AK4535_SIG1, 5, 1, 0),
};

/* Stereo Mixer */
static const struct snd_kcontrol_new ak4535_stereo_mixer_controls[] = {
        SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG2, 4, 1, 0),
        SOC_DAPM_SINGLE("Playback Switch", AK4535_SIG2, 7, 1, 0),
        SOC_DAPM_SINGLE("Aux Bypass Switch", AK4535_SIG2, 5, 1, 0),
};

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

/* Input mux */
static const struct snd_kcontrol_new ak4535_input_mux_control =
        SOC_DAPM_ENUM("Input Select", ak4535_enum[4]);

/* HP L switch */
static const struct snd_kcontrol_new ak4535_hpl_control =
        SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 1, 1, 1);

/* HP R switch */
static const struct snd_kcontrol_new ak4535_hpr_control =
        SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 0, 1, 1);

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

/* Line out switch */
static const struct snd_kcontrol_new ak4535_line_control =
        SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 6, 1, 0);

/* ak4535 dapm widgets */
static const struct snd_soc_dapm_widget ak4535_dapm_widgets[] = {
        SND_SOC_DAPM_MIXER("Stereo Mixer", SND_SOC_NOPM, 0, 0,
                &ak4535_stereo_mixer_controls[0],
                ARRAY_SIZE(ak4535_stereo_mixer_controls)),
        SND_SOC_DAPM_MIXER("Mono1 Mixer", SND_SOC_NOPM, 0, 0,
                &ak4535_mono1_mixer_controls[0],
                ARRAY_SIZE(ak4535_mono1_mixer_controls)),
        SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0,
                &ak4535_input_mixer_controls[0],
                ARRAY_SIZE(ak4535_input_mixer_controls)),
        SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0,
                &ak4535_input_mux_control),
        SND_SOC_DAPM_DAC("DAC", "Playback", AK4535_PM2, 0, 0),
        SND_SOC_DAPM_SWITCH("Mono 2 Enable", SND_SOC_NOPM, 0, 0,
                &ak4535_mono2_control),
        /* speaker powersave bit */
        SND_SOC_DAPM_PGA("Speaker Enable", AK4535_MODE2, 0, 0, NULL, 0),
        SND_SOC_DAPM_SWITCH("Line Out Enable", SND_SOC_NOPM, 0, 0,
                &ak4535_line_control),
        SND_SOC_DAPM_SWITCH("Left HP Enable", SND_SOC_NOPM, 0, 0,
                &ak4535_hpl_control),
        SND_SOC_DAPM_SWITCH("Right HP Enable", SND_SOC_NOPM, 0, 0,
                &ak4535_hpr_control),
        SND_SOC_DAPM_OUTPUT("LOUT"),
        SND_SOC_DAPM_OUTPUT("HPL"),
        SND_SOC_DAPM_OUTPUT("ROUT"),
        SND_SOC_DAPM_OUTPUT("HPR"),
        SND_SOC_DAPM_OUTPUT("SPP"),
        SND_SOC_DAPM_OUTPUT("SPN"),
        SND_SOC_DAPM_OUTPUT("MOUT1"),
        SND_SOC_DAPM_OUTPUT("MOUT2"),
        SND_SOC_DAPM_OUTPUT("MICOUT"),
        SND_SOC_DAPM_ADC("ADC", "Capture", AK4535_PM1, 0, 0),
        SND_SOC_DAPM_PGA("Spk Amp", AK4535_PM2, 3, 0, NULL, 0),
        SND_SOC_DAPM_PGA("HP R Amp", AK4535_PM2, 1, 0, NULL, 0),
        SND_SOC_DAPM_PGA("HP L Amp", AK4535_PM2, 2, 0, NULL, 0),
        SND_SOC_DAPM_PGA("Mic", AK4535_PM1, 1, 0, NULL, 0),
        SND_SOC_DAPM_PGA("Line Out", AK4535_PM1, 4, 0, NULL, 0),
        SND_SOC_DAPM_PGA("Mono Out", AK4535_PM1, 3, 0, NULL, 0),
        SND_SOC_DAPM_PGA("AUX In", AK4535_PM1, 2, 0, NULL, 0),

        SND_SOC_DAPM_MICBIAS("Mic Int Bias", AK4535_MIC, 3, 0),
        SND_SOC_DAPM_MICBIAS("Mic Ext Bias", AK4535_MIC, 4, 0),
        SND_SOC_DAPM_INPUT("MICIN"),
        SND_SOC_DAPM_INPUT("MICEXT"),
        SND_SOC_DAPM_INPUT("AUX"),
        SND_SOC_DAPM_INPUT("MIN"),
        SND_SOC_DAPM_INPUT("AIN"),
};

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

        /* mono1 mixer */
        {"Mono1 Mixer", "Mic Sidetone Switch", "Mic"},
        {"Mono1 Mixer", "Mono Playback Switch", "DAC"},

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

        /* line out */
        {"LOUT", NULL, "Line Out Enable"},
        {"ROUT", NULL, "Line Out Enable"},
        {"Line Out Enable", "Switch", "Line Out"},
        {"Line Out", NULL, "Stereo Mixer"},

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

        /* left HP */
        {"HPL", NULL, "Left HP Enable"},
        {"Left HP Enable", "Switch", "HP L Amp"},
        {"HP L Amp", NULL, "Stereo Mixer"},

        /* right HP */
        {"HPR", NULL, "Right HP Enable"},
        {"Right HP Enable", "Switch", "HP R Amp"},
        {"HP R Amp", NULL, "Stereo Mixer"},

        /* speaker */
        {"SPP", NULL, "Speaker Enable"},
        {"SPN", NULL, "Speaker Enable"},
        {"Speaker Enable", "Switch", "Spk Amp"},
        {"Spk Amp", NULL, "MIN"},

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

        /* 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 ak4535_add_widgets(struct snd_soc_codec *codec)
{
        snd_soc_dapm_new_controls(codec, ak4535_dapm_widgets,
                                  ARRAY_SIZE(ak4535_dapm_widgets));

        snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));

        snd_soc_dapm_new_widgets(codec);
        return 0;
}

static int ak4535_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 ak4535_priv *ak4535 = codec->private_data;

        ak4535->sysclk = freq;
        return 0;
}

static int ak4535_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_device *socdev = rtd->socdev;
        struct snd_soc_codec *codec = socdev->codec;
        struct ak4535_priv *ak4535 = codec->private_data;
        u8 mode2 = ak4535_read_reg_cache(codec, AK4535_MODE2) & ~(0x3 << 5);
        int rate = params_rate(params), fs = 256;

        if (rate)
                fs = ak4535->sysclk / rate;

        /* set fs */
        switch (fs) {
        case 1024:
                mode2 |= (0x2 << 5);
                break;
        case 512:
                mode2 |= (0x1 << 5);
                break;
        case 256:
                break;
        }

        /* set rate */
        ak4535_write(codec, AK4535_MODE2, mode2);
        return 0;
}

static int ak4535_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 = 0x0002;
                break;
        case SND_SOC_DAIFMT_LEFT_J:
                mode1 = 0x0001;
                break;
        default:
                return -EINVAL;
        }

        /* use 32 fs for BCLK to save power */
        mode1 |= 0x4;

        ak4535_write(codec, AK4535_MODE1, mode1);
        return 0;
}

static int ak4535_mute(struct snd_soc_dai *dai, int mute)
{
        struct snd_soc_codec *codec = dai->codec;
        u16 mute_reg = ak4535_read_reg_cache(codec, AK4535_DAC) & 0xffdf;
        if (!mute)
                ak4535_write(codec, AK4535_DAC, mute_reg);
        else
                ak4535_write(codec, AK4535_DAC, mute_reg | 0x20);
        return 0;
}

static int ak4535_set_bias_level(struct snd_soc_codec *codec,
        enum snd_soc_bias_level level)
{
        u16 i;

        switch (level) {
        case SND_SOC_BIAS_ON:
                ak4535_mute(codec->dai, 0);
                break;
        case SND_SOC_BIAS_PREPARE:
                ak4535_mute(codec->dai, 1);
                break;
        case SND_SOC_BIAS_STANDBY:
                i = ak4535_read_reg_cache(codec, AK4535_PM1);
                ak4535_write(codec, AK4535_PM1, i | 0x80);
                i = ak4535_read_reg_cache(codec, AK4535_PM2);
                ak4535_write(codec, AK4535_PM2, i & (~0x80));
                break;
        case SND_SOC_BIAS_OFF:
                i = ak4535_read_reg_cache(codec, AK4535_PM1);
                ak4535_write(codec, AK4535_PM1, i & (~0x80));
                break;
        }
        codec->bias_level = level;
        return 0;
}

#define AK4535_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
                SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
                SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)

struct snd_soc_dai ak4535_dai = {
        .name = "AK4535",
        .playback = {
                .stream_name = "Playback",
                .channels_min = 1,
                .channels_max = 2,
                .rates = AK4535_RATES,
                .formats = SNDRV_PCM_FMTBIT_S16_LE,},
        .capture = {
                .stream_name = "Capture",
                .channels_min = 1,
                .channels_max = 2,
                .rates = AK4535_RATES,
                .formats = SNDRV_PCM_FMTBIT_S16_LE,},
        .ops = {
                .hw_params = ak4535_hw_params,
        },
        .dai_ops = {
                .set_fmt = ak4535_set_dai_fmt,
                .digital_mute = ak4535_mute,
                .set_sysclk = ak4535_set_dai_sysclk,
        },
};
EXPORT_SYMBOL_GPL(ak4535_dai);

static int ak4535_suspend(struct platform_device *pdev, pm_message_t state)
{
        struct snd_soc_device *socdev = platform_get_drvdata(pdev);
        struct snd_soc_codec *codec = socdev->codec;

        ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);
        return 0;
}

static int ak4535_resume(struct platform_device *pdev)
{
        struct snd_soc_device *socdev = platform_get_drvdata(pdev);
        struct snd_soc_codec *codec = socdev->codec;
        ak4535_sync(codec);
        ak4535_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
        ak4535_set_bias_level(codec, codec->suspend_bias_level);
        return 0;
}

/*
 * initialise the AK4535 driver
 * register the mixer and dsp interfaces with the kernel
 */
static int ak4535_init(struct snd_soc_device *socdev)
{
        struct snd_soc_codec *codec = socdev->codec;
        int ret = 0;

        codec->name = "AK4535";
        codec->owner = THIS_MODULE;
        codec->read = ak4535_read_reg_cache;
        codec->write = ak4535_write;
        codec->set_bias_level = ak4535_set_bias_level;
        codec->dai = &ak4535_dai;
        codec->num_dai = 1;
        codec->reg_cache_size = ARRAY_SIZE(ak4535_reg);
        codec->reg_cache = kmemdup(ak4535_reg, sizeof(ak4535_reg), GFP_KERNEL);

        if (codec->reg_cache == NULL)
                return -ENOMEM;

        /* register pcms */
        ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
        if (ret < 0) {
                printk(KERN_ERR "ak4535: failed to create pcms\n");
                goto pcm_err;
        }

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

        ak4535_add_controls(codec);
        ak4535_add_widgets(codec);
        ret = snd_soc_register_card(socdev);
        if (ret < 0) {
                printk(KERN_ERR "ak4535: failed to register card\n");
                goto card_err;
        }

        return ret;

card_err:
        snd_soc_free_pcms(socdev);
        snd_soc_dapm_free(socdev);
pcm_err:
        kfree(codec->reg_cache);

        return ret;
}

static struct snd_soc_device *ak4535_socdev;

#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)

static int ak4535_i2c_probe(struct i2c_client *i2c,
                            const struct i2c_device_id *id)
{
        struct snd_soc_device *socdev = ak4535_socdev;
        struct snd_soc_codec *codec = socdev->codec;
        int ret;

        i2c_set_clientdata(i2c, codec);
        codec->control_data = i2c;

        ret = ak4535_init(socdev);
        if (ret < 0)
                printk(KERN_ERR "failed to initialise AK4535\n");

        return ret;
}

static int ak4535_i2c_remove(struct i2c_client *client)
{
        struct snd_soc_codec *codec = i2c_get_clientdata(client);
        kfree(codec->reg_cache);
        return 0;
}

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

static struct i2c_driver ak4535_i2c_driver = {
        .driver = {
                .name = "AK4535 I2C Codec",
                .owner = THIS_MODULE,
        },
        .probe =    ak4535_i2c_probe,
        .remove =   ak4535_i2c_remove,
        .id_table = ak4535_i2c_id,
};

static int ak4535_add_i2c_device(struct platform_device *pdev,
                                 const struct ak4535_setup_data *setup)
{
        struct i2c_board_info info;
        struct i2c_adapter *adapter;
        struct i2c_client *client;
        int ret;

        ret = i2c_add_driver(&ak4535_i2c_driver);
        if (ret != 0) {
                dev_err(&pdev->dev, "can't add i2c driver\n");
                return ret;
        }

        memset(&info, 0, sizeof(struct i2c_board_info));
        info.addr = setup->i2c_address;
        strlcpy(info.type, "ak4535", I2C_NAME_SIZE);

        adapter = i2c_get_adapter(setup->i2c_bus);
        if (!adapter) {
                dev_err(&pdev->dev, "can't get i2c adapter %d\n",
                        setup->i2c_bus);
                goto err_driver;
        }

        client = i2c_new_device(adapter, &info);
        i2c_put_adapter(adapter);
        if (!client) {
                dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
                        (unsigned int)info.addr);
                goto err_driver;
        }

        return 0;

err_driver:
        i2c_del_driver(&ak4535_i2c_driver);
        return -ENODEV;
}
#endif

static int ak4535_probe(struct platform_device *pdev)
{
        struct snd_soc_device *socdev = platform_get_drvdata(pdev);
        struct ak4535_setup_data *setup;
        struct snd_soc_codec *codec;
        struct ak4535_priv *ak4535;
        int ret;

        printk(KERN_INFO "AK4535 Audio Codec %s", AK4535_VERSION);

        setup = socdev->codec_data;
        codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
        if (codec == NULL)
                return -ENOMEM;

        ak4535 = kzalloc(sizeof(struct ak4535_priv), GFP_KERNEL);
        if (ak4535 == NULL) {
                kfree(codec);
                return -ENOMEM;
        }

        codec->private_data = ak4535;
        socdev->codec = codec;
        mutex_init(&codec->mutex);
        INIT_LIST_HEAD(&codec->dapm_widgets);
        INIT_LIST_HEAD(&codec->dapm_paths);

        ak4535_socdev = socdev;
        ret = -ENODEV;

#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
        if (setup->i2c_address) {
                codec->hw_write = (hw_write_t)i2c_master_send;
                codec->hw_read = (hw_read_t)i2c_master_recv;
                ret = ak4535_add_i2c_device(pdev, setup);
        }
#endif

        if (ret != 0) {
                kfree(codec->private_data);
                kfree(codec);
        }
        return ret;
}

/* power down chip */
static int ak4535_remove(struct platform_device *pdev)
{
        struct snd_soc_device *socdev = platform_get_drvdata(pdev);
        struct snd_soc_codec *codec = socdev->codec;

        if (codec->control_data)
                ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);

        snd_soc_free_pcms(socdev);
        snd_soc_dapm_free(socdev);
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
        i2c_unregister_device(codec->control_data);
        i2c_del_driver(&ak4535_i2c_driver);
#endif
        kfree(codec->private_data);
        kfree(codec);

        return 0;
}

struct snd_soc_codec_device soc_codec_dev_ak4535 = {
        .probe =        ak4535_probe,
        .remove =       ak4535_remove,
        .suspend =      ak4535_suspend,
        .resume =       ak4535_resume,
};
EXPORT_SYMBOL_GPL(soc_codec_dev_ak4535);

MODULE_DESCRIPTION("Soc AK4535 driver");
MODULE_AUTHOR("Richard Purdie");
MODULE_LICENSE("GPL");

/* [<][>][^][v][top][bottom][index][help] */

[funini.com] -> [kei@sodan] -> Kernel Reading