blob: 36ef91fe05116438d6a59b9da9bb38abe0bf5fd7 [file] [log] [blame]
Ian Lartey992bee42010-07-31 00:32:11 +01001/*
2 * wm8741.c -- WM8741 ALSA SoC Audio driver
3 *
Mark Brown656baae2012-05-23 12:39:07 +01004 * Copyright 2010-1 Wolfson Microelectronics plc
Ian Lartey992bee42010-07-31 00:32:11 +01005 *
6 * Author: Ian Lartey <ian@opensource.wolfsonmicro.com>
7 *
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
12 */
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/init.h>
17#include <linux/delay.h>
18#include <linux/pm.h>
19#include <linux/i2c.h>
Mark Brown39e9b8d2011-08-03 17:30:57 +090020#include <linux/spi/spi.h>
Mark Brownfe98c0c2012-09-10 18:00:21 +080021#include <linux/regmap.h>
Ian Lartey992bee42010-07-31 00:32:11 +010022#include <linux/regulator/consumer.h>
23#include <linux/slab.h>
Mark Brown80080ec2011-08-03 17:31:26 +090024#include <linux/of_device.h>
Ian Lartey992bee42010-07-31 00:32:11 +010025#include <sound/core.h>
26#include <sound/pcm.h>
27#include <sound/pcm_params.h>
28#include <sound/soc.h>
Ian Lartey992bee42010-07-31 00:32:11 +010029#include <sound/initval.h>
30#include <sound/tlv.h>
31
32#include "wm8741.h"
33
Ian Lartey992bee42010-07-31 00:32:11 +010034#define WM8741_NUM_SUPPLIES 2
35static const char *wm8741_supply_names[WM8741_NUM_SUPPLIES] = {
36 "AVDD",
37 "DVDD",
38};
39
Ian Lartey3fe4a5e2010-08-27 15:26:27 +010040#define WM8741_NUM_RATES 6
Ian Lartey992bee42010-07-31 00:32:11 +010041
42/* codec private data */
43struct wm8741_priv {
Sergej Sawazkic354b542015-05-13 11:39:01 +020044 struct wm8741_platform_data pdata;
Mark Brownfe98c0c2012-09-10 18:00:21 +080045 struct regmap *regmap;
Ian Lartey992bee42010-07-31 00:32:11 +010046 struct regulator_bulk_data supplies[WM8741_NUM_SUPPLIES];
47 unsigned int sysclk;
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +010048 const struct snd_pcm_hw_constraint_list *sysclk_constraints;
Ian Lartey992bee42010-07-31 00:32:11 +010049};
50
Mark Brownfe98c0c2012-09-10 18:00:21 +080051static const struct reg_default wm8741_reg_defaults[] = {
52 { 0, 0x0000 }, /* R0 - DACLLSB Attenuation */
53 { 1, 0x0000 }, /* R1 - DACLMSB Attenuation */
54 { 2, 0x0000 }, /* R2 - DACRLSB Attenuation */
55 { 3, 0x0000 }, /* R3 - DACRMSB Attenuation */
56 { 4, 0x0000 }, /* R4 - Volume Control */
57 { 5, 0x000A }, /* R5 - Format Control */
58 { 6, 0x0000 }, /* R6 - Filter Control */
59 { 7, 0x0000 }, /* R7 - Mode Control 1 */
60 { 8, 0x0002 }, /* R8 - Mode Control 2 */
61 { 32, 0x0002 }, /* R32 - ADDITONAL_CONTROL_1 */
Ian Lartey992bee42010-07-31 00:32:11 +010062};
63
Ian Lartey992bee42010-07-31 00:32:11 +010064static int wm8741_reset(struct snd_soc_codec *codec)
65{
66 return snd_soc_write(codec, WM8741_RESET, 0);
67}
68
69static const DECLARE_TLV_DB_SCALE(dac_tlv_fine, -12700, 13, 0);
70static const DECLARE_TLV_DB_SCALE(dac_tlv, -12700, 400, 0);
71
Sergej Sawazkic354b542015-05-13 11:39:01 +020072static const struct snd_kcontrol_new wm8741_snd_controls_stereo[] = {
Ian Lartey992bee42010-07-31 00:32:11 +010073SOC_DOUBLE_R_TLV("Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
74 WM8741_DACRLSB_ATTENUATION, 1, 255, 1, dac_tlv_fine),
75SOC_DOUBLE_R_TLV("Playback Volume", WM8741_DACLMSB_ATTENUATION,
76 WM8741_DACRMSB_ATTENUATION, 0, 511, 1, dac_tlv),
77};
78
Sergej Sawazkic354b542015-05-13 11:39:01 +020079static const struct snd_kcontrol_new wm8741_snd_controls_mono_left[] = {
80SOC_SINGLE_TLV("Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
81 1, 255, 1, dac_tlv_fine),
82SOC_SINGLE_TLV("Playback Volume", WM8741_DACLMSB_ATTENUATION,
83 0, 511, 1, dac_tlv),
84};
85
86static const struct snd_kcontrol_new wm8741_snd_controls_mono_right[] = {
87SOC_SINGLE_TLV("Fine Playback Volume", WM8741_DACRLSB_ATTENUATION,
88 1, 255, 1, dac_tlv_fine),
89SOC_SINGLE_TLV("Playback Volume", WM8741_DACRMSB_ATTENUATION,
90 0, 511, 1, dac_tlv),
91};
92
Ian Lartey992bee42010-07-31 00:32:11 +010093static const struct snd_soc_dapm_widget wm8741_dapm_widgets[] = {
94SND_SOC_DAPM_DAC("DACL", "Playback", SND_SOC_NOPM, 0, 0),
95SND_SOC_DAPM_DAC("DACR", "Playback", SND_SOC_NOPM, 0, 0),
96SND_SOC_DAPM_OUTPUT("VOUTLP"),
97SND_SOC_DAPM_OUTPUT("VOUTLN"),
98SND_SOC_DAPM_OUTPUT("VOUTRP"),
99SND_SOC_DAPM_OUTPUT("VOUTRN"),
100};
101
Mark Brown0e627802011-12-03 17:15:06 +0000102static const struct snd_soc_dapm_route wm8741_dapm_routes[] = {
Ian Lartey992bee42010-07-31 00:32:11 +0100103 { "VOUTLP", NULL, "DACL" },
104 { "VOUTLN", NULL, "DACL" },
105 { "VOUTRP", NULL, "DACR" },
106 { "VOUTRN", NULL, "DACR" },
107};
108
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100109static const unsigned int rates_11289[] = {
Sergej Sawazki87870412015-03-24 21:13:22 +0100110 44100, 88200,
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100111};
112
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100113static const struct snd_pcm_hw_constraint_list constraints_11289 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100114 .count = ARRAY_SIZE(rates_11289),
115 .list = rates_11289,
116};
117
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100118static const unsigned int rates_12288[] = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100119 32000, 48000, 96000,
120};
121
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100122static const struct snd_pcm_hw_constraint_list constraints_12288 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100123 .count = ARRAY_SIZE(rates_12288),
124 .list = rates_12288,
125};
126
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100127static const unsigned int rates_16384[] = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100128 32000,
129};
130
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100131static const struct snd_pcm_hw_constraint_list constraints_16384 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100132 .count = ARRAY_SIZE(rates_16384),
133 .list = rates_16384,
134};
135
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100136static const unsigned int rates_16934[] = {
Sergej Sawazki87870412015-03-24 21:13:22 +0100137 44100, 88200,
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100138};
139
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100140static const struct snd_pcm_hw_constraint_list constraints_16934 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100141 .count = ARRAY_SIZE(rates_16934),
142 .list = rates_16934,
143};
144
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100145static const unsigned int rates_18432[] = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100146 48000, 96000,
147};
148
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100149static const struct snd_pcm_hw_constraint_list constraints_18432 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100150 .count = ARRAY_SIZE(rates_18432),
151 .list = rates_18432,
152};
153
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100154static const unsigned int rates_22579[] = {
Sergej Sawazki87870412015-03-24 21:13:22 +0100155 44100, 88200, 176400
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100156};
157
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100158static const struct snd_pcm_hw_constraint_list constraints_22579 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100159 .count = ARRAY_SIZE(rates_22579),
160 .list = rates_22579,
161};
162
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100163static const unsigned int rates_24576[] = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100164 32000, 48000, 96000, 192000
165};
166
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100167static const struct snd_pcm_hw_constraint_list constraints_24576 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100168 .count = ARRAY_SIZE(rates_24576),
169 .list = rates_24576,
170};
171
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100172static const unsigned int rates_36864[] = {
Sergej Sawazki87870412015-03-24 21:13:22 +0100173 48000, 96000, 192000
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100174};
175
Lars-Peter Clausen70bad2c2014-02-05 21:54:35 +0100176static const struct snd_pcm_hw_constraint_list constraints_36864 = {
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100177 .count = ARRAY_SIZE(rates_36864),
178 .list = rates_36864,
Ian Lartey992bee42010-07-31 00:32:11 +0100179};
180
Ian Lartey992bee42010-07-31 00:32:11 +0100181static int wm8741_startup(struct snd_pcm_substream *substream,
182 struct snd_soc_dai *dai)
183{
184 struct snd_soc_codec *codec = dai->codec;
185 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
186
Sergej Sawazkie369bd02015-06-06 11:25:48 +0200187 if (wm8741->sysclk)
188 snd_pcm_hw_constraint_list(substream->runtime, 0,
189 SNDRV_PCM_HW_PARAM_RATE,
190 wm8741->sysclk_constraints);
Ian Lartey992bee42010-07-31 00:32:11 +0100191
192 return 0;
193}
194
195static int wm8741_hw_params(struct snd_pcm_substream *substream,
196 struct snd_pcm_hw_params *params,
197 struct snd_soc_dai *dai)
198{
Mark Browne6968a12012-04-04 15:58:16 +0100199 struct snd_soc_codec *codec = dai->codec;
Ian Lartey992bee42010-07-31 00:32:11 +0100200 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
201 u16 iface = snd_soc_read(codec, WM8741_FORMAT_CONTROL) & 0x1FC;
202 int i;
203
Sergej Sawazkie369bd02015-06-06 11:25:48 +0200204 /* The set of sample rates that can be supported depends on the
205 * MCLK supplied to the CODEC - enforce this.
206 */
207 if (!wm8741->sysclk) {
208 dev_err(codec->dev,
209 "No MCLK configured, call set_sysclk() on init or in hw_params\n");
210 return -EINVAL;
211 }
212
213 /* Find a supported LRCLK rate */
214 for (i = 0; i < wm8741->sysclk_constraints->count; i++) {
215 if (wm8741->sysclk_constraints->list[i] == params_rate(params))
Ian Lartey992bee42010-07-31 00:32:11 +0100216 break;
217 }
218
Sergej Sawazkie369bd02015-06-06 11:25:48 +0200219 if (i == wm8741->sysclk_constraints->count) {
220 dev_err(codec->dev, "LRCLK %d unsupported with MCLK %d\n",
221 params_rate(params), wm8741->sysclk);
Ian Lartey992bee42010-07-31 00:32:11 +0100222 return -EINVAL;
223 }
224
225 /* bit size */
Mark Brown34967ad2014-07-31 12:51:45 +0100226 switch (params_width(params)) {
227 case 16:
Ian Lartey992bee42010-07-31 00:32:11 +0100228 break;
Mark Brown34967ad2014-07-31 12:51:45 +0100229 case 20:
Ian Lartey992bee42010-07-31 00:32:11 +0100230 iface |= 0x0001;
231 break;
Mark Brown34967ad2014-07-31 12:51:45 +0100232 case 24:
Ian Lartey992bee42010-07-31 00:32:11 +0100233 iface |= 0x0002;
234 break;
Mark Brown34967ad2014-07-31 12:51:45 +0100235 case 32:
Ian Lartey992bee42010-07-31 00:32:11 +0100236 iface |= 0x0003;
237 break;
238 default:
239 dev_dbg(codec->dev, "wm8741_hw_params: Unsupported bit size param = %d",
Mark Brown34967ad2014-07-31 12:51:45 +0100240 params_width(params));
Ian Lartey992bee42010-07-31 00:32:11 +0100241 return -EINVAL;
242 }
243
Sergej Sawazkie369bd02015-06-06 11:25:48 +0200244 dev_dbg(codec->dev, "wm8741_hw_params: bit size param = %d, rate param = %d",
245 params_width(params), params_rate(params));
Ian Lartey992bee42010-07-31 00:32:11 +0100246
247 snd_soc_write(codec, WM8741_FORMAT_CONTROL, iface);
248 return 0;
249}
250
251static int wm8741_set_dai_sysclk(struct snd_soc_dai *codec_dai,
252 int clk_id, unsigned int freq, int dir)
253{
254 struct snd_soc_codec *codec = codec_dai->codec;
255 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
Ian Lartey992bee42010-07-31 00:32:11 +0100256
257 dev_dbg(codec->dev, "wm8741_set_dai_sysclk info: freq=%dHz\n", freq);
258
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100259 switch (freq) {
Sergej Sawazkie369bd02015-06-06 11:25:48 +0200260 case 0:
261 wm8741->sysclk_constraints = NULL;
Axel Lin6f55a042015-07-30 10:24:03 +0800262 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100263 case 11289600:
264 wm8741->sysclk_constraints = &constraints_11289;
Axel Lin6f55a042015-07-30 10:24:03 +0800265 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100266 case 12288000:
267 wm8741->sysclk_constraints = &constraints_12288;
Axel Lin6f55a042015-07-30 10:24:03 +0800268 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100269 case 16384000:
270 wm8741->sysclk_constraints = &constraints_16384;
Axel Lin6f55a042015-07-30 10:24:03 +0800271 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100272 case 16934400:
273 wm8741->sysclk_constraints = &constraints_16934;
Axel Lin6f55a042015-07-30 10:24:03 +0800274 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100275 case 18432000:
276 wm8741->sysclk_constraints = &constraints_18432;
Axel Lin6f55a042015-07-30 10:24:03 +0800277 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100278 case 22579200:
279 case 33868800:
280 wm8741->sysclk_constraints = &constraints_22579;
Axel Lin6f55a042015-07-30 10:24:03 +0800281 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100282 case 24576000:
283 wm8741->sysclk_constraints = &constraints_24576;
Axel Lin6f55a042015-07-30 10:24:03 +0800284 break;
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100285 case 36864000:
286 wm8741->sysclk_constraints = &constraints_36864;
Axel Lin6f55a042015-07-30 10:24:03 +0800287 break;
288 default:
289 return -EINVAL;
Ian Lartey992bee42010-07-31 00:32:11 +0100290 }
Axel Lin6f55a042015-07-30 10:24:03 +0800291
292 wm8741->sysclk = freq;
293 return 0;
Ian Lartey992bee42010-07-31 00:32:11 +0100294}
295
296static int wm8741_set_dai_fmt(struct snd_soc_dai *codec_dai,
297 unsigned int fmt)
298{
299 struct snd_soc_codec *codec = codec_dai->codec;
300 u16 iface = snd_soc_read(codec, WM8741_FORMAT_CONTROL) & 0x1C3;
301
302 /* check master/slave audio interface */
303 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
304 case SND_SOC_DAIFMT_CBS_CFS:
305 break;
306 default:
307 return -EINVAL;
308 }
309
310 /* interface format */
311 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
312 case SND_SOC_DAIFMT_I2S:
313 iface |= 0x0008;
314 break;
315 case SND_SOC_DAIFMT_RIGHT_J:
316 break;
317 case SND_SOC_DAIFMT_LEFT_J:
318 iface |= 0x0004;
319 break;
320 case SND_SOC_DAIFMT_DSP_A:
Axel Lin3a340102011-10-17 20:14:56 +0800321 iface |= 0x000C;
Ian Lartey992bee42010-07-31 00:32:11 +0100322 break;
323 case SND_SOC_DAIFMT_DSP_B:
Axel Lin3a340102011-10-17 20:14:56 +0800324 iface |= 0x001C;
Ian Lartey992bee42010-07-31 00:32:11 +0100325 break;
326 default:
327 return -EINVAL;
328 }
329
330 /* clock inversion */
331 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
332 case SND_SOC_DAIFMT_NB_NF:
333 break;
334 case SND_SOC_DAIFMT_IB_IF:
335 iface |= 0x0010;
336 break;
337 case SND_SOC_DAIFMT_IB_NF:
338 iface |= 0x0020;
339 break;
340 case SND_SOC_DAIFMT_NB_IF:
341 iface |= 0x0030;
342 break;
343 default:
344 return -EINVAL;
345 }
346
347
348 dev_dbg(codec->dev, "wm8741_set_dai_fmt: Format=%x, Clock Inv=%x\n",
349 fmt & SND_SOC_DAIFMT_FORMAT_MASK,
350 ((fmt & SND_SOC_DAIFMT_INV_MASK)));
351
352 snd_soc_write(codec, WM8741_FORMAT_CONTROL, iface);
353 return 0;
354}
355
356#define WM8741_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | \
357 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | \
358 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 | \
359 SNDRV_PCM_RATE_192000)
360
361#define WM8741_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
362 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
363
Lars-Peter Clausen85e76522011-11-23 11:40:40 +0100364static const struct snd_soc_dai_ops wm8741_dai_ops = {
Ian Lartey992bee42010-07-31 00:32:11 +0100365 .startup = wm8741_startup,
366 .hw_params = wm8741_hw_params,
367 .set_sysclk = wm8741_set_dai_sysclk,
368 .set_fmt = wm8741_set_dai_fmt,
369};
370
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000371static struct snd_soc_dai_driver wm8741_dai = {
Ian Lartey30e2d362010-08-20 17:18:44 +0100372 .name = "wm8741",
Ian Lartey992bee42010-07-31 00:32:11 +0100373 .playback = {
374 .stream_name = "Playback",
Sergej Sawazkic354b542015-05-13 11:39:01 +0200375 .channels_min = 2,
Ian Lartey992bee42010-07-31 00:32:11 +0100376 .channels_max = 2,
377 .rates = WM8741_RATES,
378 .formats = WM8741_FORMATS,
379 },
380 .ops = &wm8741_dai_ops,
381};
Ian Lartey992bee42010-07-31 00:32:11 +0100382
383#ifdef CONFIG_PM
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000384static int wm8741_resume(struct snd_soc_codec *codec)
Ian Lartey992bee42010-07-31 00:32:11 +0100385{
Axel Lindf3431b2011-10-17 20:16:37 +0800386 snd_soc_cache_sync(codec);
Ian Lartey992bee42010-07-31 00:32:11 +0100387 return 0;
388}
389#else
Ian Lartey992bee42010-07-31 00:32:11 +0100390#define wm8741_resume NULL
391#endif
392
Sergej Sawazkic354b542015-05-13 11:39:01 +0200393static int wm8741_configure(struct snd_soc_codec *codec)
394{
395 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
396
397 /* Configure differential mode */
398 switch (wm8741->pdata.diff_mode) {
399 case WM8741_DIFF_MODE_STEREO:
400 case WM8741_DIFF_MODE_STEREO_REVERSED:
401 case WM8741_DIFF_MODE_MONO_LEFT:
402 case WM8741_DIFF_MODE_MONO_RIGHT:
403 snd_soc_update_bits(codec, WM8741_MODE_CONTROL_2,
404 WM8741_DIFF_MASK,
405 wm8741->pdata.diff_mode << WM8741_DIFF_SHIFT);
406 break;
407 default:
408 return -EINVAL;
409 }
410
411 /* Change some default settings - latch VU */
412 snd_soc_update_bits(codec, WM8741_DACLLSB_ATTENUATION,
413 WM8741_UPDATELL, WM8741_UPDATELL);
414 snd_soc_update_bits(codec, WM8741_DACLMSB_ATTENUATION,
415 WM8741_UPDATELM, WM8741_UPDATELM);
416 snd_soc_update_bits(codec, WM8741_DACRLSB_ATTENUATION,
417 WM8741_UPDATERL, WM8741_UPDATERL);
418 snd_soc_update_bits(codec, WM8741_DACRMSB_ATTENUATION,
419 WM8741_UPDATERM, WM8741_UPDATERM);
420
421 return 0;
422}
423
424static int wm8741_add_controls(struct snd_soc_codec *codec)
425{
426 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
427
428 switch (wm8741->pdata.diff_mode) {
429 case WM8741_DIFF_MODE_STEREO:
430 case WM8741_DIFF_MODE_STEREO_REVERSED:
431 snd_soc_add_codec_controls(codec,
432 wm8741_snd_controls_stereo,
433 ARRAY_SIZE(wm8741_snd_controls_stereo));
434 break;
435 case WM8741_DIFF_MODE_MONO_LEFT:
436 snd_soc_add_codec_controls(codec,
437 wm8741_snd_controls_mono_left,
438 ARRAY_SIZE(wm8741_snd_controls_mono_left));
439 break;
440 case WM8741_DIFF_MODE_MONO_RIGHT:
441 snd_soc_add_codec_controls(codec,
442 wm8741_snd_controls_mono_right,
443 ARRAY_SIZE(wm8741_snd_controls_mono_right));
444 break;
445 default:
446 return -EINVAL;
447 }
448
449 return 0;
450}
451
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000452static int wm8741_probe(struct snd_soc_codec *codec)
Ian Lartey992bee42010-07-31 00:32:11 +0100453{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000454 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
Ian Lartey992bee42010-07-31 00:32:11 +0100455 int ret = 0;
Mark Brown398575d2011-08-03 17:16:11 +0900456
457 ret = regulator_bulk_enable(ARRAY_SIZE(wm8741->supplies),
458 wm8741->supplies);
459 if (ret != 0) {
460 dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
461 goto err_get;
462 }
Ian Lartey992bee42010-07-31 00:32:11 +0100463
Ian Lartey992bee42010-07-31 00:32:11 +0100464 ret = wm8741_reset(codec);
465 if (ret < 0) {
466 dev_err(codec->dev, "Failed to issue reset\n");
Mark Brown398575d2011-08-03 17:16:11 +0900467 goto err_enable;
Ian Lartey992bee42010-07-31 00:32:11 +0100468 }
469
Sergej Sawazkic354b542015-05-13 11:39:01 +0200470 ret = wm8741_configure(codec);
471 if (ret < 0) {
472 dev_err(codec->dev, "Failed to change default settings\n");
473 goto err_enable;
474 }
475
476 ret = wm8741_add_controls(codec);
477 if (ret < 0) {
478 dev_err(codec->dev, "Failed to add controls\n");
479 goto err_enable;
480 }
Ian Lartey992bee42010-07-31 00:32:11 +0100481
Ian Lartey992bee42010-07-31 00:32:11 +0100482 dev_dbg(codec->dev, "Successful registration\n");
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000483 return ret;
Mark Brown398575d2011-08-03 17:16:11 +0900484
485err_enable:
486 regulator_bulk_disable(ARRAY_SIZE(wm8741->supplies), wm8741->supplies);
487err_get:
Mark Brown398575d2011-08-03 17:16:11 +0900488 return ret;
489}
490
491static int wm8741_remove(struct snd_soc_codec *codec)
492{
493 struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
494
495 regulator_bulk_disable(ARRAY_SIZE(wm8741->supplies), wm8741->supplies);
Mark Brown398575d2011-08-03 17:16:11 +0900496
497 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000498}
499
500static struct snd_soc_codec_driver soc_codec_dev_wm8741 = {
501 .probe = wm8741_probe,
Mark Brown398575d2011-08-03 17:16:11 +0900502 .remove = wm8741_remove,
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000503 .resume = wm8741_resume,
Mark Brown0e627802011-12-03 17:15:06 +0000504
Mark Brown0e627802011-12-03 17:15:06 +0000505 .dapm_widgets = wm8741_dapm_widgets,
506 .num_dapm_widgets = ARRAY_SIZE(wm8741_dapm_widgets),
507 .dapm_routes = wm8741_dapm_routes,
508 .num_dapm_routes = ARRAY_SIZE(wm8741_dapm_routes),
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000509};
510
Mark Brown80080ec2011-08-03 17:31:26 +0900511static const struct of_device_id wm8741_of_match[] = {
512 { .compatible = "wlf,wm8741", },
513 { }
514};
515MODULE_DEVICE_TABLE(of, wm8741_of_match);
516
Mark Brownfe98c0c2012-09-10 18:00:21 +0800517static const struct regmap_config wm8741_regmap = {
518 .reg_bits = 7,
519 .val_bits = 9,
520 .max_register = WM8741_MAX_REGISTER,
521
522 .reg_defaults = wm8741_reg_defaults,
523 .num_reg_defaults = ARRAY_SIZE(wm8741_reg_defaults),
524 .cache_type = REGCACHE_RBTREE,
Mark Brownfe98c0c2012-09-10 18:00:21 +0800525};
526
Sergej Sawazkic354b542015-05-13 11:39:01 +0200527static int wm8741_set_pdata(struct device *dev, struct wm8741_priv *wm8741)
528{
529 const struct wm8741_platform_data *pdata = dev_get_platdata(dev);
530 u32 diff_mode;
531
532 if (dev->of_node) {
533 if (of_property_read_u32(dev->of_node, "diff-mode", &diff_mode)
534 >= 0)
535 wm8741->pdata.diff_mode = diff_mode;
536 } else {
537 if (pdata != NULL)
538 memcpy(&wm8741->pdata, pdata, sizeof(wm8741->pdata));
539 }
540
541 return 0;
542}
543
Fabio Estevam26090a82013-11-21 12:38:45 -0200544#if IS_ENABLED(CONFIG_I2C)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000545static int wm8741_i2c_probe(struct i2c_client *i2c,
546 const struct i2c_device_id *id)
547{
548 struct wm8741_priv *wm8741;
Mark Brownd9780552012-09-10 17:52:59 +0800549 int ret, i;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000550
Mark Brown5aefb302011-12-03 17:17:05 +0000551 wm8741 = devm_kzalloc(&i2c->dev, sizeof(struct wm8741_priv),
552 GFP_KERNEL);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000553 if (wm8741 == NULL)
554 return -ENOMEM;
555
Mark Brownd9780552012-09-10 17:52:59 +0800556 for (i = 0; i < ARRAY_SIZE(wm8741->supplies); i++)
557 wm8741->supplies[i].supply = wm8741_supply_names[i];
558
559 ret = devm_regulator_bulk_get(&i2c->dev, ARRAY_SIZE(wm8741->supplies),
560 wm8741->supplies);
561 if (ret != 0) {
Mark Brownfe98c0c2012-09-10 18:00:21 +0800562 dev_err(&i2c->dev, "Failed to request supplies: %d\n", ret);
563 return ret;
564 }
565
Tushar Beherafd64c452012-11-22 09:38:37 +0530566 wm8741->regmap = devm_regmap_init_i2c(i2c, &wm8741_regmap);
Mark Brownfe98c0c2012-09-10 18:00:21 +0800567 if (IS_ERR(wm8741->regmap)) {
568 ret = PTR_ERR(wm8741->regmap);
569 dev_err(&i2c->dev, "Failed to init regmap: %d\n", ret);
570 return ret;
Mark Brownd9780552012-09-10 17:52:59 +0800571 }
572
Dan Carpenter2d52d172015-05-20 10:40:35 +0300573 ret = wm8741_set_pdata(&i2c->dev, wm8741);
Sergej Sawazkic354b542015-05-13 11:39:01 +0200574 if (ret != 0) {
575 dev_err(&i2c->dev, "Failed to set pdata: %d\n", ret);
576 return ret;
577 }
578
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000579 i2c_set_clientdata(i2c, wm8741);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000580
Mark Brown398575d2011-08-03 17:16:11 +0900581 ret = snd_soc_register_codec(&i2c->dev,
582 &soc_codec_dev_wm8741, &wm8741_dai, 1);
Mark Brown398575d2011-08-03 17:16:11 +0900583
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000584 return ret;
Ian Lartey992bee42010-07-31 00:32:11 +0100585}
586
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000587static int wm8741_i2c_remove(struct i2c_client *client)
Ian Lartey992bee42010-07-31 00:32:11 +0100588{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000589 snd_soc_unregister_codec(&client->dev);
Ian Lartey992bee42010-07-31 00:32:11 +0100590 return 0;
591}
592
593static const struct i2c_device_id wm8741_i2c_id[] = {
594 { "wm8741", 0 },
595 { }
596};
597MODULE_DEVICE_TABLE(i2c, wm8741_i2c_id);
598
Ian Lartey992bee42010-07-31 00:32:11 +0100599static struct i2c_driver wm8741_i2c_driver = {
600 .driver = {
Mark Brown0473e612011-08-03 16:52:10 +0900601 .name = "wm8741",
Mark Brown80080ec2011-08-03 17:31:26 +0900602 .of_match_table = wm8741_of_match,
Ian Lartey992bee42010-07-31 00:32:11 +0100603 },
604 .probe = wm8741_i2c_probe,
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000605 .remove = wm8741_i2c_remove,
Ian Lartey992bee42010-07-31 00:32:11 +0100606 .id_table = wm8741_i2c_id,
607};
608#endif
609
Mark Brown39e9b8d2011-08-03 17:30:57 +0900610#if defined(CONFIG_SPI_MASTER)
Bill Pemberton7a79e942012-12-07 09:26:37 -0500611static int wm8741_spi_probe(struct spi_device *spi)
Mark Brown39e9b8d2011-08-03 17:30:57 +0900612{
613 struct wm8741_priv *wm8741;
Mark Brownd9780552012-09-10 17:52:59 +0800614 int ret, i;
Mark Brown39e9b8d2011-08-03 17:30:57 +0900615
Mark Brown5aefb302011-12-03 17:17:05 +0000616 wm8741 = devm_kzalloc(&spi->dev, sizeof(struct wm8741_priv),
617 GFP_KERNEL);
Mark Brown39e9b8d2011-08-03 17:30:57 +0900618 if (wm8741 == NULL)
619 return -ENOMEM;
620
Mark Brownd9780552012-09-10 17:52:59 +0800621 for (i = 0; i < ARRAY_SIZE(wm8741->supplies); i++)
622 wm8741->supplies[i].supply = wm8741_supply_names[i];
623
Mark Brownfe98c0c2012-09-10 18:00:21 +0800624 ret = devm_regulator_bulk_get(&spi->dev, ARRAY_SIZE(wm8741->supplies),
Mark Brownd9780552012-09-10 17:52:59 +0800625 wm8741->supplies);
626 if (ret != 0) {
627 dev_err(&spi->dev, "Failed to request supplies: %d\n", ret);
Mark Brownfe98c0c2012-09-10 18:00:21 +0800628 return ret;
Mark Brownd9780552012-09-10 17:52:59 +0800629 }
630
Tushar Beherafd64c452012-11-22 09:38:37 +0530631 wm8741->regmap = devm_regmap_init_spi(spi, &wm8741_regmap);
Mark Brownfe98c0c2012-09-10 18:00:21 +0800632 if (IS_ERR(wm8741->regmap)) {
633 ret = PTR_ERR(wm8741->regmap);
634 dev_err(&spi->dev, "Failed to init regmap: %d\n", ret);
635 return ret;
636 }
637
Dan Carpenter2d52d172015-05-20 10:40:35 +0300638 ret = wm8741_set_pdata(&spi->dev, wm8741);
Sergej Sawazkic354b542015-05-13 11:39:01 +0200639 if (ret != 0) {
640 dev_err(&spi->dev, "Failed to set pdata: %d\n", ret);
641 return ret;
642 }
643
Mark Brown39e9b8d2011-08-03 17:30:57 +0900644 spi_set_drvdata(spi, wm8741);
645
646 ret = snd_soc_register_codec(&spi->dev,
647 &soc_codec_dev_wm8741, &wm8741_dai, 1);
Mark Brown39e9b8d2011-08-03 17:30:57 +0900648 return ret;
649}
650
Bill Pemberton7a79e942012-12-07 09:26:37 -0500651static int wm8741_spi_remove(struct spi_device *spi)
Mark Brown39e9b8d2011-08-03 17:30:57 +0900652{
653 snd_soc_unregister_codec(&spi->dev);
Mark Brown39e9b8d2011-08-03 17:30:57 +0900654 return 0;
655}
656
657static struct spi_driver wm8741_spi_driver = {
658 .driver = {
659 .name = "wm8741",
Mark Brown80080ec2011-08-03 17:31:26 +0900660 .of_match_table = wm8741_of_match,
Mark Brown39e9b8d2011-08-03 17:30:57 +0900661 },
662 .probe = wm8741_spi_probe,
Bill Pemberton7a79e942012-12-07 09:26:37 -0500663 .remove = wm8741_spi_remove,
Mark Brown39e9b8d2011-08-03 17:30:57 +0900664};
665#endif /* CONFIG_SPI_MASTER */
666
Ian Lartey992bee42010-07-31 00:32:11 +0100667static int __init wm8741_modinit(void)
668{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000669 int ret = 0;
670
Fabio Estevam26090a82013-11-21 12:38:45 -0200671#if IS_ENABLED(CONFIG_I2C)
Ian Lartey992bee42010-07-31 00:32:11 +0100672 ret = i2c_add_driver(&wm8741_i2c_driver);
Ian Lartey3fe4a5e2010-08-27 15:26:27 +0100673 if (ret != 0)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000674 pr_err("Failed to register WM8741 I2C driver: %d\n", ret);
Ian Lartey992bee42010-07-31 00:32:11 +0100675#endif
Mark Brown39e9b8d2011-08-03 17:30:57 +0900676#if defined(CONFIG_SPI_MASTER)
677 ret = spi_register_driver(&wm8741_spi_driver);
678 if (ret != 0) {
679 printk(KERN_ERR "Failed to register wm8741 SPI driver: %d\n",
680 ret);
681 }
682#endif
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000683
684 return ret;
Ian Lartey992bee42010-07-31 00:32:11 +0100685}
686module_init(wm8741_modinit);
687
688static void __exit wm8741_exit(void)
689{
Mark Brown39e9b8d2011-08-03 17:30:57 +0900690#if defined(CONFIG_SPI_MASTER)
691 spi_unregister_driver(&wm8741_spi_driver);
692#endif
Fabio Estevam26090a82013-11-21 12:38:45 -0200693#if IS_ENABLED(CONFIG_I2C)
Ian Lartey992bee42010-07-31 00:32:11 +0100694 i2c_del_driver(&wm8741_i2c_driver);
695#endif
696}
697module_exit(wm8741_exit);
698
699MODULE_DESCRIPTION("ASoC WM8741 driver");
700MODULE_AUTHOR("Ian Lartey <ian@opensource.wolfsonmicro.com>");
701MODULE_LICENSE("GPL");