| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright (C) 2009-2010, Lars-Peter Clausen <lars@metafoo.de> | 
 | 3 |  * | 
 | 4 |  * This program is free software; you can redistribute it and/or modify | 
 | 5 |  * it under the terms of the GNU General Public License version 2 as | 
 | 6 |  * published by the Free Software Foundation. | 
 | 7 |  * | 
 | 8 |  *  You should have received a copy of the  GNU General Public License along | 
 | 9 |  *  with this program; if not, write  to the Free Software Foundation, Inc., | 
 | 10 |  *  675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 11 |  * | 
 | 12 |  */ | 
 | 13 |  | 
 | 14 | #include <linux/kernel.h> | 
 | 15 | #include <linux/module.h> | 
 | 16 | #include <linux/platform_device.h> | 
 | 17 | #include <linux/slab.h> | 
 | 18 |  | 
 | 19 | #include <linux/delay.h> | 
 | 20 |  | 
 | 21 | #include <sound/core.h> | 
 | 22 | #include <sound/pcm.h> | 
 | 23 | #include <sound/pcm_params.h> | 
 | 24 | #include <sound/initval.h> | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 25 | #include <sound/soc.h> | 
 | 26 |  | 
 | 27 | #define JZ4740_REG_CODEC_1 0x0 | 
 | 28 | #define JZ4740_REG_CODEC_2 0x1 | 
 | 29 |  | 
 | 30 | #define JZ4740_CODEC_1_LINE_ENABLE BIT(29) | 
 | 31 | #define JZ4740_CODEC_1_MIC_ENABLE BIT(28) | 
 | 32 | #define JZ4740_CODEC_1_SW1_ENABLE BIT(27) | 
 | 33 | #define JZ4740_CODEC_1_ADC_ENABLE BIT(26) | 
 | 34 | #define JZ4740_CODEC_1_SW2_ENABLE BIT(25) | 
 | 35 | #define JZ4740_CODEC_1_DAC_ENABLE BIT(24) | 
 | 36 | #define JZ4740_CODEC_1_VREF_DISABLE BIT(20) | 
 | 37 | #define JZ4740_CODEC_1_VREF_AMP_DISABLE BIT(19) | 
 | 38 | #define JZ4740_CODEC_1_VREF_PULLDOWN BIT(18) | 
 | 39 | #define JZ4740_CODEC_1_VREF_LOW_CURRENT BIT(17) | 
 | 40 | #define JZ4740_CODEC_1_VREF_HIGH_CURRENT BIT(16) | 
 | 41 | #define JZ4740_CODEC_1_HEADPHONE_DISABLE BIT(14) | 
 | 42 | #define JZ4740_CODEC_1_HEADPHONE_AMP_CHANGE_ANY BIT(13) | 
 | 43 | #define JZ4740_CODEC_1_HEADPHONE_CHARGE BIT(12) | 
 | 44 | #define JZ4740_CODEC_1_HEADPHONE_PULLDOWN (BIT(11) | BIT(10)) | 
 | 45 | #define JZ4740_CODEC_1_HEADPHONE_POWERDOWN_M BIT(9) | 
 | 46 | #define JZ4740_CODEC_1_HEADPHONE_POWERDOWN BIT(8) | 
 | 47 | #define JZ4740_CODEC_1_SUSPEND BIT(1) | 
 | 48 | #define JZ4740_CODEC_1_RESET BIT(0) | 
 | 49 |  | 
 | 50 | #define JZ4740_CODEC_1_LINE_ENABLE_OFFSET 29 | 
 | 51 | #define JZ4740_CODEC_1_MIC_ENABLE_OFFSET 28 | 
 | 52 | #define JZ4740_CODEC_1_SW1_ENABLE_OFFSET 27 | 
 | 53 | #define JZ4740_CODEC_1_ADC_ENABLE_OFFSET 26 | 
 | 54 | #define JZ4740_CODEC_1_SW2_ENABLE_OFFSET 25 | 
 | 55 | #define JZ4740_CODEC_1_DAC_ENABLE_OFFSET 24 | 
 | 56 | #define JZ4740_CODEC_1_HEADPHONE_DISABLE_OFFSET 14 | 
 | 57 | #define JZ4740_CODEC_1_HEADPHONE_POWERDOWN_OFFSET 8 | 
 | 58 |  | 
 | 59 | #define JZ4740_CODEC_2_INPUT_VOLUME_MASK		0x1f0000 | 
 | 60 | #define JZ4740_CODEC_2_SAMPLE_RATE_MASK			0x000f00 | 
 | 61 | #define JZ4740_CODEC_2_MIC_BOOST_GAIN_MASK		0x000030 | 
 | 62 | #define JZ4740_CODEC_2_HEADPHONE_VOLUME_MASK	0x000003 | 
 | 63 |  | 
 | 64 | #define JZ4740_CODEC_2_INPUT_VOLUME_OFFSET		16 | 
 | 65 | #define JZ4740_CODEC_2_SAMPLE_RATE_OFFSET		 8 | 
 | 66 | #define JZ4740_CODEC_2_MIC_BOOST_GAIN_OFFSET	 4 | 
 | 67 | #define JZ4740_CODEC_2_HEADPHONE_VOLUME_OFFSET	 0 | 
 | 68 |  | 
 | 69 | static const uint32_t jz4740_codec_regs[] = { | 
 | 70 | 	0x021b2302, 0x00170803, | 
 | 71 | }; | 
 | 72 |  | 
 | 73 | struct jz4740_codec { | 
 | 74 | 	void __iomem *base; | 
 | 75 | 	struct resource *mem; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 76 | }; | 
 | 77 |  | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 78 | static unsigned int jz4740_codec_read(struct snd_soc_codec *codec, | 
 | 79 | 	unsigned int reg) | 
 | 80 | { | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 81 | 	struct jz4740_codec *jz4740_codec = snd_soc_codec_get_drvdata(codec); | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 82 | 	return readl(jz4740_codec->base + (reg << 2)); | 
 | 83 | } | 
 | 84 |  | 
 | 85 | static int jz4740_codec_write(struct snd_soc_codec *codec, unsigned int reg, | 
 | 86 | 	unsigned int val) | 
 | 87 | { | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 88 | 	struct jz4740_codec *jz4740_codec = snd_soc_codec_get_drvdata(codec); | 
 | 89 | 	u32 *cache = codec->reg_cache; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 90 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 91 | 	cache[reg] = val; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 92 | 	writel(val, jz4740_codec->base + (reg << 2)); | 
 | 93 |  | 
 | 94 | 	return 0; | 
 | 95 | } | 
 | 96 |  | 
 | 97 | static const struct snd_kcontrol_new jz4740_codec_controls[] = { | 
 | 98 | 	SOC_SINGLE("Master Playback Volume", JZ4740_REG_CODEC_2, | 
 | 99 | 			JZ4740_CODEC_2_HEADPHONE_VOLUME_OFFSET, 3, 0), | 
 | 100 | 	SOC_SINGLE("Master Capture Volume", JZ4740_REG_CODEC_2, | 
 | 101 | 			JZ4740_CODEC_2_INPUT_VOLUME_OFFSET, 31, 0), | 
 | 102 | 	SOC_SINGLE("Master Playback Switch", JZ4740_REG_CODEC_1, | 
 | 103 | 			JZ4740_CODEC_1_HEADPHONE_DISABLE_OFFSET, 1, 1), | 
 | 104 | 	SOC_SINGLE("Mic Capture Volume", JZ4740_REG_CODEC_2, | 
 | 105 | 			JZ4740_CODEC_2_MIC_BOOST_GAIN_OFFSET, 3, 0), | 
 | 106 | }; | 
 | 107 |  | 
 | 108 | static const struct snd_kcontrol_new jz4740_codec_output_controls[] = { | 
 | 109 | 	SOC_DAPM_SINGLE("Bypass Switch", JZ4740_REG_CODEC_1, | 
 | 110 | 			JZ4740_CODEC_1_SW1_ENABLE_OFFSET, 1, 0), | 
 | 111 | 	SOC_DAPM_SINGLE("DAC Switch", JZ4740_REG_CODEC_1, | 
 | 112 | 			JZ4740_CODEC_1_SW2_ENABLE_OFFSET, 1, 0), | 
 | 113 | }; | 
 | 114 |  | 
 | 115 | static const struct snd_kcontrol_new jz4740_codec_input_controls[] = { | 
 | 116 | 	SOC_DAPM_SINGLE("Line Capture Switch", JZ4740_REG_CODEC_1, | 
 | 117 | 			JZ4740_CODEC_1_LINE_ENABLE_OFFSET, 1, 0), | 
 | 118 | 	SOC_DAPM_SINGLE("Mic Capture Switch", JZ4740_REG_CODEC_1, | 
 | 119 | 			JZ4740_CODEC_1_MIC_ENABLE_OFFSET, 1, 0), | 
 | 120 | }; | 
 | 121 |  | 
 | 122 | static const struct snd_soc_dapm_widget jz4740_codec_dapm_widgets[] = { | 
 | 123 | 	SND_SOC_DAPM_ADC("ADC", "Capture", JZ4740_REG_CODEC_1, | 
 | 124 | 			JZ4740_CODEC_1_ADC_ENABLE_OFFSET, 0), | 
 | 125 | 	SND_SOC_DAPM_DAC("DAC", "Playback", JZ4740_REG_CODEC_1, | 
 | 126 | 			JZ4740_CODEC_1_DAC_ENABLE_OFFSET, 0), | 
 | 127 |  | 
 | 128 | 	SND_SOC_DAPM_MIXER("Output Mixer", JZ4740_REG_CODEC_1, | 
 | 129 | 			JZ4740_CODEC_1_HEADPHONE_POWERDOWN_OFFSET, 1, | 
 | 130 | 			jz4740_codec_output_controls, | 
 | 131 | 			ARRAY_SIZE(jz4740_codec_output_controls)), | 
 | 132 |  | 
 | 133 | 	SND_SOC_DAPM_MIXER_NAMED_CTL("Input Mixer", SND_SOC_NOPM, 0, 0, | 
 | 134 | 			jz4740_codec_input_controls, | 
 | 135 | 			ARRAY_SIZE(jz4740_codec_input_controls)), | 
 | 136 | 	SND_SOC_DAPM_MIXER("Line Input", SND_SOC_NOPM, 0, 0, NULL, 0), | 
 | 137 |  | 
 | 138 | 	SND_SOC_DAPM_OUTPUT("LOUT"), | 
 | 139 | 	SND_SOC_DAPM_OUTPUT("ROUT"), | 
 | 140 |  | 
 | 141 | 	SND_SOC_DAPM_INPUT("MIC"), | 
 | 142 | 	SND_SOC_DAPM_INPUT("LIN"), | 
 | 143 | 	SND_SOC_DAPM_INPUT("RIN"), | 
 | 144 | }; | 
 | 145 |  | 
 | 146 | static const struct snd_soc_dapm_route jz4740_codec_dapm_routes[] = { | 
 | 147 | 	{"Line Input", NULL, "LIN"}, | 
 | 148 | 	{"Line Input", NULL, "RIN"}, | 
 | 149 |  | 
 | 150 | 	{"Input Mixer", "Line Capture Switch", "Line Input"}, | 
 | 151 | 	{"Input Mixer", "Mic Capture Switch", "MIC"}, | 
 | 152 |  | 
 | 153 | 	{"ADC", NULL, "Input Mixer"}, | 
 | 154 |  | 
 | 155 | 	{"Output Mixer", "Bypass Switch", "Input Mixer"}, | 
 | 156 | 	{"Output Mixer", "DAC Switch", "DAC"}, | 
 | 157 |  | 
 | 158 | 	{"LOUT", NULL, "Output Mixer"}, | 
 | 159 | 	{"ROUT", NULL, "Output Mixer"}, | 
 | 160 | }; | 
 | 161 |  | 
 | 162 | static int jz4740_codec_hw_params(struct snd_pcm_substream *substream, | 
 | 163 | 	struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) | 
 | 164 | { | 
 | 165 | 	uint32_t val; | 
 | 166 | 	struct snd_soc_pcm_runtime *rtd = substream->private_data; | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 167 | 	struct snd_soc_codec *codec =rtd->codec; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 168 |  | 
 | 169 | 	switch (params_rate(params)) { | 
 | 170 | 	case 8000: | 
 | 171 | 		val = 0; | 
 | 172 | 		break; | 
 | 173 | 	case 11025: | 
 | 174 | 		val = 1; | 
 | 175 | 		break; | 
 | 176 | 	case 12000: | 
 | 177 | 		val = 2; | 
 | 178 | 		break; | 
 | 179 | 	case 16000: | 
 | 180 | 		val = 3; | 
 | 181 | 		break; | 
 | 182 | 	case 22050: | 
 | 183 | 		val = 4; | 
 | 184 | 		break; | 
 | 185 | 	case 24000: | 
 | 186 | 		val = 5; | 
 | 187 | 		break; | 
 | 188 | 	case 32000: | 
 | 189 | 		val = 6; | 
 | 190 | 		break; | 
 | 191 | 	case 44100: | 
 | 192 | 		val = 7; | 
 | 193 | 		break; | 
 | 194 | 	case 48000: | 
 | 195 | 		val = 8; | 
 | 196 | 		break; | 
 | 197 | 	default: | 
 | 198 | 		return -EINVAL; | 
 | 199 | 	} | 
 | 200 |  | 
 | 201 | 	val <<= JZ4740_CODEC_2_SAMPLE_RATE_OFFSET; | 
 | 202 |  | 
 | 203 | 	snd_soc_update_bits(codec, JZ4740_REG_CODEC_2, | 
 | 204 | 				JZ4740_CODEC_2_SAMPLE_RATE_MASK, val); | 
 | 205 |  | 
 | 206 | 	return 0; | 
 | 207 | } | 
 | 208 |  | 
 | 209 | static struct snd_soc_dai_ops jz4740_codec_dai_ops = { | 
 | 210 | 	.hw_params = jz4740_codec_hw_params, | 
 | 211 | }; | 
 | 212 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 213 | static struct snd_soc_dai_driver jz4740_codec_dai = { | 
 | 214 | 	.name = "jz4740-hifi", | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 215 | 	.playback = { | 
 | 216 | 		.stream_name = "Playback", | 
 | 217 | 		.channels_min = 2, | 
 | 218 | 		.channels_max = 2, | 
 | 219 | 		.rates = SNDRV_PCM_RATE_8000_48000, | 
 | 220 | 		.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S8, | 
 | 221 | 	}, | 
 | 222 | 	.capture = { | 
 | 223 | 		.stream_name = "Capture", | 
 | 224 | 		.channels_min = 2, | 
 | 225 | 		.channels_max = 2, | 
 | 226 | 		.rates = SNDRV_PCM_RATE_8000_48000, | 
 | 227 | 		.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S8, | 
 | 228 | 	}, | 
 | 229 | 	.ops = &jz4740_codec_dai_ops, | 
 | 230 | 	.symmetric_rates = 1, | 
 | 231 | }; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 232 |  | 
 | 233 | static void jz4740_codec_wakeup(struct snd_soc_codec *codec) | 
 | 234 | { | 
 | 235 | 	int i; | 
 | 236 | 	uint32_t *cache = codec->reg_cache; | 
 | 237 |  | 
 | 238 | 	snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, | 
 | 239 | 		JZ4740_CODEC_1_RESET, JZ4740_CODEC_1_RESET); | 
 | 240 | 	udelay(2); | 
 | 241 |  | 
 | 242 | 	snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, | 
 | 243 | 		JZ4740_CODEC_1_SUSPEND | JZ4740_CODEC_1_RESET, 0); | 
 | 244 |  | 
 | 245 | 	for (i = 0; i < ARRAY_SIZE(jz4740_codec_regs); ++i) | 
 | 246 | 		jz4740_codec_write(codec, i, cache[i]); | 
 | 247 | } | 
 | 248 |  | 
 | 249 | static int jz4740_codec_set_bias_level(struct snd_soc_codec *codec, | 
 | 250 | 	enum snd_soc_bias_level level) | 
 | 251 | { | 
 | 252 | 	unsigned int mask; | 
 | 253 | 	unsigned int value; | 
 | 254 |  | 
 | 255 | 	switch (level) { | 
 | 256 | 	case SND_SOC_BIAS_ON: | 
 | 257 | 		break; | 
 | 258 | 	case SND_SOC_BIAS_PREPARE: | 
 | 259 | 		mask = JZ4740_CODEC_1_VREF_DISABLE | | 
 | 260 | 				JZ4740_CODEC_1_VREF_AMP_DISABLE | | 
 | 261 | 				JZ4740_CODEC_1_HEADPHONE_POWERDOWN_M; | 
 | 262 | 		value = 0; | 
 | 263 |  | 
 | 264 | 		snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, mask, value); | 
 | 265 | 		break; | 
 | 266 | 	case SND_SOC_BIAS_STANDBY: | 
 | 267 | 		/* The only way to clear the suspend flag is to reset the codec */ | 
| Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 268 | 		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 269 | 			jz4740_codec_wakeup(codec); | 
 | 270 |  | 
 | 271 | 		mask = JZ4740_CODEC_1_VREF_DISABLE | | 
 | 272 | 			JZ4740_CODEC_1_VREF_AMP_DISABLE | | 
 | 273 | 			JZ4740_CODEC_1_HEADPHONE_POWERDOWN_M; | 
 | 274 | 		value = JZ4740_CODEC_1_VREF_DISABLE | | 
 | 275 | 			JZ4740_CODEC_1_VREF_AMP_DISABLE | | 
 | 276 | 			JZ4740_CODEC_1_HEADPHONE_POWERDOWN_M; | 
 | 277 |  | 
 | 278 | 		snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, mask, value); | 
 | 279 | 		break; | 
 | 280 | 	case SND_SOC_BIAS_OFF: | 
 | 281 | 		mask = JZ4740_CODEC_1_SUSPEND; | 
 | 282 | 		value = JZ4740_CODEC_1_SUSPEND; | 
 | 283 |  | 
 | 284 | 		snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, mask, value); | 
 | 285 | 		break; | 
 | 286 | 	default: | 
 | 287 | 		break; | 
 | 288 | 	} | 
 | 289 |  | 
| Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 290 | 	codec->dapm.bias_level = level; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 291 |  | 
 | 292 | 	return 0; | 
 | 293 | } | 
 | 294 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 295 | static int jz4740_codec_dev_probe(struct snd_soc_codec *codec) | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 296 | { | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 297 | 	snd_soc_update_bits(codec, JZ4740_REG_CODEC_1, | 
 | 298 | 			JZ4740_CODEC_1_SW2_ENABLE, JZ4740_CODEC_1_SW2_ENABLE); | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 299 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 300 | 	jz4740_codec_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | 
 | 301 |  | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 302 | 	return 0; | 
 | 303 | } | 
 | 304 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 305 | static int jz4740_codec_dev_remove(struct snd_soc_codec *codec) | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 306 | { | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 307 | 	jz4740_codec_set_bias_level(codec, SND_SOC_BIAS_OFF); | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 308 |  | 
 | 309 | 	return 0; | 
 | 310 | } | 
 | 311 |  | 
 | 312 | #ifdef CONFIG_PM_SLEEP | 
 | 313 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 314 | static int jz4740_codec_suspend(struct snd_soc_codec *codec, pm_message_t state) | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 315 | { | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 316 | 	return jz4740_codec_set_bias_level(codec, SND_SOC_BIAS_OFF); | 
 | 317 | } | 
 | 318 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 319 | static int jz4740_codec_resume(struct snd_soc_codec *codec) | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 320 | { | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 321 | 	return jz4740_codec_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | 
 | 322 | } | 
 | 323 |  | 
 | 324 | #else | 
 | 325 | #define jz4740_codec_suspend NULL | 
 | 326 | #define jz4740_codec_resume NULL | 
 | 327 | #endif | 
 | 328 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 329 | static struct snd_soc_codec_driver soc_codec_dev_jz4740_codec = { | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 330 | 	.probe = jz4740_codec_dev_probe, | 
 | 331 | 	.remove = jz4740_codec_dev_remove, | 
 | 332 | 	.suspend = jz4740_codec_suspend, | 
 | 333 | 	.resume = jz4740_codec_resume, | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 334 | 	.read = jz4740_codec_read, | 
 | 335 | 	.write = jz4740_codec_write, | 
 | 336 | 	.set_bias_level = jz4740_codec_set_bias_level, | 
 | 337 | 	.reg_cache_default	= jz4740_codec_regs, | 
 | 338 | 	.reg_word_size = sizeof(u32), | 
 | 339 | 	.reg_cache_size	= 2, | 
| Lars-Peter Clausen | 6744791 | 2011-04-12 19:33:29 +0200 | [diff] [blame] | 340 |  | 
 | 341 | 	.controls = jz4740_codec_controls, | 
 | 342 | 	.num_controls = ARRAY_SIZE(jz4740_codec_controls), | 
 | 343 | 	.dapm_widgets = jz4740_codec_dapm_widgets, | 
 | 344 | 	.num_dapm_widgets = ARRAY_SIZE(jz4740_codec_dapm_widgets), | 
 | 345 | 	.dapm_routes = jz4740_codec_dapm_routes, | 
 | 346 | 	.num_dapm_routes = ARRAY_SIZE(jz4740_codec_dapm_routes), | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 347 | }; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 348 |  | 
 | 349 | static int __devinit jz4740_codec_probe(struct platform_device *pdev) | 
 | 350 | { | 
 | 351 | 	int ret; | 
 | 352 | 	struct jz4740_codec *jz4740_codec; | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 353 | 	struct resource *mem; | 
 | 354 |  | 
 | 355 | 	jz4740_codec = kzalloc(sizeof(*jz4740_codec), GFP_KERNEL); | 
 | 356 | 	if (!jz4740_codec) | 
 | 357 | 		return -ENOMEM; | 
 | 358 |  | 
 | 359 | 	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
 | 360 | 	if (!mem) { | 
 | 361 | 		dev_err(&pdev->dev, "Failed to get mmio memory resource\n"); | 
 | 362 | 		ret = -ENOENT; | 
 | 363 | 		goto err_free_codec; | 
 | 364 | 	} | 
 | 365 |  | 
 | 366 | 	mem = request_mem_region(mem->start, resource_size(mem), pdev->name); | 
 | 367 | 	if (!mem) { | 
 | 368 | 		dev_err(&pdev->dev, "Failed to request mmio memory region\n"); | 
 | 369 | 		ret = -EBUSY; | 
 | 370 | 		goto err_free_codec; | 
 | 371 | 	} | 
 | 372 |  | 
 | 373 | 	jz4740_codec->base = ioremap(mem->start, resource_size(mem)); | 
 | 374 | 	if (!jz4740_codec->base) { | 
 | 375 | 		dev_err(&pdev->dev, "Failed to ioremap mmio memory\n"); | 
 | 376 | 		ret = -EBUSY; | 
 | 377 | 		goto err_release_mem_region; | 
 | 378 | 	} | 
 | 379 | 	jz4740_codec->mem = mem; | 
 | 380 |  | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 381 | 	platform_set_drvdata(pdev, jz4740_codec); | 
 | 382 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 383 | 	ret = snd_soc_register_codec(&pdev->dev, | 
 | 384 | 			&soc_codec_dev_jz4740_codec, &jz4740_codec_dai, 1); | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 385 | 	if (ret) { | 
 | 386 | 		dev_err(&pdev->dev, "Failed to register codec\n"); | 
 | 387 | 		goto err_iounmap; | 
 | 388 | 	} | 
 | 389 |  | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 390 | 	return 0; | 
 | 391 |  | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 392 | err_iounmap: | 
 | 393 | 	iounmap(jz4740_codec->base); | 
 | 394 | err_release_mem_region: | 
 | 395 | 	release_mem_region(mem->start, resource_size(mem)); | 
 | 396 | err_free_codec: | 
 | 397 | 	kfree(jz4740_codec); | 
 | 398 |  | 
 | 399 | 	return ret; | 
 | 400 | } | 
 | 401 |  | 
 | 402 | static int __devexit jz4740_codec_remove(struct platform_device *pdev) | 
 | 403 | { | 
 | 404 | 	struct jz4740_codec *jz4740_codec = platform_get_drvdata(pdev); | 
 | 405 | 	struct resource *mem = jz4740_codec->mem; | 
 | 406 |  | 
| Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 407 | 	snd_soc_unregister_codec(&pdev->dev); | 
| Lars-Peter Clausen | 3b097d6 | 2010-06-22 00:46:31 +0200 | [diff] [blame] | 408 |  | 
 | 409 | 	iounmap(jz4740_codec->base); | 
 | 410 | 	release_mem_region(mem->start, resource_size(mem)); | 
 | 411 |  | 
 | 412 | 	platform_set_drvdata(pdev, NULL); | 
 | 413 | 	kfree(jz4740_codec); | 
 | 414 |  | 
 | 415 | 	return 0; | 
 | 416 | } | 
 | 417 |  | 
 | 418 | static struct platform_driver jz4740_codec_driver = { | 
 | 419 | 	.probe = jz4740_codec_probe, | 
 | 420 | 	.remove = __devexit_p(jz4740_codec_remove), | 
 | 421 | 	.driver = { | 
 | 422 | 		.name = "jz4740-codec", | 
 | 423 | 		.owner = THIS_MODULE, | 
 | 424 | 	}, | 
 | 425 | }; | 
 | 426 |  | 
 | 427 | static int __init jz4740_codec_init(void) | 
 | 428 | { | 
 | 429 | 	return platform_driver_register(&jz4740_codec_driver); | 
 | 430 | } | 
 | 431 | module_init(jz4740_codec_init); | 
 | 432 |  | 
 | 433 | static void __exit jz4740_codec_exit(void) | 
 | 434 | { | 
 | 435 | 	platform_driver_unregister(&jz4740_codec_driver); | 
 | 436 | } | 
 | 437 | module_exit(jz4740_codec_exit); | 
 | 438 |  | 
 | 439 | MODULE_DESCRIPTION("JZ4740 SoC internal codec driver"); | 
 | 440 | MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); | 
 | 441 | MODULE_LICENSE("GPL v2"); | 
 | 442 | MODULE_ALIAS("platform:jz4740-codec"); |