[deliverable/linux.git] / sound / soc / codecs / ak4535.c

/*
 * 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];
}

/*
 * 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),
};

/* 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_dai *dai)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_device *socdev = rtd->socdev;
	struct snd_soc_codec *codec = socdev->card->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)

static struct snd_soc_dai_ops ak4535_dai_ops = {
	.hw_params	= ak4535_hw_params,
	.set_fmt	= ak4535_set_dai_fmt,
	.digital_mute	= ak4535_mute,
	.set_sysclk	= ak4535_set_dai_sysclk,
};

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 = &ak4535_dai_ops,
};
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->card->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->card->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->card->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);

	snd_soc_add_controls(codec, ak4535_snd_controls,
				ARRAY_SIZE(ak4535_snd_controls));
	ak4535_add_widgets(codec);
	ret = snd_soc_init_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->card->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->card->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;
		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->card->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)
	if (codec->control_data)
		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);

static int __init ak4535_modinit(void)
{
	return snd_soc_register_dai(&ak4535_dai);
}
module_init(ak4535_modinit);

static void __exit ak4535_exit(void)
{
	snd_soc_unregister_dai(&ak4535_dai);
}
module_exit(ak4535_exit);

MODULE_DESCRIPTION("Soc AK4535 driver");
MODULE_AUTHOR("Richard Purdie");
MODULE_LICENSE("GPL");
Commit	Line	Data
796d2ca8 RP	1	/*
	2	* ak4535.c -- AK4535 ALSA Soc Audio driver
	3	*
	4	* Copyright 2005 Openedhand Ltd.
	5	*
	6	* Author: Richard Purdie <richard@openedhand.com>
	7	*
	8	* Based on wm8753.c by Liam Girdwood
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License version 2 as
	12	* published by the Free Software Foundation.
	13	*/
	14
	15	#include <linux/module.h>
	16	#include <linux/moduleparam.h>
	17	#include <linux/init.h>
	18	#include <linux/delay.h>
	19	#include <linux/pm.h>
	20	#include <linux/i2c.h>
	21	#include <linux/platform_device.h>
	22	#include <sound/core.h>
	23	#include <sound/pcm.h>
	24	#include <sound/pcm_params.h>
	25	#include <sound/soc.h>
	26	#include <sound/soc-dapm.h>
	27	#include <sound/initval.h>
	28
	29	#include "ak4535.h"
	30
796d2ca8 RP	31	#define AK4535_VERSION "0.3"
	32
	33	struct snd_soc_codec_device soc_codec_dev_ak4535;
	34
	35	/* codec private data */
	36	struct ak4535_priv {
	37	unsigned int sysclk;
	38	};
	39
	40	/*
	41	* ak4535 register cache
	42	*/
	43	static const u16 ak4535_reg[AK4535_CACHEREGNUM] = {
	44	0x0000, 0x0080, 0x0000, 0x0003,
	45	0x0002, 0x0000, 0x0011, 0x0001,
	46	0x0000, 0x0040, 0x0036, 0x0010,
	47	0x0000, 0x0000, 0x0057, 0x0000,
	48	};
	49
	50	/*
	51	* read ak4535 register cache
	52	*/
	53	static inline unsigned int ak4535_read_reg_cache(struct snd_soc_codec *codec,
	54	unsigned int reg)
	55	{
	56	u16 *cache = codec->reg_cache;
	57	if (reg >= AK4535_CACHEREGNUM)
	58	return -1;
	59	return cache[reg];
	60	}
	61
796d2ca8 RP	62	/*
	63	* write ak4535 register cache
	64	*/
	65	static inline void ak4535_write_reg_cache(struct snd_soc_codec *codec,
	66	u16 reg, unsigned int value)
	67	{
	68	u16 *cache = codec->reg_cache;
	69	if (reg >= AK4535_CACHEREGNUM)
	70	return;
	71	cache[reg] = value;
	72	}
	73
	74	/*
	75	* write to the AK4535 register space
	76	*/
	77	static int ak4535_write(struct snd_soc_codec *codec, unsigned int reg,
	78	unsigned int value)
	79	{
	80	u8 data[2];
	81
	82	/* data is
	83	* D15..D8 AK4535 register offset
	84	* D7...D0 register data
	85	*/
	86	data[0] = reg & 0xff;
	87	data[1] = value & 0xff;
	88
	89	ak4535_write_reg_cache(codec, reg, value);
	90	if (codec->hw_write(codec->control_data, data, 2) == 2)
	91	return 0;
	92	else
	93	return -EIO;
	94	}
	95
	96	static int ak4535_sync(struct snd_soc_codec *codec)
	97	{
	98	u16 *cache = codec->reg_cache;
	99	int i, r = 0;
	100
	101	for (i = 0; i < AK4535_CACHEREGNUM; i++)
	102	r \|= ak4535_write(codec, i, cache[i]);
	103
	104	return r;
	105	};
	106
	107	static const char *ak4535_mono_gain[] = {"+6dB", "-17dB"};
	108	static const char *ak4535_mono_out[] = {"(L + R)/2", "Hi-Z"};
	109	static const char *ak4535_hp_out[] = {"Stereo", "Mono"};
	110	static const char *ak4535_deemp[] = {"44.1kHz", "Off", "48kHz", "32kHz"};
	111	static const char *ak4535_mic_select[] = {"Internal", "External"};
	112
	113	static const struct soc_enum ak4535_enum[] = {
	114	SOC_ENUM_SINGLE(AK4535_SIG1, 7, 2, ak4535_mono_gain),
	115	SOC_ENUM_SINGLE(AK4535_SIG1, 6, 2, ak4535_mono_out),
	116	SOC_ENUM_SINGLE(AK4535_MODE2, 2, 2, ak4535_hp_out),
	117	SOC_ENUM_SINGLE(AK4535_DAC, 0, 4, ak4535_deemp),
	118	SOC_ENUM_SINGLE(AK4535_MIC, 1, 2, ak4535_mic_select),
	119	};
	120
	121	static const struct snd_kcontrol_new ak4535_snd_controls[] = {
	122	SOC_SINGLE("ALC2 Switch", AK4535_SIG1, 1, 1, 0),
	123	SOC_ENUM("Mono 1 Output", ak4535_enum[1]),
	124	SOC_ENUM("Mono 1 Gain", ak4535_enum[0]),
	125	SOC_ENUM("Headphone Output", ak4535_enum[2]),
126	SOC_ENUM("Playback Deemphasis", ak4535_enum[3]),
127	SOC_SINGLE("Bass Volume", AK4535_DAC, 2, 3, 0),
128	SOC_SINGLE("Mic Boost (+20dB) Switch", AK4535_MIC, 0, 1, 0),
129	SOC_ENUM("Mic Select", ak4535_enum[4]),
130	SOC_SINGLE("ALC Operation Time", AK4535_TIMER, 0, 3, 0),
131	SOC_SINGLE("ALC Recovery Time", AK4535_TIMER, 2, 3, 0),
132	SOC_SINGLE("ALC ZC Time", AK4535_TIMER, 4, 3, 0),
133	SOC_SINGLE("ALC 1 Switch", AK4535_ALC1, 5, 1, 0),
134	SOC_SINGLE("ALC 2 Switch", AK4535_ALC1, 6, 1, 0),
135	SOC_SINGLE("ALC Volume", AK4535_ALC2, 0, 127, 0),
136	SOC_SINGLE("Capture Volume", AK4535_PGA, 0, 127, 0),
137	SOC_SINGLE("Left Playback Volume", AK4535_LATT, 0, 127, 1),
138	SOC_SINGLE("Right Playback Volume", AK4535_RATT, 0, 127, 1),
139	SOC_SINGLE("AUX Bypass Volume", AK4535_VOL, 0, 15, 0),
140	SOC_SINGLE("Mic Sidetone Volume", AK4535_VOL, 4, 7, 0),
141	};
142
796d2ca8 RP	143	/* Mono 1 Mixer */
	144	static const struct snd_kcontrol_new ak4535_mono1_mixer_controls[] = {
	145	SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG1, 4, 1, 0),
	146	SOC_DAPM_SINGLE("Mono Playback Switch", AK4535_SIG1, 5, 1, 0),
	147	};
	148
	149	/* Stereo Mixer */
	150	static const struct snd_kcontrol_new ak4535_stereo_mixer_controls[] = {
	151	SOC_DAPM_SINGLE("Mic Sidetone Switch", AK4535_SIG2, 4, 1, 0),
	152	SOC_DAPM_SINGLE("Playback Switch", AK4535_SIG2, 7, 1, 0),
	153	SOC_DAPM_SINGLE("Aux Bypass Switch", AK4535_SIG2, 5, 1, 0),
	154	};
	155
	156	/* Input Mixer */
	157	static const struct snd_kcontrol_new ak4535_input_mixer_controls[] = {
	158	SOC_DAPM_SINGLE("Mic Capture Switch", AK4535_MIC, 2, 1, 0),
	159	SOC_DAPM_SINGLE("Aux Capture Switch", AK4535_MIC, 5, 1, 0),
	160	};
	161
	162	/* Input mux */
	163	static const struct snd_kcontrol_new ak4535_input_mux_control =
	164	SOC_DAPM_ENUM("Input Select", ak4535_enum[4]);
	165
	166	/* HP L switch */
	167	static const struct snd_kcontrol_new ak4535_hpl_control =
	168	SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 1, 1, 1);
	169
	170	/* HP R switch */
	171	static const struct snd_kcontrol_new ak4535_hpr_control =
	172	SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 0, 1, 1);
	173
	174	/* mono 2 switch */
	175	static const struct snd_kcontrol_new ak4535_mono2_control =
	176	SOC_DAPM_SINGLE("Switch", AK4535_SIG1, 0, 1, 0);
	177
	178	/* Line out switch */
	179	static const struct snd_kcontrol_new ak4535_line_control =
	180	SOC_DAPM_SINGLE("Switch", AK4535_SIG2, 6, 1, 0);
	181
	182	/* ak4535 dapm widgets */
	183	static const struct snd_soc_dapm_widget ak4535_dapm_widgets[] = {
	184	SND_SOC_DAPM_MIXER("Stereo Mixer", SND_SOC_NOPM, 0, 0,
	185	&ak4535_stereo_mixer_controls[0],
	186	ARRAY_SIZE(ak4535_stereo_mixer_controls)),
	187	SND_SOC_DAPM_MIXER("Mono1 Mixer", SND_SOC_NOPM, 0, 0,
	188	&ak4535_mono1_mixer_controls[0],
	189	ARRAY_SIZE(ak4535_mono1_mixer_controls)),
	190	SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0,
	191	&ak4535_input_mixer_controls[0],
	192	ARRAY_SIZE(ak4535_input_mixer_controls)),
	193	SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0,
	194	&ak4535_input_mux_control),
	195	SND_SOC_DAPM_DAC("DAC", "Playback", AK4535_PM2, 0, 0),
	196	SND_SOC_DAPM_SWITCH("Mono 2 Enable", SND_SOC_NOPM, 0, 0,
	197	&ak4535_mono2_control),
	198	/* speaker powersave bit */
	199	SND_SOC_DAPM_PGA("Speaker Enable", AK4535_MODE2, 0, 0, NULL, 0),
	200	SND_SOC_DAPM_SWITCH("Line Out Enable", SND_SOC_NOPM, 0, 0,
	201	&ak4535_line_control),
	202	SND_SOC_DAPM_SWITCH("Left HP Enable", SND_SOC_NOPM, 0, 0,
	203	&ak4535_hpl_control),
	204	SND_SOC_DAPM_SWITCH("Right HP Enable", SND_SOC_NOPM, 0, 0,
	205	&ak4535_hpr_control),
	206	SND_SOC_DAPM_OUTPUT("LOUT"),
207	SND_SOC_DAPM_OUTPUT("HPL"),
208	SND_SOC_DAPM_OUTPUT("ROUT"),
209	SND_SOC_DAPM_OUTPUT("HPR"),
210	SND_SOC_DAPM_OUTPUT("SPP"),
211	SND_SOC_DAPM_OUTPUT("SPN"),
212	SND_SOC_DAPM_OUTPUT("MOUT1"),
213	SND_SOC_DAPM_OUTPUT("MOUT2"),
214	SND_SOC_DAPM_OUTPUT("MICOUT"),
215	SND_SOC_DAPM_ADC("ADC", "Capture", AK4535_PM1, 0, 0),
216	SND_SOC_DAPM_PGA("Spk Amp", AK4535_PM2, 3, 0, NULL, 0),
217	SND_SOC_DAPM_PGA("HP R Amp", AK4535_PM2, 1, 0, NULL, 0),
218	SND_SOC_DAPM_PGA("HP L Amp", AK4535_PM2, 2, 0, NULL, 0),
219	SND_SOC_DAPM_PGA("Mic", AK4535_PM1, 1, 0, NULL, 0),
220	SND_SOC_DAPM_PGA("Line Out", AK4535_PM1, 4, 0, NULL, 0),
221	SND_SOC_DAPM_PGA("Mono Out", AK4535_PM1, 3, 0, NULL, 0),
222	SND_SOC_DAPM_PGA("AUX In", AK4535_PM1, 2, 0, NULL, 0),
223
224	SND_SOC_DAPM_MICBIAS("Mic Int Bias", AK4535_MIC, 3, 0),
225	SND_SOC_DAPM_MICBIAS("Mic Ext Bias", AK4535_MIC, 4, 0),
226	SND_SOC_DAPM_INPUT("MICIN"),
227	SND_SOC_DAPM_INPUT("MICEXT"),
228	SND_SOC_DAPM_INPUT("AUX"),
229	SND_SOC_DAPM_INPUT("MIN"),
230	SND_SOC_DAPM_INPUT("AIN"),
231	};
232
233	static const struct snd_soc_dapm_route audio_map[] = {
234	/stereo mixer /
235	{"Stereo Mixer", "Playback Switch", "DAC"},
236	{"Stereo Mixer", "Mic Sidetone Switch", "Mic"},
237	{"Stereo Mixer", "Aux Bypass Switch", "AUX In"},
238
239	/* mono1 mixer */
240	{"Mono1 Mixer", "Mic Sidetone Switch", "Mic"},
241	{"Mono1 Mixer", "Mono Playback Switch", "DAC"},
242
243	/* Mic */
244	{"Mic", NULL, "AIN"},
245	{"Input Mux", "Internal", "Mic Int Bias"},
246	{"Input Mux", "External", "Mic Ext Bias"},
247	{"Mic Int Bias", NULL, "MICIN"},
248	{"Mic Ext Bias", NULL, "MICEXT"},
249	{"MICOUT", NULL, "Input Mux"},
250
251	/* line out */
252	{"LOUT", NULL, "Line Out Enable"},
253	{"ROUT", NULL, "Line Out Enable"},
254	{"Line Out Enable", "Switch", "Line Out"},
255	{"Line Out", NULL, "Stereo Mixer"},
256
257	/* mono1 out */
258	{"MOUT1", NULL, "Mono Out"},
259	{"Mono Out", NULL, "Mono1 Mixer"},
260
261	/* left HP */
262	{"HPL", NULL, "Left HP Enable"},
263	{"Left HP Enable", "Switch", "HP L Amp"},
264	{"HP L Amp", NULL, "Stereo Mixer"},
265
266	/* right HP */
267	{"HPR", NULL, "Right HP Enable"},
268	{"Right HP Enable", "Switch", "HP R Amp"},
269	{"HP R Amp", NULL, "Stereo Mixer"},
270
271	/* speaker */
272	{"SPP", NULL, "Speaker Enable"},
273	{"SPN", NULL, "Speaker Enable"},
274	{"Speaker Enable", "Switch", "Spk Amp"},
275	{"Spk Amp", NULL, "MIN"},
276
277	/* mono 2 */
278	{"MOUT2", NULL, "Mono 2 Enable"},
279	{"Mono 2 Enable", "Switch", "Stereo Mixer"},
280
281	/* Aux In */
282	{"Aux In", NULL, "AUX"},
283
284	/* ADC */
285	{"ADC", NULL, "Input Mixer"},
286	{"Input Mixer", "Mic Capture Switch", "Mic"},
287	{"Input Mixer", "Aux Capture Switch", "Aux In"},
288	};
289
290	static int ak4535_add_widgets(struct snd_soc_codec *codec)
291	{
292	snd_soc_dapm_new_controls(codec, ak4535_dapm_widgets,
293	ARRAY_SIZE(ak4535_dapm_widgets));
294
295	snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
296
297	snd_soc_dapm_new_widgets(codec);
298	return 0;
299	}
300
e550e17f	301	static int ak4535_set_dai_sysclk(struct snd_soc_dai *codec_dai,
796d2ca8 RP	302	int clk_id, unsigned int freq, int dir)
	303	{
	304	struct snd_soc_codec *codec = codec_dai->codec;
	305	struct ak4535_priv *ak4535 = codec->private_data;
	306
	307	ak4535->sysclk = freq;
	308	return 0;
	309	}
	310
	311	static int ak4535_hw_params(struct snd_pcm_substream *substream,
dee89c4d MB	312	struct snd_pcm_hw_params *params,
dee89c4d MB	313	struct snd_soc_dai *dai)
796d2ca8 RP	314	{
	315	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	316	struct snd_soc_device *socdev = rtd->socdev;
6627a653	317	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	318	struct ak4535_priv *ak4535 = codec->private_data;
	319	u8 mode2 = ak4535_read_reg_cache(codec, AK4535_MODE2) & ~(0x3 << 5);
	320	int rate = params_rate(params), fs = 256;
	321
	322	if (rate)
	323	fs = ak4535->sysclk / rate;
	324
	325	/* set fs */
	326	switch (fs) {
	327	case 1024:
	328	mode2 \|= (0x2 << 5);
	329	break;
	330	case 512:
	331	mode2 \|= (0x1 << 5);
	332	break;
	333	case 256:
	334	break;
	335	}
	336
	337	/* set rate */
	338	ak4535_write(codec, AK4535_MODE2, mode2);
	339	return 0;
	340	}
	341
e550e17f	342	static int ak4535_set_dai_fmt(struct snd_soc_dai *codec_dai,
796d2ca8 RP	343	unsigned int fmt)
	344	{
	345	struct snd_soc_codec *codec = codec_dai->codec;
	346	u8 mode1 = 0;
	347
	348	/* interface format */
	349	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
	350	case SND_SOC_DAIFMT_I2S:
	351	mode1 = 0x0002;
	352	break;
	353	case SND_SOC_DAIFMT_LEFT_J:
	354	mode1 = 0x0001;
	355	break;
	356	default:
	357	return -EINVAL;
	358	}
	359
	360	/* use 32 fs for BCLK to save power */
	361	mode1 \|= 0x4;
	362
	363	ak4535_write(codec, AK4535_MODE1, mode1);
	364	return 0;
	365	}
	366
e550e17f	367	static int ak4535_mute(struct snd_soc_dai *dai, int mute)
796d2ca8 RP	368	{
	369	struct snd_soc_codec *codec = dai->codec;
	370	u16 mute_reg = ak4535_read_reg_cache(codec, AK4535_DAC) & 0xffdf;
	371	if (!mute)
	372	ak4535_write(codec, AK4535_DAC, mute_reg);
	373	else
	374	ak4535_write(codec, AK4535_DAC, mute_reg \| 0x20);
	375	return 0;
	376	}
	377
	378	static int ak4535_set_bias_level(struct snd_soc_codec *codec,
	379	enum snd_soc_bias_level level)
	380	{
	381	u16 i;
	382
	383	switch (level) {
	384	case SND_SOC_BIAS_ON:
	385	ak4535_mute(codec->dai, 0);
	386	break;
	387	case SND_SOC_BIAS_PREPARE:
	388	ak4535_mute(codec->dai, 1);
	389	break;
	390	case SND_SOC_BIAS_STANDBY:
	391	i = ak4535_read_reg_cache(codec, AK4535_PM1);
	392	ak4535_write(codec, AK4535_PM1, i \| 0x80);
	393	i = ak4535_read_reg_cache(codec, AK4535_PM2);
	394	ak4535_write(codec, AK4535_PM2, i & (~0x80));
	395	break;
	396	case SND_SOC_BIAS_OFF:
	397	i = ak4535_read_reg_cache(codec, AK4535_PM1);
	398	ak4535_write(codec, AK4535_PM1, i & (~0x80));
	399	break;
	400	}
	401	codec->bias_level = level;
	402	return 0;
	403	}
	404
	405	#define AK4535_RATES (SNDRV_PCM_RATE_8000 \| SNDRV_PCM_RATE_11025 \|\
	406	SNDRV_PCM_RATE_16000 \| SNDRV_PCM_RATE_22050 \|\
	407	SNDRV_PCM_RATE_44100 \| SNDRV_PCM_RATE_48000)
	408
6335d055 EM	409	static struct snd_soc_dai_ops ak4535_dai_ops = {
	410	.hw_params = ak4535_hw_params,
	411	.set_fmt = ak4535_set_dai_fmt,
	412	.digital_mute = ak4535_mute,
	413	.set_sysclk = ak4535_set_dai_sysclk,
	414	};
	415
e550e17f	416	struct snd_soc_dai ak4535_dai = {
796d2ca8 RP	417	.name = "AK4535",
	418	.playback = {
	419	.stream_name = "Playback",
	420	.channels_min = 1,
	421	.channels_max = 2,
	422	.rates = AK4535_RATES,
	423	.formats = SNDRV_PCM_FMTBIT_S16_LE,},
	424	.capture = {
	425	.stream_name = "Capture",
	426	.channels_min = 1,
	427	.channels_max = 2,
	428	.rates = AK4535_RATES,
	429	.formats = SNDRV_PCM_FMTBIT_S16_LE,},
6335d055	430	.ops = &ak4535_dai_ops,
796d2ca8 RP	431	};
	432	EXPORT_SYMBOL_GPL(ak4535_dai);
	433
	434	static int ak4535_suspend(struct platform_device *pdev, pm_message_t state)
	435	{
	436	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653	437	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	438
	439	ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);
	440	return 0;
	441	}
	442
	443	static int ak4535_resume(struct platform_device *pdev)
	444	{
	445	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653	446	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	447	ak4535_sync(codec);
	448	ak4535_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
	449	ak4535_set_bias_level(codec, codec->suspend_bias_level);
	450	return 0;
	451	}
	452
	453	/*
	454	* initialise the AK4535 driver
	455	* register the mixer and dsp interfaces with the kernel
	456	*/
	457	static int ak4535_init(struct snd_soc_device *socdev)
	458	{
6627a653	459	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	460	int ret = 0;
	461
	462	codec->name = "AK4535";
	463	codec->owner = THIS_MODULE;
	464	codec->read = ak4535_read_reg_cache;
	465	codec->write = ak4535_write;
	466	codec->set_bias_level = ak4535_set_bias_level;
	467	codec->dai = &ak4535_dai;
	468	codec->num_dai = 1;
	469	codec->reg_cache_size = ARRAY_SIZE(ak4535_reg);
	470	codec->reg_cache = kmemdup(ak4535_reg, sizeof(ak4535_reg), GFP_KERNEL);
	471
	472	if (codec->reg_cache == NULL)
	473	return -ENOMEM;
	474
	475	/* register pcms */
	476	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
	477	if (ret < 0) {
	478	printk(KERN_ERR "ak4535: failed to create pcms\n");
	479	goto pcm_err;
	480	}
	481
	482	/* power on device */
	483	ak4535_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
	484
3e8e1952 IM	485	snd_soc_add_controls(codec, ak4535_snd_controls,
3e8e1952 IM	486	ARRAY_SIZE(ak4535_snd_controls));
796d2ca8	487	ak4535_add_widgets(codec);
968a6025	488	ret = snd_soc_init_card(socdev);
796d2ca8 RP	489	if (ret < 0) {
	490	printk(KERN_ERR "ak4535: failed to register card\n");
	491	goto card_err;
	492	}
	493
	494	return ret;
	495
	496	card_err:
	497	snd_soc_free_pcms(socdev);
	498	snd_soc_dapm_free(socdev);
	499	pcm_err:
	500	kfree(codec->reg_cache);
	501
	502	return ret;
	503	}
	504
	505	static struct snd_soc_device *ak4535_socdev;
	506
	507	#if defined(CONFIG_I2C) \|\| defined(CONFIG_I2C_MODULE)
	508
d28d2713 JD	509	static int ak4535_i2c_probe(struct i2c_client *i2c,
d28d2713 JD	510	const struct i2c_device_id *id)
796d2ca8 RP	511	{
796d2ca8 RP	512	struct snd_soc_device *socdev = ak4535_socdev;
6627a653	513	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	514	int ret;
796d2ca8 RP	515
796d2ca8 RP	516	i2c_set_clientdata(i2c, codec);
	517	codec->control_data = i2c;
	518
796d2ca8	519	ret = ak4535_init(socdev);
d28d2713	520	if (ret < 0)
796d2ca8	521	printk(KERN_ERR "failed to initialise AK4535\n");
796d2ca8	522
796d2ca8 RP	523	return ret;
	524	}
	525
d28d2713	526	static int ak4535_i2c_remove(struct i2c_client *client)
796d2ca8 RP	527	{
796d2ca8 RP	528	struct snd_soc_codec *codec = i2c_get_clientdata(client);
796d2ca8	529	kfree(codec->reg_cache);
796d2ca8 RP	530	return 0;
	531	}
	532
d28d2713 JD	533	static const struct i2c_device_id ak4535_i2c_id[] = {
	534	{ "ak4535", 0 },
	535	{ }
	536	};
	537	MODULE_DEVICE_TABLE(i2c, ak4535_i2c_id);
796d2ca8	538
796d2ca8 RP	539	static struct i2c_driver ak4535_i2c_driver = {
	540	.driver = {
	541	.name = "AK4535 I2C Codec",
	542	.owner = THIS_MODULE,
	543	},
d28d2713 JD	544	.probe = ak4535_i2c_probe,
	545	.remove = ak4535_i2c_remove,
	546	.id_table = ak4535_i2c_id,
796d2ca8 RP	547	};
796d2ca8 RP	548
d28d2713 JD	549	static int ak4535_add_i2c_device(struct platform_device *pdev,
	550	const struct ak4535_setup_data *setup)
	551	{
	552	struct i2c_board_info info;
	553	struct i2c_adapter *adapter;
	554	struct i2c_client *client;
	555	int ret;
	556
	557	ret = i2c_add_driver(&ak4535_i2c_driver);
	558	if (ret != 0) {
	559	dev_err(&pdev->dev, "can't add i2c driver\n");
	560	return ret;
	561	}
	562
	563	memset(&info, 0, sizeof(struct i2c_board_info));
	564	info.addr = setup->i2c_address;
	565	strlcpy(info.type, "ak4535", I2C_NAME_SIZE);
	566
	567	adapter = i2c_get_adapter(setup->i2c_bus);
	568	if (!adapter) {
	569	dev_err(&pdev->dev, "can't get i2c adapter %d\n",
	570	setup->i2c_bus);
	571	goto err_driver;
	572	}
	573
	574	client = i2c_new_device(adapter, &info);
	575	i2c_put_adapter(adapter);
	576	if (!client) {
	577	dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
	578	(unsigned int)info.addr);
	579	goto err_driver;
	580	}
	581
	582	return 0;
	583
	584	err_driver:
	585	i2c_del_driver(&ak4535_i2c_driver);
	586	return -ENODEV;
	587	}
796d2ca8 RP	588	#endif
	589
	590	static int ak4535_probe(struct platform_device *pdev)
	591	{
	592	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
	593	struct ak4535_setup_data *setup;
	594	struct snd_soc_codec *codec;
	595	struct ak4535_priv *ak4535;
b7c9d852	596	int ret;
796d2ca8 RP	597
	598	printk(KERN_INFO "AK4535 Audio Codec %s", AK4535_VERSION);
	599
	600	setup = socdev->codec_data;
	601	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
	602	if (codec == NULL)
	603	return -ENOMEM;
	604
	605	ak4535 = kzalloc(sizeof(struct ak4535_priv), GFP_KERNEL);
	606	if (ak4535 == NULL) {
	607	kfree(codec);
	608	return -ENOMEM;
	609	}
	610
	611	codec->private_data = ak4535;
6627a653	612	socdev->card->codec = codec;
796d2ca8 RP	613	mutex_init(&codec->mutex);
	614	INIT_LIST_HEAD(&codec->dapm_widgets);
	615	INIT_LIST_HEAD(&codec->dapm_paths);
	616
	617	ak4535_socdev = socdev;
b7c9d852 MB	618	ret = -ENODEV;
b7c9d852 MB	619
796d2ca8 RP	620	#if defined(CONFIG_I2C) \|\| defined(CONFIG_I2C_MODULE)
796d2ca8 RP	621	if (setup->i2c_address) {
796d2ca8	622	codec->hw_write = (hw_write_t)i2c_master_send;
d28d2713	623	ret = ak4535_add_i2c_device(pdev, setup);
796d2ca8	624	}
796d2ca8	625	#endif
3051e41a JD	626
	627	if (ret != 0) {
	628	kfree(codec->private_data);
	629	kfree(codec);
	630	}
796d2ca8 RP	631	return ret;
	632	}
	633
	634	/* power down chip */
	635	static int ak4535_remove(struct platform_device *pdev)
	636	{
	637	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653	638	struct snd_soc_codec *codec = socdev->card->codec;
796d2ca8 RP	639
	640	if (codec->control_data)
	641	ak4535_set_bias_level(codec, SND_SOC_BIAS_OFF);
	642
	643	snd_soc_free_pcms(socdev);
	644	snd_soc_dapm_free(socdev);
	645	#if defined(CONFIG_I2C) \|\| defined(CONFIG_I2C_MODULE)
09318c47 DC	646	if (codec->control_data)
09318c47 DC	647	i2c_unregister_device(codec->control_data);
796d2ca8 RP	648	i2c_del_driver(&ak4535_i2c_driver);
	649	#endif
	650	kfree(codec->private_data);
	651	kfree(codec);
	652
	653	return 0;
	654	}
	655
	656	struct snd_soc_codec_device soc_codec_dev_ak4535 = {
	657	.probe = ak4535_probe,
	658	.remove = ak4535_remove,
	659	.suspend = ak4535_suspend,
	660	.resume = ak4535_resume,
	661	};
	662	EXPORT_SYMBOL_GPL(soc_codec_dev_ak4535);
	663
c9b3a40f	664	static int __init ak4535_modinit(void)
64089b84 MB	665	{
	666	return snd_soc_register_dai(&ak4535_dai);
	667	}
	668	module_init(ak4535_modinit);
	669
	670	static void __exit ak4535_exit(void)
	671	{
	672	snd_soc_unregister_dai(&ak4535_dai);
	673	}
	674	module_exit(ak4535_exit);
	675
796d2ca8 RP	676	MODULE_DESCRIPTION("Soc AK4535 driver");
	677	MODULE_AUTHOR("Richard Purdie");
	678	MODULE_LICENSE("GPL");