Linux Audio

Check our new training course

In-person Linux kernel drivers training

Jun 16-20, 2025
Register
Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * ALSA SoC WM9090 driver
  4 *
  5 * Copyright 2009-12 Wolfson Microelectronics
  6 *
  7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  8 */
  9
 10#include <linux/module.h>
 11#include <linux/errno.h>
 12#include <linux/device.h>
 13#include <linux/i2c.h>
 14#include <linux/delay.h>
 15#include <linux/regmap.h>
 16#include <linux/slab.h>
 17#include <sound/initval.h>
 18#include <sound/soc.h>
 19#include <sound/tlv.h>
 20#include <sound/wm9090.h>
 21
 22#include "wm9090.h"
 23
 24static const struct reg_default wm9090_reg_defaults[] = {
 25	{ 1,  0x0006 },     /* R1   - Power Management (1) */
 26	{ 2,  0x6000 },     /* R2   - Power Management (2) */
 27	{ 3,  0x0000 },     /* R3   - Power Management (3) */
 28	{ 6,  0x01C0 },     /* R6   - Clocking 1 */
 29	{ 22, 0x0003 },     /* R22  - IN1 Line Control */
 30	{ 23, 0x0003 },     /* R23  - IN2 Line Control */
 31	{ 24, 0x0083 },     /* R24  - IN1 Line Input A Volume */
 32	{ 25, 0x0083 },     /* R25  - IN1  Line Input B Volume */
 33	{ 26, 0x0083 },     /* R26  - IN2 Line Input A Volume */
 34	{ 27, 0x0083 },     /* R27  - IN2 Line Input B Volume */
 35	{ 28, 0x002D },     /* R28  - Left Output Volume */
 36	{ 29, 0x002D },     /* R29  - Right Output Volume */
 37	{ 34, 0x0100 },     /* R34  - SPKMIXL Attenuation */
 38	{ 35, 0x0010 },     /* R36  - SPKOUT Mixers */
 39	{ 37, 0x0140 },     /* R37  - ClassD3 */
 40	{ 38, 0x0039 },     /* R38  - Speaker Volume Left */
 41	{ 45, 0x0000 },     /* R45  - Output Mixer1 */
 42	{ 46, 0x0000 },     /* R46  - Output Mixer2 */
 43	{ 47, 0x0100 },     /* R47  - Output Mixer3 */
 44	{ 48, 0x0100 },     /* R48  - Output Mixer4 */
 45	{ 54, 0x0000 },     /* R54  - Speaker Mixer */
 46	{ 57, 0x000D },     /* R57  - AntiPOP2 */
 47	{ 70, 0x0000 },     /* R70  - Write Sequencer 0 */
 48	{ 71, 0x0000 },     /* R71  - Write Sequencer 1 */
 49	{ 72, 0x0000 },     /* R72  - Write Sequencer 2 */
 50	{ 73, 0x0000 },     /* R73  - Write Sequencer 3 */
 51	{ 74, 0x0000 },     /* R74  - Write Sequencer 4 */
 52	{ 75, 0x0000 },     /* R75  - Write Sequencer 5 */
 53	{ 76, 0x1F25 },     /* R76  - Charge Pump 1 */
 54	{ 85, 0x054A },     /* R85  - DC Servo 1 */
 55	{ 87, 0x0000 },     /* R87  - DC Servo 3 */
 56	{ 96, 0x0100 },     /* R96  - Analogue HP 0 */
 57	{ 98, 0x8640 },     /* R98  - AGC Control 0 */
 58	{ 99, 0xC000 },     /* R99  - AGC Control 1 */
 59	{ 100, 0x0200 },     /* R100 - AGC Control 2 */
 60};
 61
 62/* This struct is used to save the context */
 63struct wm9090_priv {
 64	struct wm9090_platform_data pdata;
 65	struct regmap *regmap;
 66};
 67
 68static bool wm9090_volatile(struct device *dev, unsigned int reg)
 69{
 70	switch (reg) {
 71	case WM9090_SOFTWARE_RESET:
 72	case WM9090_DC_SERVO_0:
 73	case WM9090_DC_SERVO_READBACK_0:
 74	case WM9090_DC_SERVO_READBACK_1:
 75	case WM9090_DC_SERVO_READBACK_2:
 76		return true;
 77
 78	default:
 79		return false;
 80	}
 81}
 82
 83static bool wm9090_readable(struct device *dev, unsigned int reg)
 84{
 85	switch (reg) {
 86	case WM9090_SOFTWARE_RESET:
 87	case WM9090_POWER_MANAGEMENT_1:
 88	case WM9090_POWER_MANAGEMENT_2:
 89	case WM9090_POWER_MANAGEMENT_3:
 90	case WM9090_CLOCKING_1:
 91	case WM9090_IN1_LINE_CONTROL:
 92	case WM9090_IN2_LINE_CONTROL:
 93	case WM9090_IN1_LINE_INPUT_A_VOLUME:
 94	case WM9090_IN1_LINE_INPUT_B_VOLUME:
 95	case WM9090_IN2_LINE_INPUT_A_VOLUME:
 96	case WM9090_IN2_LINE_INPUT_B_VOLUME:
 97	case WM9090_LEFT_OUTPUT_VOLUME:
 98	case WM9090_RIGHT_OUTPUT_VOLUME:
 99	case WM9090_SPKMIXL_ATTENUATION:
100	case WM9090_SPKOUT_MIXERS:
101	case WM9090_CLASSD3:
102	case WM9090_SPEAKER_VOLUME_LEFT:
103	case WM9090_OUTPUT_MIXER1:
104	case WM9090_OUTPUT_MIXER2:
105	case WM9090_OUTPUT_MIXER3:
106	case WM9090_OUTPUT_MIXER4:
107	case WM9090_SPEAKER_MIXER:
108	case WM9090_ANTIPOP2:
109	case WM9090_WRITE_SEQUENCER_0:
110	case WM9090_WRITE_SEQUENCER_1:
111	case WM9090_WRITE_SEQUENCER_2:
112	case WM9090_WRITE_SEQUENCER_3:
113	case WM9090_WRITE_SEQUENCER_4:
114	case WM9090_WRITE_SEQUENCER_5:
115	case WM9090_CHARGE_PUMP_1:
116	case WM9090_DC_SERVO_0:
117	case WM9090_DC_SERVO_1:
118	case WM9090_DC_SERVO_3:
119	case WM9090_DC_SERVO_READBACK_0:
120	case WM9090_DC_SERVO_READBACK_1:
121	case WM9090_DC_SERVO_READBACK_2:
122	case WM9090_ANALOGUE_HP_0:
123	case WM9090_AGC_CONTROL_0:
124	case WM9090_AGC_CONTROL_1:
125	case WM9090_AGC_CONTROL_2:
126		return true;
127
128	default:
129		return false;
130	}
131}
132
133static void wait_for_dc_servo(struct snd_soc_component *component)
134{
135	unsigned int reg;
136	int count = 0;
137
138	dev_dbg(component->dev, "Waiting for DC servo...\n");
139	do {
140		count++;
141		msleep(1);
142		reg = snd_soc_component_read(component, WM9090_DC_SERVO_READBACK_0);
143		dev_dbg(component->dev, "DC servo status: %x\n", reg);
144	} while ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
145		 != WM9090_DCS_CAL_COMPLETE_MASK && count < 1000);
146
147	if ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
148	    != WM9090_DCS_CAL_COMPLETE_MASK)
149		dev_err(component->dev, "Timed out waiting for DC Servo\n");
150}
151
152static const DECLARE_TLV_DB_RANGE(in_tlv,
 
153	0, 0, TLV_DB_SCALE_ITEM(-600, 0, 0),
154	1, 3, TLV_DB_SCALE_ITEM(-350, 350, 0),
155	4, 6, TLV_DB_SCALE_ITEM(600, 600, 0)
156);
157static const DECLARE_TLV_DB_RANGE(mix_tlv,
 
158	0, 2, TLV_DB_SCALE_ITEM(-1200, 300, 0),
159	3, 3, TLV_DB_SCALE_ITEM(0, 0, 0)
160);
161static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
162static const DECLARE_TLV_DB_RANGE(spkboost_tlv,
 
163	0, 6, TLV_DB_SCALE_ITEM(0, 150, 0),
164	7, 7, TLV_DB_SCALE_ITEM(1200, 0, 0)
165);
166
167static const struct snd_kcontrol_new wm9090_controls[] = {
168SOC_SINGLE_TLV("IN1A Volume", WM9090_IN1_LINE_INPUT_A_VOLUME, 0, 6, 0,
169	       in_tlv),
170SOC_SINGLE("IN1A Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 7, 1, 1),
171SOC_SINGLE("IN1A ZC Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 6, 1, 0),
172
173SOC_SINGLE_TLV("IN2A Volume", WM9090_IN2_LINE_INPUT_A_VOLUME, 0, 6, 0,
174	       in_tlv),
175SOC_SINGLE("IN2A Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 7, 1, 1),
176SOC_SINGLE("IN2A ZC Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 6, 1, 0),
177
178SOC_SINGLE("MIXOUTL Switch", WM9090_OUTPUT_MIXER3, 8, 1, 1),
179SOC_SINGLE_TLV("MIXOUTL IN1A Volume", WM9090_OUTPUT_MIXER3, 6, 3, 1,
180	       mix_tlv),
181SOC_SINGLE_TLV("MIXOUTL IN2A Volume", WM9090_OUTPUT_MIXER3, 2, 3, 1,
182	       mix_tlv),
183
184SOC_SINGLE("MIXOUTR Switch", WM9090_OUTPUT_MIXER4, 8, 1, 1),
185SOC_SINGLE_TLV("MIXOUTR IN1A Volume", WM9090_OUTPUT_MIXER4, 6, 3, 1,
186	       mix_tlv),
187SOC_SINGLE_TLV("MIXOUTR IN2A Volume", WM9090_OUTPUT_MIXER4, 2, 3, 1,
188	       mix_tlv),
189
190SOC_SINGLE("SPKMIX Switch", WM9090_SPKMIXL_ATTENUATION, 8, 1, 1),
191SOC_SINGLE_TLV("SPKMIX IN1A Volume", WM9090_SPKMIXL_ATTENUATION, 6, 3, 1,
192	       mix_tlv),
193SOC_SINGLE_TLV("SPKMIX IN2A Volume", WM9090_SPKMIXL_ATTENUATION, 2, 3, 1,
194	       mix_tlv),
195
196SOC_DOUBLE_R_TLV("Headphone Volume", WM9090_LEFT_OUTPUT_VOLUME,
197		 WM9090_RIGHT_OUTPUT_VOLUME, 0, 63, 0, out_tlv),
198SOC_DOUBLE_R("Headphone Switch", WM9090_LEFT_OUTPUT_VOLUME,
199	     WM9090_RIGHT_OUTPUT_VOLUME, 6, 1, 1),
200SOC_DOUBLE_R("Headphone ZC Switch", WM9090_LEFT_OUTPUT_VOLUME,
201	     WM9090_RIGHT_OUTPUT_VOLUME, 7, 1, 0),
202
203SOC_SINGLE_TLV("Speaker Volume", WM9090_SPEAKER_VOLUME_LEFT, 0, 63, 0,
204	       out_tlv),
205SOC_SINGLE("Speaker Switch", WM9090_SPEAKER_VOLUME_LEFT, 6, 1, 1),
206SOC_SINGLE("Speaker ZC Switch", WM9090_SPEAKER_VOLUME_LEFT, 7, 1, 0),
207SOC_SINGLE_TLV("Speaker Boost Volume", WM9090_CLASSD3, 3, 7, 0, spkboost_tlv),
208};
209
210static const struct snd_kcontrol_new wm9090_in1_se_controls[] = {
211SOC_SINGLE_TLV("IN1B Volume", WM9090_IN1_LINE_INPUT_B_VOLUME, 0, 6, 0,
212	       in_tlv),
213SOC_SINGLE("IN1B Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 7, 1, 1),
214SOC_SINGLE("IN1B ZC Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 6, 1, 0),
215
216SOC_SINGLE_TLV("SPKMIX IN1B Volume", WM9090_SPKMIXL_ATTENUATION, 4, 3, 1,
217	       mix_tlv),
218SOC_SINGLE_TLV("MIXOUTL IN1B Volume", WM9090_OUTPUT_MIXER3, 4, 3, 1,
219	       mix_tlv),
220SOC_SINGLE_TLV("MIXOUTR IN1B Volume", WM9090_OUTPUT_MIXER4, 4, 3, 1,
221	       mix_tlv),
222};
223
224static const struct snd_kcontrol_new wm9090_in2_se_controls[] = {
225SOC_SINGLE_TLV("IN2B Volume", WM9090_IN2_LINE_INPUT_B_VOLUME, 0, 6, 0,
226	       in_tlv),
227SOC_SINGLE("IN2B Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 7, 1, 1),
228SOC_SINGLE("IN2B ZC Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 6, 1, 0),
229
230SOC_SINGLE_TLV("SPKMIX IN2B Volume", WM9090_SPKMIXL_ATTENUATION, 0, 3, 1,
231	       mix_tlv),
232SOC_SINGLE_TLV("MIXOUTL IN2B Volume", WM9090_OUTPUT_MIXER3, 0, 3, 1,
233	       mix_tlv),
234SOC_SINGLE_TLV("MIXOUTR IN2B Volume", WM9090_OUTPUT_MIXER4, 0, 3, 1,
235	       mix_tlv),
236};
237
238static int hp_ev(struct snd_soc_dapm_widget *w,
239		 struct snd_kcontrol *kcontrol, int event)
240{
241	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
242	unsigned int reg = snd_soc_component_read(component, WM9090_ANALOGUE_HP_0);
243
244	switch (event) {
245	case SND_SOC_DAPM_POST_PMU:
246		snd_soc_component_update_bits(component, WM9090_CHARGE_PUMP_1,
247				    WM9090_CP_ENA, WM9090_CP_ENA);
248
249		msleep(5);
250
251		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_1,
252				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
253				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA);
254
255		reg |= WM9090_HPOUT1L_DLY | WM9090_HPOUT1R_DLY;
256		snd_soc_component_write(component, WM9090_ANALOGUE_HP_0, reg);
257
258		/* Start the DC servo.  We don't currently use the
259		 * ability to save the state since we don't have full
260		 * control of the analogue paths and they can change
261		 * DC offsets; see the WM8904 driver for an example of
262		 * doing so.
263		 */
264		snd_soc_component_write(component, WM9090_DC_SERVO_0,
265			      WM9090_DCS_ENA_CHAN_0 |
266			      WM9090_DCS_ENA_CHAN_1 |
267			      WM9090_DCS_TRIG_STARTUP_1 |
268			      WM9090_DCS_TRIG_STARTUP_0);
269		wait_for_dc_servo(component);
270
271		reg |= WM9090_HPOUT1R_OUTP | WM9090_HPOUT1R_RMV_SHORT |
272			WM9090_HPOUT1L_OUTP | WM9090_HPOUT1L_RMV_SHORT;
273		snd_soc_component_write(component, WM9090_ANALOGUE_HP_0, reg);
274		break;
275
276	case SND_SOC_DAPM_PRE_PMD:
277		reg &= ~(WM9090_HPOUT1L_RMV_SHORT |
278			 WM9090_HPOUT1L_DLY |
279			 WM9090_HPOUT1L_OUTP |
280			 WM9090_HPOUT1R_RMV_SHORT |
281			 WM9090_HPOUT1R_DLY |
282			 WM9090_HPOUT1R_OUTP);
283
284		snd_soc_component_write(component, WM9090_ANALOGUE_HP_0, reg);
285
286		snd_soc_component_write(component, WM9090_DC_SERVO_0, 0);
287
288		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_1,
289				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
290				    0);
291
292		snd_soc_component_update_bits(component, WM9090_CHARGE_PUMP_1,
293				    WM9090_CP_ENA, 0);
294		break;
295	}
296
297	return 0;
298}
299
300static const struct snd_kcontrol_new spkmix[] = {
301SOC_DAPM_SINGLE("IN1A Switch", WM9090_SPEAKER_MIXER, 6, 1, 0),
302SOC_DAPM_SINGLE("IN1B Switch", WM9090_SPEAKER_MIXER, 4, 1, 0),
303SOC_DAPM_SINGLE("IN2A Switch", WM9090_SPEAKER_MIXER, 2, 1, 0),
304SOC_DAPM_SINGLE("IN2B Switch", WM9090_SPEAKER_MIXER, 0, 1, 0),
305};
306
307static const struct snd_kcontrol_new spkout[] = {
308SOC_DAPM_SINGLE("Mixer Switch", WM9090_SPKOUT_MIXERS, 4, 1, 0),
309};
310
311static const struct snd_kcontrol_new mixoutl[] = {
312SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER1, 6, 1, 0),
313SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER1, 4, 1, 0),
314SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER1, 2, 1, 0),
315SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER1, 0, 1, 0),
316};
317
318static const struct snd_kcontrol_new mixoutr[] = {
319SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER2, 6, 1, 0),
320SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER2, 4, 1, 0),
321SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER2, 2, 1, 0),
322SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER2, 0, 1, 0),
323};
324
325static const struct snd_soc_dapm_widget wm9090_dapm_widgets[] = {
326SND_SOC_DAPM_INPUT("IN1+"),
327SND_SOC_DAPM_INPUT("IN1-"),
328SND_SOC_DAPM_INPUT("IN2+"),
329SND_SOC_DAPM_INPUT("IN2-"),
330
331SND_SOC_DAPM_SUPPLY("OSC", WM9090_POWER_MANAGEMENT_1, 3, 0, NULL, 0),
332
333SND_SOC_DAPM_PGA("IN1A PGA", WM9090_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
334SND_SOC_DAPM_PGA("IN1B PGA", WM9090_POWER_MANAGEMENT_2, 6, 0, NULL, 0),
335SND_SOC_DAPM_PGA("IN2A PGA", WM9090_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
336SND_SOC_DAPM_PGA("IN2B PGA", WM9090_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
337
338SND_SOC_DAPM_MIXER("SPKMIX", WM9090_POWER_MANAGEMENT_3, 3, 0,
339		   spkmix, ARRAY_SIZE(spkmix)),
340SND_SOC_DAPM_MIXER("MIXOUTL", WM9090_POWER_MANAGEMENT_3, 5, 0,
341		   mixoutl, ARRAY_SIZE(mixoutl)),
342SND_SOC_DAPM_MIXER("MIXOUTR", WM9090_POWER_MANAGEMENT_3, 4, 0,
343		   mixoutr, ARRAY_SIZE(mixoutr)),
344
345SND_SOC_DAPM_PGA_E("HP PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
346		   hp_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
347
348SND_SOC_DAPM_PGA("SPKPGA", WM9090_POWER_MANAGEMENT_3, 8, 0, NULL, 0),
349SND_SOC_DAPM_MIXER("SPKOUT", WM9090_POWER_MANAGEMENT_1, 12, 0,
350		   spkout, ARRAY_SIZE(spkout)),
351
352SND_SOC_DAPM_OUTPUT("HPR"),
353SND_SOC_DAPM_OUTPUT("HPL"),
354SND_SOC_DAPM_OUTPUT("Speaker"),
355};
356
357static const struct snd_soc_dapm_route audio_map[] = {
358	{ "IN1A PGA", NULL, "IN1+" },
359	{ "IN2A PGA", NULL, "IN2+" },
360
361	{ "SPKMIX", "IN1A Switch", "IN1A PGA" },
362	{ "SPKMIX", "IN2A Switch", "IN2A PGA" },
363
364	{ "MIXOUTL", "IN1A Switch", "IN1A PGA" },
365	{ "MIXOUTL", "IN2A Switch", "IN2A PGA" },
366
367	{ "MIXOUTR", "IN1A Switch", "IN1A PGA" },
368	{ "MIXOUTR", "IN2A Switch", "IN2A PGA" },
369
370	{ "HP PGA", NULL, "OSC" },
371	{ "HP PGA", NULL, "MIXOUTL" },
372	{ "HP PGA", NULL, "MIXOUTR" },
373
374	{ "HPL", NULL, "HP PGA" },
375	{ "HPR", NULL, "HP PGA" },
376
377	{ "SPKPGA", NULL, "OSC" },
378	{ "SPKPGA", NULL, "SPKMIX" },
379
380	{ "SPKOUT", "Mixer Switch", "SPKPGA" },
381
382	{ "Speaker", NULL, "SPKOUT" },
383};
384
385static const struct snd_soc_dapm_route audio_map_in1_se[] = {
386	{ "IN1B PGA", NULL, "IN1-" },	
387
388	{ "SPKMIX", "IN1B Switch", "IN1B PGA" },
389	{ "MIXOUTL", "IN1B Switch", "IN1B PGA" },
390	{ "MIXOUTR", "IN1B Switch", "IN1B PGA" },
391};
392
393static const struct snd_soc_dapm_route audio_map_in1_diff[] = {
394	{ "IN1A PGA", NULL, "IN1-" },	
395};
396
397static const struct snd_soc_dapm_route audio_map_in2_se[] = {
398	{ "IN2B PGA", NULL, "IN2-" },	
399
400	{ "SPKMIX", "IN2B Switch", "IN2B PGA" },
401	{ "MIXOUTL", "IN2B Switch", "IN2B PGA" },
402	{ "MIXOUTR", "IN2B Switch", "IN2B PGA" },
403};
404
405static const struct snd_soc_dapm_route audio_map_in2_diff[] = {
406	{ "IN2A PGA", NULL, "IN2-" },	
407};
408
409static int wm9090_add_controls(struct snd_soc_component *component)
410{
411	struct wm9090_priv *wm9090 = snd_soc_component_get_drvdata(component);
412	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
413	int i;
414
415	snd_soc_dapm_new_controls(dapm, wm9090_dapm_widgets,
416				  ARRAY_SIZE(wm9090_dapm_widgets));
417
418	snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
419
420	snd_soc_add_component_controls(component, wm9090_controls,
421			     ARRAY_SIZE(wm9090_controls));
422
423	if (wm9090->pdata.lin1_diff) {
424		snd_soc_dapm_add_routes(dapm, audio_map_in1_diff,
425					ARRAY_SIZE(audio_map_in1_diff));
426	} else {
427		snd_soc_dapm_add_routes(dapm, audio_map_in1_se,
428					ARRAY_SIZE(audio_map_in1_se));
429		snd_soc_add_component_controls(component, wm9090_in1_se_controls,
430				     ARRAY_SIZE(wm9090_in1_se_controls));
431	}
432
433	if (wm9090->pdata.lin2_diff) {
434		snd_soc_dapm_add_routes(dapm, audio_map_in2_diff,
435					ARRAY_SIZE(audio_map_in2_diff));
436	} else {
437		snd_soc_dapm_add_routes(dapm, audio_map_in2_se,
438					ARRAY_SIZE(audio_map_in2_se));
439		snd_soc_add_component_controls(component, wm9090_in2_se_controls,
440				     ARRAY_SIZE(wm9090_in2_se_controls));
441	}
442
443	if (wm9090->pdata.agc_ena) {
444		for (i = 0; i < ARRAY_SIZE(wm9090->pdata.agc); i++)
445			snd_soc_component_write(component, WM9090_AGC_CONTROL_0 + i,
446				      wm9090->pdata.agc[i]);
447		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_3,
448				    WM9090_AGC_ENA, WM9090_AGC_ENA);
449	} else {
450		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_3,
451				    WM9090_AGC_ENA, 0);
452	}
453
454	return 0;
455
456}
457
458/*
459 * The machine driver should call this from their set_bias_level; if there
460 * isn't one then this can just be set as the set_bias_level function.
461 */
462static int wm9090_set_bias_level(struct snd_soc_component *component,
463				 enum snd_soc_bias_level level)
464{
465	struct wm9090_priv *wm9090 = snd_soc_component_get_drvdata(component);
466
467	switch (level) {
468	case SND_SOC_BIAS_ON:
469		break;
470
471	case SND_SOC_BIAS_PREPARE:
472		snd_soc_component_update_bits(component, WM9090_ANTIPOP2, WM9090_VMID_ENA,
473				    WM9090_VMID_ENA);
474		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_1,
475				    WM9090_BIAS_ENA |
476				    WM9090_VMID_RES_MASK,
477				    WM9090_BIAS_ENA |
478				    1 << WM9090_VMID_RES_SHIFT);
479		msleep(1);  /* Probably an overestimate */
480		break;
481
482	case SND_SOC_BIAS_STANDBY:
483		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
484			/* Restore the register cache */
485			regcache_sync(wm9090->regmap);
486		}
487
488		/* We keep VMID off during standby since the combination of
489		 * ground referenced outputs and class D speaker mean that
490		 * latency is not an issue.
491		 */
492		snd_soc_component_update_bits(component, WM9090_POWER_MANAGEMENT_1,
493				    WM9090_BIAS_ENA | WM9090_VMID_RES_MASK, 0);
494		snd_soc_component_update_bits(component, WM9090_ANTIPOP2,
495				    WM9090_VMID_ENA, 0);
496		break;
497
498	case SND_SOC_BIAS_OFF:
499		break;
500	}
501
 
 
502	return 0;
503}
504
505static int wm9090_probe(struct snd_soc_component *component)
506{
 
 
 
 
 
 
 
 
 
 
507	/* Configure some defaults; they will be written out when we
508	 * bring the bias up.
509	 */
510	snd_soc_component_update_bits(component, WM9090_IN1_LINE_INPUT_A_VOLUME,
511			    WM9090_IN1_VU | WM9090_IN1A_ZC,
512			    WM9090_IN1_VU | WM9090_IN1A_ZC);
513	snd_soc_component_update_bits(component, WM9090_IN1_LINE_INPUT_B_VOLUME,
514			    WM9090_IN1_VU | WM9090_IN1B_ZC,
515			    WM9090_IN1_VU | WM9090_IN1B_ZC);
516	snd_soc_component_update_bits(component, WM9090_IN2_LINE_INPUT_A_VOLUME,
517			    WM9090_IN2_VU | WM9090_IN2A_ZC,
518			    WM9090_IN2_VU | WM9090_IN2A_ZC);
519	snd_soc_component_update_bits(component, WM9090_IN2_LINE_INPUT_B_VOLUME,
520			    WM9090_IN2_VU | WM9090_IN2B_ZC,
521			    WM9090_IN2_VU | WM9090_IN2B_ZC);
522	snd_soc_component_update_bits(component, WM9090_SPEAKER_VOLUME_LEFT,
523			    WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC,
524			    WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC);
525	snd_soc_component_update_bits(component, WM9090_LEFT_OUTPUT_VOLUME,
526			    WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC,
527			    WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC);
528	snd_soc_component_update_bits(component, WM9090_RIGHT_OUTPUT_VOLUME,
529			    WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC,
530			    WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC);
531
532	snd_soc_component_update_bits(component, WM9090_CLOCKING_1,
533			    WM9090_TOCLK_ENA, WM9090_TOCLK_ENA);
534
535	wm9090_add_controls(component);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
536
537	return 0;
538}
539
540static const struct snd_soc_component_driver soc_component_dev_wm9090 = {
541	.probe			= wm9090_probe,
542	.set_bias_level		= wm9090_set_bias_level,
543	.suspend_bias_off	= 1,
544	.idle_bias_on		= 1,
545	.use_pmdown_time	= 1,
546};
547
548static const struct regmap_config wm9090_regmap = {
549	.reg_bits = 8,
550	.val_bits = 16,
551
552	.max_register = WM9090_MAX_REGISTER,
553	.volatile_reg = wm9090_volatile,
554	.readable_reg = wm9090_readable,
555
556	.cache_type = REGCACHE_MAPLE,
557	.reg_defaults = wm9090_reg_defaults,
558	.num_reg_defaults = ARRAY_SIZE(wm9090_reg_defaults),
559};
560
561
562static int wm9090_i2c_probe(struct i2c_client *i2c)
 
563{
564	struct wm9090_priv *wm9090;
565	unsigned int reg;
566	int ret;
567
568	wm9090 = devm_kzalloc(&i2c->dev, sizeof(*wm9090), GFP_KERNEL);
569	if (!wm9090)
 
570		return -ENOMEM;
 
571
572	wm9090->regmap = devm_regmap_init_i2c(i2c, &wm9090_regmap);
573	if (IS_ERR(wm9090->regmap)) {
574		ret = PTR_ERR(wm9090->regmap);
575		dev_err(&i2c->dev, "Failed to allocate regmap: %d\n", ret);
576		return ret;
577	}
578
579	ret = regmap_read(wm9090->regmap, WM9090_SOFTWARE_RESET, &reg);
580	if (ret < 0)
581		return ret;
582
583	if (reg != 0x9093) {
584		dev_err(&i2c->dev, "Device is not a WM9090, ID=%x\n", reg);
585		return -ENODEV;
 
586	}
587
588	ret = regmap_write(wm9090->regmap, WM9090_SOFTWARE_RESET, 0);
589	if (ret < 0)
590		return ret;
591
592	if (i2c->dev.platform_data)
593		memcpy(&wm9090->pdata, i2c->dev.platform_data,
594		       sizeof(wm9090->pdata));
595
596	i2c_set_clientdata(i2c, wm9090);
597
598	ret =  devm_snd_soc_register_component(&i2c->dev,
599			&soc_component_dev_wm9090,  NULL, 0);
600	if (ret != 0) {
601		dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
602		return ret;
603	}
604
605	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
606}
607
608static const struct i2c_device_id wm9090_id[] = {
609	{ "wm9090" },
610	{ "wm9093" },
611	{ }
612};
613MODULE_DEVICE_TABLE(i2c, wm9090_id);
614
615static struct i2c_driver wm9090_i2c_driver = {
616	.driver = {
617		.name = "wm9090",
 
618	},
619	.probe = wm9090_i2c_probe,
 
620	.id_table = wm9090_id,
621};
622
623module_i2c_driver(wm9090_i2c_driver);
 
 
 
 
 
 
 
 
 
 
624
625MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
626MODULE_DESCRIPTION("WM9090 ASoC driver");
627MODULE_LICENSE("GPL");
v3.5.6
 
  1/*
  2 * ALSA SoC WM9090 driver
  3 *
  4 * Copyright 2009, 2010 Wolfson Microelectronics
  5 *
  6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
  7 *
  8 * This program is free software; you can redistribute it and/or
  9 * modify it under the terms of the GNU General Public License
 10 * version 2 as published by the Free Software Foundation.
 11 *
 12 * This program is distributed in the hope that it will be useful, but
 13 * WITHOUT ANY WARRANTY; without even the implied warranty of
 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 15 * General Public License for more details.
 16 *
 17 * You should have received a copy of the GNU General Public License
 18 * along with this program; if not, write to the Free Software
 19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 20 * 02110-1301 USA
 21 */
 22
 23#include <linux/module.h>
 24#include <linux/errno.h>
 25#include <linux/device.h>
 26#include <linux/i2c.h>
 27#include <linux/delay.h>
 28#include <linux/regmap.h>
 29#include <linux/slab.h>
 30#include <sound/initval.h>
 31#include <sound/soc.h>
 32#include <sound/tlv.h>
 33#include <sound/wm9090.h>
 34
 35#include "wm9090.h"
 36
 37static const struct reg_default wm9090_reg_defaults[] = {
 38	{ 1,  0x0006 },     /* R1   - Power Management (1) */
 39	{ 2,  0x6000 },     /* R2   - Power Management (2) */
 40	{ 3,  0x0000 },     /* R3   - Power Management (3) */
 41	{ 6,  0x01C0 },     /* R6   - Clocking 1 */
 42	{ 22, 0x0003 },     /* R22  - IN1 Line Control */
 43	{ 23, 0x0003 },     /* R23  - IN2 Line Control */
 44	{ 24, 0x0083 },     /* R24  - IN1 Line Input A Volume */
 45	{ 25, 0x0083 },     /* R25  - IN1  Line Input B Volume */
 46	{ 26, 0x0083 },     /* R26  - IN2 Line Input A Volume */
 47	{ 27, 0x0083 },     /* R27  - IN2 Line Input B Volume */
 48	{ 28, 0x002D },     /* R28  - Left Output Volume */
 49	{ 29, 0x002D },     /* R29  - Right Output Volume */
 50	{ 34, 0x0100 },     /* R34  - SPKMIXL Attenuation */
 51	{ 35, 0x0010 },     /* R36  - SPKOUT Mixers */
 52	{ 37, 0x0140 },     /* R37  - ClassD3 */
 53	{ 38, 0x0039 },     /* R38  - Speaker Volume Left */
 54	{ 45, 0x0000 },     /* R45  - Output Mixer1 */
 55	{ 46, 0x0000 },     /* R46  - Output Mixer2 */
 56	{ 47, 0x0100 },     /* R47  - Output Mixer3 */
 57	{ 48, 0x0100 },     /* R48  - Output Mixer4 */
 58	{ 54, 0x0000 },     /* R54  - Speaker Mixer */
 59	{ 57, 0x000D },     /* R57  - AntiPOP2 */
 60	{ 70, 0x0000 },     /* R70  - Write Sequencer 0 */
 61	{ 71, 0x0000 },     /* R71  - Write Sequencer 1 */
 62	{ 72, 0x0000 },     /* R72  - Write Sequencer 2 */
 63	{ 73, 0x0000 },     /* R73  - Write Sequencer 3 */
 64	{ 74, 0x0000 },     /* R74  - Write Sequencer 4 */
 65	{ 75, 0x0000 },     /* R75  - Write Sequencer 5 */
 66	{ 76, 0x1F25 },     /* R76  - Charge Pump 1 */
 67	{ 85, 0x054A },     /* R85  - DC Servo 1 */
 68	{ 87, 0x0000 },     /* R87  - DC Servo 3 */
 69	{ 96, 0x0100 },     /* R96  - Analogue HP 0 */
 70	{ 98, 0x8640 },     /* R98  - AGC Control 0 */
 71	{ 99, 0xC000 },     /* R99  - AGC Control 1 */
 72	{ 100, 0x0200 },     /* R100 - AGC Control 2 */
 73};
 74
 75/* This struct is used to save the context */
 76struct wm9090_priv {
 77	struct wm9090_platform_data pdata;
 78	struct regmap *regmap;
 79};
 80
 81static bool wm9090_volatile(struct device *dev, unsigned int reg)
 82{
 83	switch (reg) {
 84	case WM9090_SOFTWARE_RESET:
 85	case WM9090_DC_SERVO_0:
 86	case WM9090_DC_SERVO_READBACK_0:
 87	case WM9090_DC_SERVO_READBACK_1:
 88	case WM9090_DC_SERVO_READBACK_2:
 89		return true;
 90
 91	default:
 92		return false;
 93	}
 94}
 95
 96static bool wm9090_readable(struct device *dev, unsigned int reg)
 97{
 98	switch (reg) {
 99	case WM9090_SOFTWARE_RESET:
100	case WM9090_POWER_MANAGEMENT_1:
101	case WM9090_POWER_MANAGEMENT_2:
102	case WM9090_POWER_MANAGEMENT_3:
103	case WM9090_CLOCKING_1:
104	case WM9090_IN1_LINE_CONTROL:
105	case WM9090_IN2_LINE_CONTROL:
106	case WM9090_IN1_LINE_INPUT_A_VOLUME:
107	case WM9090_IN1_LINE_INPUT_B_VOLUME:
108	case WM9090_IN2_LINE_INPUT_A_VOLUME:
109	case WM9090_IN2_LINE_INPUT_B_VOLUME:
110	case WM9090_LEFT_OUTPUT_VOLUME:
111	case WM9090_RIGHT_OUTPUT_VOLUME:
112	case WM9090_SPKMIXL_ATTENUATION:
113	case WM9090_SPKOUT_MIXERS:
114	case WM9090_CLASSD3:
115	case WM9090_SPEAKER_VOLUME_LEFT:
116	case WM9090_OUTPUT_MIXER1:
117	case WM9090_OUTPUT_MIXER2:
118	case WM9090_OUTPUT_MIXER3:
119	case WM9090_OUTPUT_MIXER4:
120	case WM9090_SPEAKER_MIXER:
121	case WM9090_ANTIPOP2:
122	case WM9090_WRITE_SEQUENCER_0:
123	case WM9090_WRITE_SEQUENCER_1:
124	case WM9090_WRITE_SEQUENCER_2:
125	case WM9090_WRITE_SEQUENCER_3:
126	case WM9090_WRITE_SEQUENCER_4:
127	case WM9090_WRITE_SEQUENCER_5:
128	case WM9090_CHARGE_PUMP_1:
129	case WM9090_DC_SERVO_0:
130	case WM9090_DC_SERVO_1:
131	case WM9090_DC_SERVO_3:
132	case WM9090_DC_SERVO_READBACK_0:
133	case WM9090_DC_SERVO_READBACK_1:
134	case WM9090_DC_SERVO_READBACK_2:
135	case WM9090_ANALOGUE_HP_0:
136	case WM9090_AGC_CONTROL_0:
137	case WM9090_AGC_CONTROL_1:
138	case WM9090_AGC_CONTROL_2:
139		return true;
140
141	default:
142		return false;
143	}
144}
145
146static void wait_for_dc_servo(struct snd_soc_codec *codec)
147{
148	unsigned int reg;
149	int count = 0;
150
151	dev_dbg(codec->dev, "Waiting for DC servo...\n");
152	do {
153		count++;
154		msleep(1);
155		reg = snd_soc_read(codec, WM9090_DC_SERVO_READBACK_0);
156		dev_dbg(codec->dev, "DC servo status: %x\n", reg);
157	} while ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
158		 != WM9090_DCS_CAL_COMPLETE_MASK && count < 1000);
159
160	if ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
161	    != WM9090_DCS_CAL_COMPLETE_MASK)
162		dev_err(codec->dev, "Timed out waiting for DC Servo\n");
163}
164
165static const unsigned int in_tlv[] = {
166	TLV_DB_RANGE_HEAD(3),
167	0, 0, TLV_DB_SCALE_ITEM(-600, 0, 0),
168	1, 3, TLV_DB_SCALE_ITEM(-350, 350, 0),
169	4, 6, TLV_DB_SCALE_ITEM(600, 600, 0),
170};
171static const unsigned int mix_tlv[] = {
172	TLV_DB_RANGE_HEAD(2),
173	0, 2, TLV_DB_SCALE_ITEM(-1200, 300, 0),
174	3, 3, TLV_DB_SCALE_ITEM(0, 0, 0),
175};
176static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
177static const unsigned int spkboost_tlv[] = {
178	TLV_DB_RANGE_HEAD(2),
179	0, 6, TLV_DB_SCALE_ITEM(0, 150, 0),
180	7, 7, TLV_DB_SCALE_ITEM(1200, 0, 0),
181};
182
183static const struct snd_kcontrol_new wm9090_controls[] = {
184SOC_SINGLE_TLV("IN1A Volume", WM9090_IN1_LINE_INPUT_A_VOLUME, 0, 6, 0,
185	       in_tlv),
186SOC_SINGLE("IN1A Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 7, 1, 1),
187SOC_SINGLE("IN1A ZC Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 6, 1, 0),
188
189SOC_SINGLE_TLV("IN2A Volume", WM9090_IN2_LINE_INPUT_A_VOLUME, 0, 6, 0,
190	       in_tlv),
191SOC_SINGLE("IN2A Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 7, 1, 1),
192SOC_SINGLE("IN2A ZC Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 6, 1, 0),
193
194SOC_SINGLE("MIXOUTL Switch", WM9090_OUTPUT_MIXER3, 8, 1, 1),
195SOC_SINGLE_TLV("MIXOUTL IN1A Volume", WM9090_OUTPUT_MIXER3, 6, 3, 1,
196	       mix_tlv),
197SOC_SINGLE_TLV("MIXOUTL IN2A Volume", WM9090_OUTPUT_MIXER3, 2, 3, 1,
198	       mix_tlv),
199
200SOC_SINGLE("MIXOUTR Switch", WM9090_OUTPUT_MIXER4, 8, 1, 1),
201SOC_SINGLE_TLV("MIXOUTR IN1A Volume", WM9090_OUTPUT_MIXER4, 6, 3, 1,
202	       mix_tlv),
203SOC_SINGLE_TLV("MIXOUTR IN2A Volume", WM9090_OUTPUT_MIXER4, 2, 3, 1,
204	       mix_tlv),
205
206SOC_SINGLE("SPKMIX Switch", WM9090_SPKMIXL_ATTENUATION, 8, 1, 1),
207SOC_SINGLE_TLV("SPKMIX IN1A Volume", WM9090_SPKMIXL_ATTENUATION, 6, 3, 1,
208	       mix_tlv),
209SOC_SINGLE_TLV("SPKMIX IN2A Volume", WM9090_SPKMIXL_ATTENUATION, 2, 3, 1,
210	       mix_tlv),
211
212SOC_DOUBLE_R_TLV("Headphone Volume", WM9090_LEFT_OUTPUT_VOLUME,
213		 WM9090_RIGHT_OUTPUT_VOLUME, 0, 63, 0, out_tlv),
214SOC_DOUBLE_R("Headphone Switch", WM9090_LEFT_OUTPUT_VOLUME,
215	     WM9090_RIGHT_OUTPUT_VOLUME, 6, 1, 1),
216SOC_DOUBLE_R("Headphone ZC Switch", WM9090_LEFT_OUTPUT_VOLUME,
217	     WM9090_RIGHT_OUTPUT_VOLUME, 7, 1, 0),
218
219SOC_SINGLE_TLV("Speaker Volume", WM9090_SPEAKER_VOLUME_LEFT, 0, 63, 0,
220	       out_tlv),
221SOC_SINGLE("Speaker Switch", WM9090_SPEAKER_VOLUME_LEFT, 6, 1, 1),
222SOC_SINGLE("Speaker ZC Switch", WM9090_SPEAKER_VOLUME_LEFT, 7, 1, 0),
223SOC_SINGLE_TLV("Speaker Boost Volume", WM9090_CLASSD3, 3, 7, 0, spkboost_tlv),
224};
225
226static const struct snd_kcontrol_new wm9090_in1_se_controls[] = {
227SOC_SINGLE_TLV("IN1B Volume", WM9090_IN1_LINE_INPUT_B_VOLUME, 0, 6, 0,
228	       in_tlv),
229SOC_SINGLE("IN1B Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 7, 1, 1),
230SOC_SINGLE("IN1B ZC Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 6, 1, 0),
231
232SOC_SINGLE_TLV("SPKMIX IN1B Volume", WM9090_SPKMIXL_ATTENUATION, 4, 3, 1,
233	       mix_tlv),
234SOC_SINGLE_TLV("MIXOUTL IN1B Volume", WM9090_OUTPUT_MIXER3, 4, 3, 1,
235	       mix_tlv),
236SOC_SINGLE_TLV("MIXOUTR IN1B Volume", WM9090_OUTPUT_MIXER4, 4, 3, 1,
237	       mix_tlv),
238};
239
240static const struct snd_kcontrol_new wm9090_in2_se_controls[] = {
241SOC_SINGLE_TLV("IN2B Volume", WM9090_IN2_LINE_INPUT_B_VOLUME, 0, 6, 0,
242	       in_tlv),
243SOC_SINGLE("IN2B Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 7, 1, 1),
244SOC_SINGLE("IN2B ZC Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 6, 1, 0),
245
246SOC_SINGLE_TLV("SPKMIX IN2B Volume", WM9090_SPKMIXL_ATTENUATION, 0, 3, 1,
247	       mix_tlv),
248SOC_SINGLE_TLV("MIXOUTL IN2B Volume", WM9090_OUTPUT_MIXER3, 0, 3, 1,
249	       mix_tlv),
250SOC_SINGLE_TLV("MIXOUTR IN2B Volume", WM9090_OUTPUT_MIXER4, 0, 3, 1,
251	       mix_tlv),
252};
253
254static int hp_ev(struct snd_soc_dapm_widget *w,
255		 struct snd_kcontrol *kcontrol, int event)
256{
257	struct snd_soc_codec *codec = w->codec;
258	unsigned int reg = snd_soc_read(codec, WM9090_ANALOGUE_HP_0);
259
260	switch (event) {
261	case SND_SOC_DAPM_POST_PMU:
262		snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
263				    WM9090_CP_ENA, WM9090_CP_ENA);
264
265		msleep(5);
266
267		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
268				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
269				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA);
270
271		reg |= WM9090_HPOUT1L_DLY | WM9090_HPOUT1R_DLY;
272		snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
273
274		/* Start the DC servo.  We don't currently use the
275		 * ability to save the state since we don't have full
276		 * control of the analogue paths and they can change
277		 * DC offsets; see the WM8904 driver for an example of
278		 * doing so.
279		 */
280		snd_soc_write(codec, WM9090_DC_SERVO_0,
281			      WM9090_DCS_ENA_CHAN_0 |
282			      WM9090_DCS_ENA_CHAN_1 |
283			      WM9090_DCS_TRIG_STARTUP_1 |
284			      WM9090_DCS_TRIG_STARTUP_0);
285		wait_for_dc_servo(codec);
286
287		reg |= WM9090_HPOUT1R_OUTP | WM9090_HPOUT1R_RMV_SHORT |
288			WM9090_HPOUT1L_OUTP | WM9090_HPOUT1L_RMV_SHORT;
289		snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
290		break;
291
292	case SND_SOC_DAPM_PRE_PMD:
293		reg &= ~(WM9090_HPOUT1L_RMV_SHORT |
294			 WM9090_HPOUT1L_DLY |
295			 WM9090_HPOUT1L_OUTP |
296			 WM9090_HPOUT1R_RMV_SHORT |
297			 WM9090_HPOUT1R_DLY |
298			 WM9090_HPOUT1R_OUTP);
299
300		snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
301
302		snd_soc_write(codec, WM9090_DC_SERVO_0, 0);
303
304		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
305				    WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
306				    0);
307
308		snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
309				    WM9090_CP_ENA, 0);
310		break;
311	}
312
313	return 0;
314}
315
316static const struct snd_kcontrol_new spkmix[] = {
317SOC_DAPM_SINGLE("IN1A Switch", WM9090_SPEAKER_MIXER, 6, 1, 0),
318SOC_DAPM_SINGLE("IN1B Switch", WM9090_SPEAKER_MIXER, 4, 1, 0),
319SOC_DAPM_SINGLE("IN2A Switch", WM9090_SPEAKER_MIXER, 2, 1, 0),
320SOC_DAPM_SINGLE("IN2B Switch", WM9090_SPEAKER_MIXER, 0, 1, 0),
321};
322
323static const struct snd_kcontrol_new spkout[] = {
324SOC_DAPM_SINGLE("Mixer Switch", WM9090_SPKOUT_MIXERS, 4, 1, 0),
325};
326
327static const struct snd_kcontrol_new mixoutl[] = {
328SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER1, 6, 1, 0),
329SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER1, 4, 1, 0),
330SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER1, 2, 1, 0),
331SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER1, 0, 1, 0),
332};
333
334static const struct snd_kcontrol_new mixoutr[] = {
335SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER2, 6, 1, 0),
336SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER2, 4, 1, 0),
337SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER2, 2, 1, 0),
338SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER2, 0, 1, 0),
339};
340
341static const struct snd_soc_dapm_widget wm9090_dapm_widgets[] = {
342SND_SOC_DAPM_INPUT("IN1+"),
343SND_SOC_DAPM_INPUT("IN1-"),
344SND_SOC_DAPM_INPUT("IN2+"),
345SND_SOC_DAPM_INPUT("IN2-"),
346
347SND_SOC_DAPM_SUPPLY("OSC", WM9090_POWER_MANAGEMENT_1, 3, 0, NULL, 0),
348
349SND_SOC_DAPM_PGA("IN1A PGA", WM9090_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
350SND_SOC_DAPM_PGA("IN1B PGA", WM9090_POWER_MANAGEMENT_2, 6, 0, NULL, 0),
351SND_SOC_DAPM_PGA("IN2A PGA", WM9090_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
352SND_SOC_DAPM_PGA("IN2B PGA", WM9090_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
353
354SND_SOC_DAPM_MIXER("SPKMIX", WM9090_POWER_MANAGEMENT_3, 3, 0,
355		   spkmix, ARRAY_SIZE(spkmix)),
356SND_SOC_DAPM_MIXER("MIXOUTL", WM9090_POWER_MANAGEMENT_3, 5, 0,
357		   mixoutl, ARRAY_SIZE(mixoutl)),
358SND_SOC_DAPM_MIXER("MIXOUTR", WM9090_POWER_MANAGEMENT_3, 4, 0,
359		   mixoutr, ARRAY_SIZE(mixoutr)),
360
361SND_SOC_DAPM_PGA_E("HP PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
362		   hp_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
363
364SND_SOC_DAPM_PGA("SPKPGA", WM9090_POWER_MANAGEMENT_3, 8, 0, NULL, 0),
365SND_SOC_DAPM_MIXER("SPKOUT", WM9090_POWER_MANAGEMENT_1, 12, 0,
366		   spkout, ARRAY_SIZE(spkout)),
367
368SND_SOC_DAPM_OUTPUT("HPR"),
369SND_SOC_DAPM_OUTPUT("HPL"),
370SND_SOC_DAPM_OUTPUT("Speaker"),
371};
372
373static const struct snd_soc_dapm_route audio_map[] = {
374	{ "IN1A PGA", NULL, "IN1+" },
375	{ "IN2A PGA", NULL, "IN2+" },
376
377	{ "SPKMIX", "IN1A Switch", "IN1A PGA" },
378	{ "SPKMIX", "IN2A Switch", "IN2A PGA" },
379
380	{ "MIXOUTL", "IN1A Switch", "IN1A PGA" },
381	{ "MIXOUTL", "IN2A Switch", "IN2A PGA" },
382
383	{ "MIXOUTR", "IN1A Switch", "IN1A PGA" },
384	{ "MIXOUTR", "IN2A Switch", "IN2A PGA" },
385
386	{ "HP PGA", NULL, "OSC" },
387	{ "HP PGA", NULL, "MIXOUTL" },
388	{ "HP PGA", NULL, "MIXOUTR" },
389
390	{ "HPL", NULL, "HP PGA" },
391	{ "HPR", NULL, "HP PGA" },
392
393	{ "SPKPGA", NULL, "OSC" },
394	{ "SPKPGA", NULL, "SPKMIX" },
395
396	{ "SPKOUT", "Mixer Switch", "SPKPGA" },
397
398	{ "Speaker", NULL, "SPKOUT" },
399};
400
401static const struct snd_soc_dapm_route audio_map_in1_se[] = {
402	{ "IN1B PGA", NULL, "IN1-" },	
403
404	{ "SPKMIX", "IN1B Switch", "IN1B PGA" },
405	{ "MIXOUTL", "IN1B Switch", "IN1B PGA" },
406	{ "MIXOUTR", "IN1B Switch", "IN1B PGA" },
407};
408
409static const struct snd_soc_dapm_route audio_map_in1_diff[] = {
410	{ "IN1A PGA", NULL, "IN1-" },	
411};
412
413static const struct snd_soc_dapm_route audio_map_in2_se[] = {
414	{ "IN2B PGA", NULL, "IN2-" },	
415
416	{ "SPKMIX", "IN2B Switch", "IN2B PGA" },
417	{ "MIXOUTL", "IN2B Switch", "IN2B PGA" },
418	{ "MIXOUTR", "IN2B Switch", "IN2B PGA" },
419};
420
421static const struct snd_soc_dapm_route audio_map_in2_diff[] = {
422	{ "IN2A PGA", NULL, "IN2-" },	
423};
424
425static int wm9090_add_controls(struct snd_soc_codec *codec)
426{
427	struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
428	struct snd_soc_dapm_context *dapm = &codec->dapm;
429	int i;
430
431	snd_soc_dapm_new_controls(dapm, wm9090_dapm_widgets,
432				  ARRAY_SIZE(wm9090_dapm_widgets));
433
434	snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
435
436	snd_soc_add_codec_controls(codec, wm9090_controls,
437			     ARRAY_SIZE(wm9090_controls));
438
439	if (wm9090->pdata.lin1_diff) {
440		snd_soc_dapm_add_routes(dapm, audio_map_in1_diff,
441					ARRAY_SIZE(audio_map_in1_diff));
442	} else {
443		snd_soc_dapm_add_routes(dapm, audio_map_in1_se,
444					ARRAY_SIZE(audio_map_in1_se));
445		snd_soc_add_codec_controls(codec, wm9090_in1_se_controls,
446				     ARRAY_SIZE(wm9090_in1_se_controls));
447	}
448
449	if (wm9090->pdata.lin2_diff) {
450		snd_soc_dapm_add_routes(dapm, audio_map_in2_diff,
451					ARRAY_SIZE(audio_map_in2_diff));
452	} else {
453		snd_soc_dapm_add_routes(dapm, audio_map_in2_se,
454					ARRAY_SIZE(audio_map_in2_se));
455		snd_soc_add_codec_controls(codec, wm9090_in2_se_controls,
456				     ARRAY_SIZE(wm9090_in2_se_controls));
457	}
458
459	if (wm9090->pdata.agc_ena) {
460		for (i = 0; i < ARRAY_SIZE(wm9090->pdata.agc); i++)
461			snd_soc_write(codec, WM9090_AGC_CONTROL_0 + i,
462				      wm9090->pdata.agc[i]);
463		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
464				    WM9090_AGC_ENA, WM9090_AGC_ENA);
465	} else {
466		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
467				    WM9090_AGC_ENA, 0);
468	}
469
470	return 0;
471
472}
473
474/*
475 * The machine driver should call this from their set_bias_level; if there
476 * isn't one then this can just be set as the set_bias_level function.
477 */
478static int wm9090_set_bias_level(struct snd_soc_codec *codec,
479				 enum snd_soc_bias_level level)
480{
481	struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
482
483	switch (level) {
484	case SND_SOC_BIAS_ON:
485		break;
486
487	case SND_SOC_BIAS_PREPARE:
488		snd_soc_update_bits(codec, WM9090_ANTIPOP2, WM9090_VMID_ENA,
489				    WM9090_VMID_ENA);
490		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
491				    WM9090_BIAS_ENA |
492				    WM9090_VMID_RES_MASK,
493				    WM9090_BIAS_ENA |
494				    1 << WM9090_VMID_RES_SHIFT);
495		msleep(1);  /* Probably an overestimate */
496		break;
497
498	case SND_SOC_BIAS_STANDBY:
499		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
500			/* Restore the register cache */
501			regcache_sync(wm9090->regmap);
502		}
503
504		/* We keep VMID off during standby since the combination of
505		 * ground referenced outputs and class D speaker mean that
506		 * latency is not an issue.
507		 */
508		snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
509				    WM9090_BIAS_ENA | WM9090_VMID_RES_MASK, 0);
510		snd_soc_update_bits(codec, WM9090_ANTIPOP2,
511				    WM9090_VMID_ENA, 0);
512		break;
513
514	case SND_SOC_BIAS_OFF:
515		break;
516	}
517
518	codec->dapm.bias_level = level;
519
520	return 0;
521}
522
523static int wm9090_probe(struct snd_soc_codec *codec)
524{
525	struct wm9090_priv *wm9090 = dev_get_drvdata(codec->dev);
526	int ret;
527
528	codec->control_data = wm9090->regmap;
529	ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_REGMAP);
530	if (ret != 0) {
531		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
532		return ret;
533	}
534
535	/* Configure some defaults; they will be written out when we
536	 * bring the bias up.
537	 */
538	snd_soc_update_bits(codec, WM9090_IN1_LINE_INPUT_A_VOLUME,
539			    WM9090_IN1_VU | WM9090_IN1A_ZC,
540			    WM9090_IN1_VU | WM9090_IN1A_ZC);
541	snd_soc_update_bits(codec, WM9090_IN1_LINE_INPUT_B_VOLUME,
542			    WM9090_IN1_VU | WM9090_IN1B_ZC,
543			    WM9090_IN1_VU | WM9090_IN1B_ZC);
544	snd_soc_update_bits(codec, WM9090_IN2_LINE_INPUT_A_VOLUME,
545			    WM9090_IN2_VU | WM9090_IN2A_ZC,
546			    WM9090_IN2_VU | WM9090_IN2A_ZC);
547	snd_soc_update_bits(codec, WM9090_IN2_LINE_INPUT_B_VOLUME,
548			    WM9090_IN2_VU | WM9090_IN2B_ZC,
549			    WM9090_IN2_VU | WM9090_IN2B_ZC);
550	snd_soc_update_bits(codec, WM9090_SPEAKER_VOLUME_LEFT,
551			    WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC,
552			    WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC);
553	snd_soc_update_bits(codec, WM9090_LEFT_OUTPUT_VOLUME,
554			    WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC,
555			    WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC);
556	snd_soc_update_bits(codec, WM9090_RIGHT_OUTPUT_VOLUME,
557			    WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC,
558			    WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC);
559
560	snd_soc_update_bits(codec, WM9090_CLOCKING_1,
561			    WM9090_TOCLK_ENA, WM9090_TOCLK_ENA);
562
563	wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
564
565	wm9090_add_controls(codec);
566
567	return 0;
568}
569
570#ifdef CONFIG_PM
571static int wm9090_suspend(struct snd_soc_codec *codec)
572{
573	wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
574
575	return 0;
576}
577
578static int wm9090_resume(struct snd_soc_codec *codec)
579{
580	wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
581
582	return 0;
583}
584#else
585#define wm9090_suspend NULL
586#define wm9090_resume NULL
587#endif
588
589static int wm9090_remove(struct snd_soc_codec *codec)
590{
591	wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
592
593	return 0;
594}
595
596static struct snd_soc_codec_driver soc_codec_dev_wm9090 = {
597	.probe = 	wm9090_probe,
598	.remove = 	wm9090_remove,
599	.suspend = 	wm9090_suspend,
600	.resume =	wm9090_resume,
601	.set_bias_level = wm9090_set_bias_level,
602};
603
604static const struct regmap_config wm9090_regmap = {
605	.reg_bits = 8,
606	.val_bits = 16,
607
608	.max_register = WM9090_MAX_REGISTER,
609	.volatile_reg = wm9090_volatile,
610	.readable_reg = wm9090_readable,
611
612	.cache_type = REGCACHE_RBTREE,
613	.reg_defaults = wm9090_reg_defaults,
614	.num_reg_defaults = ARRAY_SIZE(wm9090_reg_defaults),
615};
616
617
618static int wm9090_i2c_probe(struct i2c_client *i2c,
619			    const struct i2c_device_id *id)
620{
621	struct wm9090_priv *wm9090;
622	unsigned int reg;
623	int ret;
624
625	wm9090 = devm_kzalloc(&i2c->dev, sizeof(*wm9090), GFP_KERNEL);
626	if (wm9090 == NULL) {
627		dev_err(&i2c->dev, "Can not allocate memory\n");
628		return -ENOMEM;
629	}
630
631	wm9090->regmap = regmap_init_i2c(i2c, &wm9090_regmap);
632	if (IS_ERR(wm9090->regmap)) {
633		ret = PTR_ERR(wm9090->regmap);
634		dev_err(&i2c->dev, "Failed to allocate regmap: %d\n", ret);
635		return ret;
636	}
637
638	ret = regmap_read(wm9090->regmap, WM9090_SOFTWARE_RESET, &reg);
639	if (ret < 0)
640		goto err;
 
641	if (reg != 0x9093) {
642		dev_err(&i2c->dev, "Device is not a WM9090, ID=%x\n", reg);
643		ret = -ENODEV;
644		goto err;
645	}
646
647	ret = regmap_write(wm9090->regmap, WM9090_SOFTWARE_RESET, 0);
648	if (ret < 0)
649		goto err;
650
651	if (i2c->dev.platform_data)
652		memcpy(&wm9090->pdata, i2c->dev.platform_data,
653		       sizeof(wm9090->pdata));
654
655	i2c_set_clientdata(i2c, wm9090);
656
657	ret =  snd_soc_register_codec(&i2c->dev,
658			&soc_codec_dev_wm9090,  NULL, 0);
659	if (ret != 0) {
660		dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
661		goto err;
662	}
663
664	return 0;
665
666err:
667	regmap_exit(wm9090->regmap);
668	return ret;
669}
670
671static int __devexit wm9090_i2c_remove(struct i2c_client *i2c)
672{
673	struct wm9090_priv *wm9090 = i2c_get_clientdata(i2c);
674
675	snd_soc_unregister_codec(&i2c->dev);
676	regmap_exit(wm9090->regmap);
677
678	return 0;
679}
680
681static const struct i2c_device_id wm9090_id[] = {
682	{ "wm9090", 0 },
683	{ "wm9093", 0 },
684	{ }
685};
686MODULE_DEVICE_TABLE(i2c, wm9090_id);
687
688static struct i2c_driver wm9090_i2c_driver = {
689	.driver = {
690		.name = "wm9090",
691		.owner = THIS_MODULE,
692	},
693	.probe = wm9090_i2c_probe,
694	.remove = __devexit_p(wm9090_i2c_remove),
695	.id_table = wm9090_id,
696};
697
698static int __init wm9090_init(void)
699{
700	return i2c_add_driver(&wm9090_i2c_driver);
701}
702module_init(wm9090_init);
703
704static void __exit wm9090_exit(void)
705{
706	i2c_del_driver(&wm9090_i2c_driver);
707}
708module_exit(wm9090_exit);
709
710MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
711MODULE_DESCRIPTION("WM9090 ASoC driver");
712MODULE_LICENSE("GPL");