xref: /OK3568_Linux_fs/kernel/sound/soc/codecs/wm0010.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * wm0010.c  --  WM0010 DSP Driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2012 Wolfson Microelectronics PLC.
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Authors: Mark Brown <broonie@opensource.wolfsonmicro.com>
8*4882a593Smuzhiyun  *          Dimitris Papastamos <dp@opensource.wolfsonmicro.com>
9*4882a593Smuzhiyun  *          Scott Ling <sl@opensource.wolfsonmicro.com>
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/moduleparam.h>
14*4882a593Smuzhiyun #include <linux/interrupt.h>
15*4882a593Smuzhiyun #include <linux/irqreturn.h>
16*4882a593Smuzhiyun #include <linux/init.h>
17*4882a593Smuzhiyun #include <linux/spi/spi.h>
18*4882a593Smuzhiyun #include <linux/firmware.h>
19*4882a593Smuzhiyun #include <linux/delay.h>
20*4882a593Smuzhiyun #include <linux/fs.h>
21*4882a593Smuzhiyun #include <linux/gpio.h>
22*4882a593Smuzhiyun #include <linux/regulator/consumer.h>
23*4882a593Smuzhiyun #include <linux/mutex.h>
24*4882a593Smuzhiyun #include <linux/workqueue.h>
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #include <sound/soc.h>
27*4882a593Smuzhiyun #include <sound/wm0010.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define DEVICE_ID_WM0010	10
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun /* We only support v1 of the .dfw INFO record */
32*4882a593Smuzhiyun #define INFO_VERSION		1
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun enum dfw_cmd {
35*4882a593Smuzhiyun 	DFW_CMD_FUSE = 0x01,
36*4882a593Smuzhiyun 	DFW_CMD_CODE_HDR,
37*4882a593Smuzhiyun 	DFW_CMD_CODE_DATA,
38*4882a593Smuzhiyun 	DFW_CMD_PLL,
39*4882a593Smuzhiyun 	DFW_CMD_INFO = 0xff
40*4882a593Smuzhiyun };
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun struct dfw_binrec {
43*4882a593Smuzhiyun 	u8 command;
44*4882a593Smuzhiyun 	u32 length:24;
45*4882a593Smuzhiyun 	u32 address;
46*4882a593Smuzhiyun 	uint8_t data[];
47*4882a593Smuzhiyun } __packed;
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun struct dfw_inforec {
50*4882a593Smuzhiyun 	u8 info_version;
51*4882a593Smuzhiyun 	u8 tool_major_version;
52*4882a593Smuzhiyun 	u8 tool_minor_version;
53*4882a593Smuzhiyun 	u8 dsp_target;
54*4882a593Smuzhiyun };
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun struct dfw_pllrec {
57*4882a593Smuzhiyun 	u8 command;
58*4882a593Smuzhiyun 	u32 length:24;
59*4882a593Smuzhiyun 	u32 address;
60*4882a593Smuzhiyun 	u32 clkctrl1;
61*4882a593Smuzhiyun 	u32 clkctrl2;
62*4882a593Smuzhiyun 	u32 clkctrl3;
63*4882a593Smuzhiyun 	u32 ldetctrl;
64*4882a593Smuzhiyun 	u32 uart_div;
65*4882a593Smuzhiyun 	u32 spi_div;
66*4882a593Smuzhiyun } __packed;
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun static struct pll_clock_map {
69*4882a593Smuzhiyun 	int max_sysclk;
70*4882a593Smuzhiyun 	int max_pll_spi_speed;
71*4882a593Smuzhiyun 	u32 pll_clkctrl1;
72*4882a593Smuzhiyun } pll_clock_map[] = {			   /* Dividers */
73*4882a593Smuzhiyun 	{ 22000000, 26000000, 0x00201f11 }, /* 2,32,2  */
74*4882a593Smuzhiyun 	{ 18000000, 26000000, 0x00203f21 }, /* 2,64,4  */
75*4882a593Smuzhiyun 	{ 14000000, 26000000, 0x00202620 }, /* 1,39,4  */
76*4882a593Smuzhiyun 	{ 10000000, 22000000, 0x00203120 }, /* 1,50,4  */
77*4882a593Smuzhiyun 	{  6500000, 22000000, 0x00204520 }, /* 1,70,4  */
78*4882a593Smuzhiyun 	{  5500000, 22000000, 0x00103f10 }, /* 1,64,2  */
79*4882a593Smuzhiyun };
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun enum wm0010_state {
82*4882a593Smuzhiyun 	WM0010_POWER_OFF,
83*4882a593Smuzhiyun 	WM0010_OUT_OF_RESET,
84*4882a593Smuzhiyun 	WM0010_BOOTROM,
85*4882a593Smuzhiyun 	WM0010_STAGE2,
86*4882a593Smuzhiyun 	WM0010_FIRMWARE,
87*4882a593Smuzhiyun };
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun struct wm0010_priv {
90*4882a593Smuzhiyun 	struct snd_soc_component *component;
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	struct mutex lock;
93*4882a593Smuzhiyun 	struct device *dev;
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun 	struct wm0010_pdata pdata;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	int gpio_reset;
98*4882a593Smuzhiyun 	int gpio_reset_value;
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	struct regulator_bulk_data core_supplies[2];
101*4882a593Smuzhiyun 	struct regulator *dbvdd;
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	int sysclk;
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	enum wm0010_state state;
106*4882a593Smuzhiyun 	bool boot_failed;
107*4882a593Smuzhiyun 	bool ready;
108*4882a593Smuzhiyun 	bool pll_running;
109*4882a593Smuzhiyun 	int max_spi_freq;
110*4882a593Smuzhiyun 	int board_max_spi_speed;
111*4882a593Smuzhiyun 	u32 pll_clkctrl1;
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	spinlock_t irq_lock;
114*4882a593Smuzhiyun 	int irq;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	struct completion boot_completion;
117*4882a593Smuzhiyun };
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun struct wm0010_spi_msg {
120*4882a593Smuzhiyun 	struct spi_message m;
121*4882a593Smuzhiyun 	struct spi_transfer t;
122*4882a593Smuzhiyun 	u8 *tx_buf;
123*4882a593Smuzhiyun 	u8 *rx_buf;
124*4882a593Smuzhiyun 	size_t len;
125*4882a593Smuzhiyun };
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun static const struct snd_soc_dapm_widget wm0010_dapm_widgets[] = {
128*4882a593Smuzhiyun SND_SOC_DAPM_SUPPLY("CLKIN",  SND_SOC_NOPM, 0, 0, NULL, 0),
129*4882a593Smuzhiyun };
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun static const struct snd_soc_dapm_route wm0010_dapm_routes[] = {
132*4882a593Smuzhiyun 	{ "SDI2 Capture", NULL, "SDI1 Playback" },
133*4882a593Smuzhiyun 	{ "SDI1 Capture", NULL, "SDI2 Playback" },
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	{ "SDI1 Capture", NULL, "CLKIN" },
136*4882a593Smuzhiyun 	{ "SDI2 Capture", NULL, "CLKIN" },
137*4882a593Smuzhiyun 	{ "SDI1 Playback", NULL, "CLKIN" },
138*4882a593Smuzhiyun 	{ "SDI2 Playback", NULL, "CLKIN" },
139*4882a593Smuzhiyun };
140*4882a593Smuzhiyun 
wm0010_state_to_str(enum wm0010_state state)141*4882a593Smuzhiyun static const char *wm0010_state_to_str(enum wm0010_state state)
142*4882a593Smuzhiyun {
143*4882a593Smuzhiyun 	static const char * const state_to_str[] = {
144*4882a593Smuzhiyun 		"Power off",
145*4882a593Smuzhiyun 		"Out of reset",
146*4882a593Smuzhiyun 		"Boot ROM",
147*4882a593Smuzhiyun 		"Stage2",
148*4882a593Smuzhiyun 		"Firmware"
149*4882a593Smuzhiyun 	};
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun 	if (state < 0 || state >= ARRAY_SIZE(state_to_str))
152*4882a593Smuzhiyun 		return "null";
153*4882a593Smuzhiyun 	return state_to_str[state];
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun /* Called with wm0010->lock held */
wm0010_halt(struct snd_soc_component * component)157*4882a593Smuzhiyun static void wm0010_halt(struct snd_soc_component *component)
158*4882a593Smuzhiyun {
159*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
160*4882a593Smuzhiyun 	unsigned long flags;
161*4882a593Smuzhiyun 	enum wm0010_state state;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	/* Fetch the wm0010 state */
164*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
165*4882a593Smuzhiyun 	state = wm0010->state;
166*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	switch (state) {
169*4882a593Smuzhiyun 	case WM0010_POWER_OFF:
170*4882a593Smuzhiyun 		/* If there's nothing to do, bail out */
171*4882a593Smuzhiyun 		return;
172*4882a593Smuzhiyun 	case WM0010_OUT_OF_RESET:
173*4882a593Smuzhiyun 	case WM0010_BOOTROM:
174*4882a593Smuzhiyun 	case WM0010_STAGE2:
175*4882a593Smuzhiyun 	case WM0010_FIRMWARE:
176*4882a593Smuzhiyun 		/* Remember to put chip back into reset */
177*4882a593Smuzhiyun 		gpio_set_value_cansleep(wm0010->gpio_reset,
178*4882a593Smuzhiyun 					wm0010->gpio_reset_value);
179*4882a593Smuzhiyun 		/* Disable the regulators */
180*4882a593Smuzhiyun 		regulator_disable(wm0010->dbvdd);
181*4882a593Smuzhiyun 		regulator_bulk_disable(ARRAY_SIZE(wm0010->core_supplies),
182*4882a593Smuzhiyun 				       wm0010->core_supplies);
183*4882a593Smuzhiyun 		break;
184*4882a593Smuzhiyun 	}
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
187*4882a593Smuzhiyun 	wm0010->state = WM0010_POWER_OFF;
188*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
189*4882a593Smuzhiyun }
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun struct wm0010_boot_xfer {
192*4882a593Smuzhiyun 	struct list_head list;
193*4882a593Smuzhiyun 	struct snd_soc_component *component;
194*4882a593Smuzhiyun 	struct completion *done;
195*4882a593Smuzhiyun 	struct spi_message m;
196*4882a593Smuzhiyun 	struct spi_transfer t;
197*4882a593Smuzhiyun };
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun /* Called with wm0010->lock held */
wm0010_mark_boot_failure(struct wm0010_priv * wm0010)200*4882a593Smuzhiyun static void wm0010_mark_boot_failure(struct wm0010_priv *wm0010)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun 	enum wm0010_state state;
203*4882a593Smuzhiyun 	unsigned long flags;
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
206*4882a593Smuzhiyun 	state = wm0010->state;
207*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	dev_err(wm0010->dev, "Failed to transition from `%s' state to `%s' state\n",
210*4882a593Smuzhiyun 		wm0010_state_to_str(state), wm0010_state_to_str(state + 1));
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	wm0010->boot_failed = true;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun 
wm0010_boot_xfer_complete(void * data)215*4882a593Smuzhiyun static void wm0010_boot_xfer_complete(void *data)
216*4882a593Smuzhiyun {
217*4882a593Smuzhiyun 	struct wm0010_boot_xfer *xfer = data;
218*4882a593Smuzhiyun 	struct snd_soc_component *component = xfer->component;
219*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
220*4882a593Smuzhiyun 	u32 *out32 = xfer->t.rx_buf;
221*4882a593Smuzhiyun 	int i;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	if (xfer->m.status != 0) {
224*4882a593Smuzhiyun 		dev_err(component->dev, "SPI transfer failed: %d\n",
225*4882a593Smuzhiyun 			xfer->m.status);
226*4882a593Smuzhiyun 		wm0010_mark_boot_failure(wm0010);
227*4882a593Smuzhiyun 		if (xfer->done)
228*4882a593Smuzhiyun 			complete(xfer->done);
229*4882a593Smuzhiyun 		return;
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	for (i = 0; i < xfer->t.len / 4; i++) {
233*4882a593Smuzhiyun 		dev_dbg(component->dev, "%d: %04x\n", i, out32[i]);
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 		switch (be32_to_cpu(out32[i])) {
236*4882a593Smuzhiyun 		case 0xe0e0e0e0:
237*4882a593Smuzhiyun 			dev_err(component->dev,
238*4882a593Smuzhiyun 				"%d: ROM error reported in stage 2\n", i);
239*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
240*4882a593Smuzhiyun 			break;
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 		case 0x55555555:
243*4882a593Smuzhiyun 			if (wm0010->state < WM0010_STAGE2)
244*4882a593Smuzhiyun 				break;
245*4882a593Smuzhiyun 			dev_err(component->dev,
246*4882a593Smuzhiyun 				"%d: ROM bootloader running in stage 2\n", i);
247*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
248*4882a593Smuzhiyun 			break;
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 		case 0x0fed0000:
251*4882a593Smuzhiyun 			dev_dbg(component->dev, "Stage2 loader running\n");
252*4882a593Smuzhiyun 			break;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 		case 0x0fed0007:
255*4882a593Smuzhiyun 			dev_dbg(component->dev, "CODE_HDR packet received\n");
256*4882a593Smuzhiyun 			break;
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 		case 0x0fed0008:
259*4882a593Smuzhiyun 			dev_dbg(component->dev, "CODE_DATA packet received\n");
260*4882a593Smuzhiyun 			break;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 		case 0x0fed0009:
263*4882a593Smuzhiyun 			dev_dbg(component->dev, "Download complete\n");
264*4882a593Smuzhiyun 			break;
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 		case 0x0fed000c:
267*4882a593Smuzhiyun 			dev_dbg(component->dev, "Application start\n");
268*4882a593Smuzhiyun 			break;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 		case 0x0fed000e:
271*4882a593Smuzhiyun 			dev_dbg(component->dev, "PLL packet received\n");
272*4882a593Smuzhiyun 			wm0010->pll_running = true;
273*4882a593Smuzhiyun 			break;
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 		case 0x0fed0025:
276*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports image too long\n");
277*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
278*4882a593Smuzhiyun 			break;
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 		case 0x0fed002c:
281*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports bad SPI packet\n");
282*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
283*4882a593Smuzhiyun 			break;
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun 		case 0x0fed0031:
286*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports SPI read overflow\n");
287*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
288*4882a593Smuzhiyun 			break;
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 		case 0x0fed0032:
291*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports SPI underclock\n");
292*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
293*4882a593Smuzhiyun 			break;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 		case 0x0fed0033:
296*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports bad header packet\n");
297*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
298*4882a593Smuzhiyun 			break;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 		case 0x0fed0034:
301*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports invalid packet type\n");
302*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
303*4882a593Smuzhiyun 			break;
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 		case 0x0fed0035:
306*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports data before header error\n");
307*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
308*4882a593Smuzhiyun 			break;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 		case 0x0fed0038:
311*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports invalid PLL packet\n");
312*4882a593Smuzhiyun 			break;
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 		case 0x0fed003a:
315*4882a593Smuzhiyun 			dev_err(component->dev, "Device reports packet alignment error\n");
316*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
317*4882a593Smuzhiyun 			break;
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 		default:
320*4882a593Smuzhiyun 			dev_err(component->dev, "Unrecognised return 0x%x\n",
321*4882a593Smuzhiyun 			    be32_to_cpu(out32[i]));
322*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
323*4882a593Smuzhiyun 			break;
324*4882a593Smuzhiyun 		}
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 		if (wm0010->boot_failed)
327*4882a593Smuzhiyun 			break;
328*4882a593Smuzhiyun 	}
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	if (xfer->done)
331*4882a593Smuzhiyun 		complete(xfer->done);
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun 
byte_swap_64(u64 * data_in,u64 * data_out,u32 len)334*4882a593Smuzhiyun static void byte_swap_64(u64 *data_in, u64 *data_out, u32 len)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun 	int i;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	for (i = 0; i < len / 8; i++)
339*4882a593Smuzhiyun 		data_out[i] = cpu_to_be64(le64_to_cpu(data_in[i]));
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun 
wm0010_firmware_load(const char * name,struct snd_soc_component * component)342*4882a593Smuzhiyun static int wm0010_firmware_load(const char *name, struct snd_soc_component *component)
343*4882a593Smuzhiyun {
344*4882a593Smuzhiyun 	struct spi_device *spi = to_spi_device(component->dev);
345*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
346*4882a593Smuzhiyun 	struct list_head xfer_list;
347*4882a593Smuzhiyun 	struct wm0010_boot_xfer *xfer;
348*4882a593Smuzhiyun 	int ret;
349*4882a593Smuzhiyun 	DECLARE_COMPLETION_ONSTACK(done);
350*4882a593Smuzhiyun 	const struct firmware *fw;
351*4882a593Smuzhiyun 	const struct dfw_binrec *rec;
352*4882a593Smuzhiyun 	const struct dfw_inforec *inforec;
353*4882a593Smuzhiyun 	u64 *img;
354*4882a593Smuzhiyun 	u8 *out, dsp;
355*4882a593Smuzhiyun 	u32 len, offset;
356*4882a593Smuzhiyun 
357*4882a593Smuzhiyun 	INIT_LIST_HEAD(&xfer_list);
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	ret = request_firmware(&fw, name, component->dev);
360*4882a593Smuzhiyun 	if (ret != 0) {
361*4882a593Smuzhiyun 		dev_err(component->dev, "Failed to request application(%s): %d\n",
362*4882a593Smuzhiyun 			name, ret);
363*4882a593Smuzhiyun 		return ret;
364*4882a593Smuzhiyun 	}
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	rec = (const struct dfw_binrec *)fw->data;
367*4882a593Smuzhiyun 	inforec = (const struct dfw_inforec *)rec->data;
368*4882a593Smuzhiyun 	offset = 0;
369*4882a593Smuzhiyun 	dsp = inforec->dsp_target;
370*4882a593Smuzhiyun 	wm0010->boot_failed = false;
371*4882a593Smuzhiyun 	if (WARN_ON(!list_empty(&xfer_list)))
372*4882a593Smuzhiyun 		return -EINVAL;
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	/* First record should be INFO */
375*4882a593Smuzhiyun 	if (rec->command != DFW_CMD_INFO) {
376*4882a593Smuzhiyun 		dev_err(component->dev, "First record not INFO\r\n");
377*4882a593Smuzhiyun 		ret = -EINVAL;
378*4882a593Smuzhiyun 		goto abort;
379*4882a593Smuzhiyun 	}
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	if (inforec->info_version != INFO_VERSION) {
382*4882a593Smuzhiyun 		dev_err(component->dev,
383*4882a593Smuzhiyun 			"Unsupported version (%02d) of INFO record\r\n",
384*4882a593Smuzhiyun 			inforec->info_version);
385*4882a593Smuzhiyun 		ret = -EINVAL;
386*4882a593Smuzhiyun 		goto abort;
387*4882a593Smuzhiyun 	}
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	dev_dbg(component->dev, "Version v%02d INFO record found\r\n",
390*4882a593Smuzhiyun 		inforec->info_version);
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun 	/* Check it's a DSP file */
393*4882a593Smuzhiyun 	if (dsp != DEVICE_ID_WM0010) {
394*4882a593Smuzhiyun 		dev_err(component->dev, "Not a WM0010 firmware file.\r\n");
395*4882a593Smuzhiyun 		ret = -EINVAL;
396*4882a593Smuzhiyun 		goto abort;
397*4882a593Smuzhiyun 	}
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	/* Skip the info record as we don't need to send it */
400*4882a593Smuzhiyun 	offset += ((rec->length) + 8);
401*4882a593Smuzhiyun 	rec = (void *)&rec->data[rec->length];
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 	while (offset < fw->size) {
404*4882a593Smuzhiyun 		dev_dbg(component->dev,
405*4882a593Smuzhiyun 			"Packet: command %d, data length = 0x%x\r\n",
406*4882a593Smuzhiyun 			rec->command, rec->length);
407*4882a593Smuzhiyun 		len = rec->length + 8;
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 		xfer = kzalloc(sizeof(*xfer), GFP_KERNEL);
410*4882a593Smuzhiyun 		if (!xfer) {
411*4882a593Smuzhiyun 			ret = -ENOMEM;
412*4882a593Smuzhiyun 			goto abort;
413*4882a593Smuzhiyun 		}
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 		xfer->component = component;
416*4882a593Smuzhiyun 		list_add_tail(&xfer->list, &xfer_list);
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 		out = kzalloc(len, GFP_KERNEL | GFP_DMA);
419*4882a593Smuzhiyun 		if (!out) {
420*4882a593Smuzhiyun 			ret = -ENOMEM;
421*4882a593Smuzhiyun 			goto abort1;
422*4882a593Smuzhiyun 		}
423*4882a593Smuzhiyun 		xfer->t.rx_buf = out;
424*4882a593Smuzhiyun 
425*4882a593Smuzhiyun 		img = kzalloc(len, GFP_KERNEL | GFP_DMA);
426*4882a593Smuzhiyun 		if (!img) {
427*4882a593Smuzhiyun 			ret = -ENOMEM;
428*4882a593Smuzhiyun 			goto abort1;
429*4882a593Smuzhiyun 		}
430*4882a593Smuzhiyun 		xfer->t.tx_buf = img;
431*4882a593Smuzhiyun 
432*4882a593Smuzhiyun 		byte_swap_64((u64 *)&rec->command, img, len);
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 		spi_message_init(&xfer->m);
435*4882a593Smuzhiyun 		xfer->m.complete = wm0010_boot_xfer_complete;
436*4882a593Smuzhiyun 		xfer->m.context = xfer;
437*4882a593Smuzhiyun 		xfer->t.len = len;
438*4882a593Smuzhiyun 		xfer->t.bits_per_word = 8;
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 		if (!wm0010->pll_running) {
441*4882a593Smuzhiyun 			xfer->t.speed_hz = wm0010->sysclk / 6;
442*4882a593Smuzhiyun 		} else {
443*4882a593Smuzhiyun 			xfer->t.speed_hz = wm0010->max_spi_freq;
444*4882a593Smuzhiyun 
445*4882a593Smuzhiyun 			if (wm0010->board_max_spi_speed &&
446*4882a593Smuzhiyun 			   (wm0010->board_max_spi_speed < wm0010->max_spi_freq))
447*4882a593Smuzhiyun 					xfer->t.speed_hz = wm0010->board_max_spi_speed;
448*4882a593Smuzhiyun 		}
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 		/* Store max usable spi frequency for later use */
451*4882a593Smuzhiyun 		wm0010->max_spi_freq = xfer->t.speed_hz;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 		spi_message_add_tail(&xfer->t, &xfer->m);
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 		offset += ((rec->length) + 8);
456*4882a593Smuzhiyun 		rec = (void *)&rec->data[rec->length];
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 		if (offset >= fw->size) {
459*4882a593Smuzhiyun 			dev_dbg(component->dev, "All transfers scheduled\n");
460*4882a593Smuzhiyun 			xfer->done = &done;
461*4882a593Smuzhiyun 		}
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 		ret = spi_async(spi, &xfer->m);
464*4882a593Smuzhiyun 		if (ret != 0) {
465*4882a593Smuzhiyun 			dev_err(component->dev, "Write failed: %d\n", ret);
466*4882a593Smuzhiyun 			goto abort1;
467*4882a593Smuzhiyun 		}
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 		if (wm0010->boot_failed) {
470*4882a593Smuzhiyun 			dev_dbg(component->dev, "Boot fail!\n");
471*4882a593Smuzhiyun 			ret = -EINVAL;
472*4882a593Smuzhiyun 			goto abort1;
473*4882a593Smuzhiyun 		}
474*4882a593Smuzhiyun 	}
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun 	wait_for_completion(&done);
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	ret = 0;
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun abort1:
481*4882a593Smuzhiyun 	while (!list_empty(&xfer_list)) {
482*4882a593Smuzhiyun 		xfer = list_first_entry(&xfer_list, struct wm0010_boot_xfer,
483*4882a593Smuzhiyun 					list);
484*4882a593Smuzhiyun 		kfree(xfer->t.rx_buf);
485*4882a593Smuzhiyun 		kfree(xfer->t.tx_buf);
486*4882a593Smuzhiyun 		list_del(&xfer->list);
487*4882a593Smuzhiyun 		kfree(xfer);
488*4882a593Smuzhiyun 	}
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun abort:
491*4882a593Smuzhiyun 	release_firmware(fw);
492*4882a593Smuzhiyun 	return ret;
493*4882a593Smuzhiyun }
494*4882a593Smuzhiyun 
wm0010_stage2_load(struct snd_soc_component * component)495*4882a593Smuzhiyun static int wm0010_stage2_load(struct snd_soc_component *component)
496*4882a593Smuzhiyun {
497*4882a593Smuzhiyun 	struct spi_device *spi = to_spi_device(component->dev);
498*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
499*4882a593Smuzhiyun 	const struct firmware *fw;
500*4882a593Smuzhiyun 	struct spi_message m;
501*4882a593Smuzhiyun 	struct spi_transfer t;
502*4882a593Smuzhiyun 	u32 *img;
503*4882a593Smuzhiyun 	u8 *out;
504*4882a593Smuzhiyun 	int i;
505*4882a593Smuzhiyun 	int ret = 0;
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	ret = request_firmware(&fw, "wm0010_stage2.bin", component->dev);
508*4882a593Smuzhiyun 	if (ret != 0) {
509*4882a593Smuzhiyun 		dev_err(component->dev, "Failed to request stage2 loader: %d\n",
510*4882a593Smuzhiyun 			ret);
511*4882a593Smuzhiyun 		return ret;
512*4882a593Smuzhiyun 	}
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	dev_dbg(component->dev, "Downloading %zu byte stage 2 loader\n", fw->size);
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	/* Copy to local buffer first as vmalloc causes problems for dma */
517*4882a593Smuzhiyun 	img = kmemdup(&fw->data[0], fw->size, GFP_KERNEL | GFP_DMA);
518*4882a593Smuzhiyun 	if (!img) {
519*4882a593Smuzhiyun 		ret = -ENOMEM;
520*4882a593Smuzhiyun 		goto abort2;
521*4882a593Smuzhiyun 	}
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	out = kzalloc(fw->size, GFP_KERNEL | GFP_DMA);
524*4882a593Smuzhiyun 	if (!out) {
525*4882a593Smuzhiyun 		ret = -ENOMEM;
526*4882a593Smuzhiyun 		goto abort1;
527*4882a593Smuzhiyun 	}
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	spi_message_init(&m);
530*4882a593Smuzhiyun 	memset(&t, 0, sizeof(t));
531*4882a593Smuzhiyun 	t.rx_buf = out;
532*4882a593Smuzhiyun 	t.tx_buf = img;
533*4882a593Smuzhiyun 	t.len = fw->size;
534*4882a593Smuzhiyun 	t.bits_per_word = 8;
535*4882a593Smuzhiyun 	t.speed_hz = wm0010->sysclk / 10;
536*4882a593Smuzhiyun 	spi_message_add_tail(&t, &m);
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	dev_dbg(component->dev, "Starting initial download at %dHz\n",
539*4882a593Smuzhiyun 		t.speed_hz);
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	ret = spi_sync(spi, &m);
542*4882a593Smuzhiyun 	if (ret != 0) {
543*4882a593Smuzhiyun 		dev_err(component->dev, "Initial download failed: %d\n", ret);
544*4882a593Smuzhiyun 		goto abort;
545*4882a593Smuzhiyun 	}
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	/* Look for errors from the boot ROM */
548*4882a593Smuzhiyun 	for (i = 0; i < fw->size; i++) {
549*4882a593Smuzhiyun 		if (out[i] != 0x55) {
550*4882a593Smuzhiyun 			dev_err(component->dev, "Boot ROM error: %x in %d\n",
551*4882a593Smuzhiyun 				out[i], i);
552*4882a593Smuzhiyun 			wm0010_mark_boot_failure(wm0010);
553*4882a593Smuzhiyun 			ret = -EBUSY;
554*4882a593Smuzhiyun 			goto abort;
555*4882a593Smuzhiyun 		}
556*4882a593Smuzhiyun 	}
557*4882a593Smuzhiyun abort:
558*4882a593Smuzhiyun 	kfree(out);
559*4882a593Smuzhiyun abort1:
560*4882a593Smuzhiyun 	kfree(img);
561*4882a593Smuzhiyun abort2:
562*4882a593Smuzhiyun 	release_firmware(fw);
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	return ret;
565*4882a593Smuzhiyun }
566*4882a593Smuzhiyun 
wm0010_boot(struct snd_soc_component * component)567*4882a593Smuzhiyun static int wm0010_boot(struct snd_soc_component *component)
568*4882a593Smuzhiyun {
569*4882a593Smuzhiyun 	struct spi_device *spi = to_spi_device(component->dev);
570*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
571*4882a593Smuzhiyun 	unsigned long flags;
572*4882a593Smuzhiyun 	int ret;
573*4882a593Smuzhiyun 	struct spi_message m;
574*4882a593Smuzhiyun 	struct spi_transfer t;
575*4882a593Smuzhiyun 	struct dfw_pllrec pll_rec;
576*4882a593Smuzhiyun 	u32 *p, len;
577*4882a593Smuzhiyun 	u64 *img_swap;
578*4882a593Smuzhiyun 	u8 *out;
579*4882a593Smuzhiyun 	int i;
580*4882a593Smuzhiyun 
581*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
582*4882a593Smuzhiyun 	if (wm0010->state != WM0010_POWER_OFF)
583*4882a593Smuzhiyun 		dev_warn(wm0010->dev, "DSP already powered up!\n");
584*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
585*4882a593Smuzhiyun 
586*4882a593Smuzhiyun 	if (wm0010->sysclk > 26000000) {
587*4882a593Smuzhiyun 		dev_err(component->dev, "Max DSP clock frequency is 26MHz\n");
588*4882a593Smuzhiyun 		ret = -ECANCELED;
589*4882a593Smuzhiyun 		goto err;
590*4882a593Smuzhiyun 	}
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 	mutex_lock(&wm0010->lock);
593*4882a593Smuzhiyun 	wm0010->pll_running = false;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	dev_dbg(component->dev, "max_spi_freq: %d\n", wm0010->max_spi_freq);
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 	ret = regulator_bulk_enable(ARRAY_SIZE(wm0010->core_supplies),
598*4882a593Smuzhiyun 				    wm0010->core_supplies);
599*4882a593Smuzhiyun 	if (ret != 0) {
600*4882a593Smuzhiyun 		dev_err(&spi->dev, "Failed to enable core supplies: %d\n",
601*4882a593Smuzhiyun 			ret);
602*4882a593Smuzhiyun 		mutex_unlock(&wm0010->lock);
603*4882a593Smuzhiyun 		goto err;
604*4882a593Smuzhiyun 	}
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	ret = regulator_enable(wm0010->dbvdd);
607*4882a593Smuzhiyun 	if (ret != 0) {
608*4882a593Smuzhiyun 		dev_err(&spi->dev, "Failed to enable DBVDD: %d\n", ret);
609*4882a593Smuzhiyun 		goto err_core;
610*4882a593Smuzhiyun 	}
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 	/* Release reset */
613*4882a593Smuzhiyun 	gpio_set_value_cansleep(wm0010->gpio_reset, !wm0010->gpio_reset_value);
614*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
615*4882a593Smuzhiyun 	wm0010->state = WM0010_OUT_OF_RESET;
616*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	if (!wait_for_completion_timeout(&wm0010->boot_completion,
619*4882a593Smuzhiyun 					 msecs_to_jiffies(20)))
620*4882a593Smuzhiyun 		dev_err(component->dev, "Failed to get interrupt from DSP\n");
621*4882a593Smuzhiyun 
622*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
623*4882a593Smuzhiyun 	wm0010->state = WM0010_BOOTROM;
624*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun 	ret = wm0010_stage2_load(component);
627*4882a593Smuzhiyun 	if (ret)
628*4882a593Smuzhiyun 		goto abort;
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	if (!wait_for_completion_timeout(&wm0010->boot_completion,
631*4882a593Smuzhiyun 					 msecs_to_jiffies(20)))
632*4882a593Smuzhiyun 		dev_err(component->dev, "Failed to get interrupt from DSP loader.\n");
633*4882a593Smuzhiyun 
634*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
635*4882a593Smuzhiyun 	wm0010->state = WM0010_STAGE2;
636*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun 	/* Only initialise PLL if max_spi_freq initialised */
639*4882a593Smuzhiyun 	if (wm0010->max_spi_freq) {
640*4882a593Smuzhiyun 
641*4882a593Smuzhiyun 		/* Initialise a PLL record */
642*4882a593Smuzhiyun 		memset(&pll_rec, 0, sizeof(pll_rec));
643*4882a593Smuzhiyun 		pll_rec.command = DFW_CMD_PLL;
644*4882a593Smuzhiyun 		pll_rec.length = (sizeof(pll_rec) - 8);
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 		/* On wm0010 only the CLKCTRL1 value is used */
647*4882a593Smuzhiyun 		pll_rec.clkctrl1 = wm0010->pll_clkctrl1;
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 		ret = -ENOMEM;
650*4882a593Smuzhiyun 		len = pll_rec.length + 8;
651*4882a593Smuzhiyun 		out = kzalloc(len, GFP_KERNEL | GFP_DMA);
652*4882a593Smuzhiyun 		if (!out)
653*4882a593Smuzhiyun 			goto abort;
654*4882a593Smuzhiyun 
655*4882a593Smuzhiyun 		img_swap = kzalloc(len, GFP_KERNEL | GFP_DMA);
656*4882a593Smuzhiyun 		if (!img_swap)
657*4882a593Smuzhiyun 			goto abort_out;
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 		/* We need to re-order for 0010 */
660*4882a593Smuzhiyun 		byte_swap_64((u64 *)&pll_rec, img_swap, len);
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 		spi_message_init(&m);
663*4882a593Smuzhiyun 		memset(&t, 0, sizeof(t));
664*4882a593Smuzhiyun 		t.rx_buf = out;
665*4882a593Smuzhiyun 		t.tx_buf = img_swap;
666*4882a593Smuzhiyun 		t.len = len;
667*4882a593Smuzhiyun 		t.bits_per_word = 8;
668*4882a593Smuzhiyun 		t.speed_hz = wm0010->sysclk / 6;
669*4882a593Smuzhiyun 		spi_message_add_tail(&t, &m);
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 		ret = spi_sync(spi, &m);
672*4882a593Smuzhiyun 		if (ret) {
673*4882a593Smuzhiyun 			dev_err(component->dev, "First PLL write failed: %d\n", ret);
674*4882a593Smuzhiyun 			goto abort_swap;
675*4882a593Smuzhiyun 		}
676*4882a593Smuzhiyun 
677*4882a593Smuzhiyun 		/* Use a second send of the message to get the return status */
678*4882a593Smuzhiyun 		ret = spi_sync(spi, &m);
679*4882a593Smuzhiyun 		if (ret) {
680*4882a593Smuzhiyun 			dev_err(component->dev, "Second PLL write failed: %d\n", ret);
681*4882a593Smuzhiyun 			goto abort_swap;
682*4882a593Smuzhiyun 		}
683*4882a593Smuzhiyun 
684*4882a593Smuzhiyun 		p = (u32 *)out;
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun 		/* Look for PLL active code from the DSP */
687*4882a593Smuzhiyun 		for (i = 0; i < len / 4; i++) {
688*4882a593Smuzhiyun 			if (*p == 0x0e00ed0f) {
689*4882a593Smuzhiyun 				dev_dbg(component->dev, "PLL packet received\n");
690*4882a593Smuzhiyun 				wm0010->pll_running = true;
691*4882a593Smuzhiyun 				break;
692*4882a593Smuzhiyun 			}
693*4882a593Smuzhiyun 			p++;
694*4882a593Smuzhiyun 		}
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 		kfree(img_swap);
697*4882a593Smuzhiyun 		kfree(out);
698*4882a593Smuzhiyun 	} else
699*4882a593Smuzhiyun 		dev_dbg(component->dev, "Not enabling DSP PLL.");
700*4882a593Smuzhiyun 
701*4882a593Smuzhiyun 	ret = wm0010_firmware_load("wm0010.dfw", component);
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun 	if (ret != 0)
704*4882a593Smuzhiyun 		goto abort;
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	spin_lock_irqsave(&wm0010->irq_lock, flags);
707*4882a593Smuzhiyun 	wm0010->state = WM0010_FIRMWARE;
708*4882a593Smuzhiyun 	spin_unlock_irqrestore(&wm0010->irq_lock, flags);
709*4882a593Smuzhiyun 
710*4882a593Smuzhiyun 	mutex_unlock(&wm0010->lock);
711*4882a593Smuzhiyun 
712*4882a593Smuzhiyun 	return 0;
713*4882a593Smuzhiyun 
714*4882a593Smuzhiyun abort_swap:
715*4882a593Smuzhiyun 	kfree(img_swap);
716*4882a593Smuzhiyun abort_out:
717*4882a593Smuzhiyun 	kfree(out);
718*4882a593Smuzhiyun abort:
719*4882a593Smuzhiyun 	/* Put the chip back into reset */
720*4882a593Smuzhiyun 	wm0010_halt(component);
721*4882a593Smuzhiyun 	mutex_unlock(&wm0010->lock);
722*4882a593Smuzhiyun 	return ret;
723*4882a593Smuzhiyun 
724*4882a593Smuzhiyun err_core:
725*4882a593Smuzhiyun 	mutex_unlock(&wm0010->lock);
726*4882a593Smuzhiyun 	regulator_bulk_disable(ARRAY_SIZE(wm0010->core_supplies),
727*4882a593Smuzhiyun 			       wm0010->core_supplies);
728*4882a593Smuzhiyun err:
729*4882a593Smuzhiyun 	return ret;
730*4882a593Smuzhiyun }
731*4882a593Smuzhiyun 
wm0010_set_bias_level(struct snd_soc_component * component,enum snd_soc_bias_level level)732*4882a593Smuzhiyun static int wm0010_set_bias_level(struct snd_soc_component *component,
733*4882a593Smuzhiyun 				 enum snd_soc_bias_level level)
734*4882a593Smuzhiyun {
735*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
736*4882a593Smuzhiyun 
737*4882a593Smuzhiyun 	switch (level) {
738*4882a593Smuzhiyun 	case SND_SOC_BIAS_ON:
739*4882a593Smuzhiyun 		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_PREPARE)
740*4882a593Smuzhiyun 			wm0010_boot(component);
741*4882a593Smuzhiyun 		break;
742*4882a593Smuzhiyun 	case SND_SOC_BIAS_PREPARE:
743*4882a593Smuzhiyun 		break;
744*4882a593Smuzhiyun 	case SND_SOC_BIAS_STANDBY:
745*4882a593Smuzhiyun 		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_PREPARE) {
746*4882a593Smuzhiyun 			mutex_lock(&wm0010->lock);
747*4882a593Smuzhiyun 			wm0010_halt(component);
748*4882a593Smuzhiyun 			mutex_unlock(&wm0010->lock);
749*4882a593Smuzhiyun 		}
750*4882a593Smuzhiyun 		break;
751*4882a593Smuzhiyun 	case SND_SOC_BIAS_OFF:
752*4882a593Smuzhiyun 		break;
753*4882a593Smuzhiyun 	}
754*4882a593Smuzhiyun 
755*4882a593Smuzhiyun 	return 0;
756*4882a593Smuzhiyun }
757*4882a593Smuzhiyun 
wm0010_set_sysclk(struct snd_soc_component * component,int source,int clk_id,unsigned int freq,int dir)758*4882a593Smuzhiyun static int wm0010_set_sysclk(struct snd_soc_component *component, int source,
759*4882a593Smuzhiyun 			     int clk_id, unsigned int freq, int dir)
760*4882a593Smuzhiyun {
761*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
762*4882a593Smuzhiyun 	unsigned int i;
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 	wm0010->sysclk = freq;
765*4882a593Smuzhiyun 
766*4882a593Smuzhiyun 	if (freq < pll_clock_map[ARRAY_SIZE(pll_clock_map)-1].max_sysclk) {
767*4882a593Smuzhiyun 		wm0010->max_spi_freq = 0;
768*4882a593Smuzhiyun 	} else {
769*4882a593Smuzhiyun 		for (i = 0; i < ARRAY_SIZE(pll_clock_map); i++)
770*4882a593Smuzhiyun 			if (freq >= pll_clock_map[i].max_sysclk) {
771*4882a593Smuzhiyun 				wm0010->max_spi_freq = pll_clock_map[i].max_pll_spi_speed;
772*4882a593Smuzhiyun 				wm0010->pll_clkctrl1 = pll_clock_map[i].pll_clkctrl1;
773*4882a593Smuzhiyun 				break;
774*4882a593Smuzhiyun 			}
775*4882a593Smuzhiyun 	}
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	return 0;
778*4882a593Smuzhiyun }
779*4882a593Smuzhiyun 
780*4882a593Smuzhiyun static int wm0010_probe(struct snd_soc_component *component);
781*4882a593Smuzhiyun 
782*4882a593Smuzhiyun static const struct snd_soc_component_driver soc_component_dev_wm0010 = {
783*4882a593Smuzhiyun 	.probe			= wm0010_probe,
784*4882a593Smuzhiyun 	.set_bias_level		= wm0010_set_bias_level,
785*4882a593Smuzhiyun 	.set_sysclk		= wm0010_set_sysclk,
786*4882a593Smuzhiyun 	.dapm_widgets		= wm0010_dapm_widgets,
787*4882a593Smuzhiyun 	.num_dapm_widgets	= ARRAY_SIZE(wm0010_dapm_widgets),
788*4882a593Smuzhiyun 	.dapm_routes		= wm0010_dapm_routes,
789*4882a593Smuzhiyun 	.num_dapm_routes	= ARRAY_SIZE(wm0010_dapm_routes),
790*4882a593Smuzhiyun 	.use_pmdown_time	= 1,
791*4882a593Smuzhiyun 	.endianness		= 1,
792*4882a593Smuzhiyun 	.non_legacy_dai_naming	= 1,
793*4882a593Smuzhiyun };
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun #define WM0010_RATES (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)
796*4882a593Smuzhiyun #define WM0010_FORMATS (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE |\
797*4882a593Smuzhiyun 			SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S24_LE |\
798*4882a593Smuzhiyun 			SNDRV_PCM_FMTBIT_S32_LE)
799*4882a593Smuzhiyun 
800*4882a593Smuzhiyun static struct snd_soc_dai_driver wm0010_dai[] = {
801*4882a593Smuzhiyun 	{
802*4882a593Smuzhiyun 		.name = "wm0010-sdi1",
803*4882a593Smuzhiyun 		.playback = {
804*4882a593Smuzhiyun 			.stream_name = "SDI1 Playback",
805*4882a593Smuzhiyun 			.channels_min = 1,
806*4882a593Smuzhiyun 			.channels_max = 2,
807*4882a593Smuzhiyun 			.rates = WM0010_RATES,
808*4882a593Smuzhiyun 			.formats = WM0010_FORMATS,
809*4882a593Smuzhiyun 		},
810*4882a593Smuzhiyun 		.capture = {
811*4882a593Smuzhiyun 			 .stream_name = "SDI1 Capture",
812*4882a593Smuzhiyun 			 .channels_min = 1,
813*4882a593Smuzhiyun 			 .channels_max = 2,
814*4882a593Smuzhiyun 			 .rates = WM0010_RATES,
815*4882a593Smuzhiyun 			 .formats = WM0010_FORMATS,
816*4882a593Smuzhiyun 		 },
817*4882a593Smuzhiyun 	},
818*4882a593Smuzhiyun 	{
819*4882a593Smuzhiyun 		.name = "wm0010-sdi2",
820*4882a593Smuzhiyun 		.playback = {
821*4882a593Smuzhiyun 			.stream_name = "SDI2 Playback",
822*4882a593Smuzhiyun 			.channels_min = 1,
823*4882a593Smuzhiyun 			.channels_max = 2,
824*4882a593Smuzhiyun 			.rates = WM0010_RATES,
825*4882a593Smuzhiyun 			.formats = WM0010_FORMATS,
826*4882a593Smuzhiyun 		},
827*4882a593Smuzhiyun 		.capture = {
828*4882a593Smuzhiyun 			 .stream_name = "SDI2 Capture",
829*4882a593Smuzhiyun 			 .channels_min = 1,
830*4882a593Smuzhiyun 			 .channels_max = 2,
831*4882a593Smuzhiyun 			 .rates = WM0010_RATES,
832*4882a593Smuzhiyun 			 .formats = WM0010_FORMATS,
833*4882a593Smuzhiyun 		 },
834*4882a593Smuzhiyun 	},
835*4882a593Smuzhiyun };
836*4882a593Smuzhiyun 
wm0010_irq(int irq,void * data)837*4882a593Smuzhiyun static irqreturn_t wm0010_irq(int irq, void *data)
838*4882a593Smuzhiyun {
839*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = data;
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	switch (wm0010->state) {
842*4882a593Smuzhiyun 	case WM0010_OUT_OF_RESET:
843*4882a593Smuzhiyun 	case WM0010_BOOTROM:
844*4882a593Smuzhiyun 	case WM0010_STAGE2:
845*4882a593Smuzhiyun 		spin_lock(&wm0010->irq_lock);
846*4882a593Smuzhiyun 		complete(&wm0010->boot_completion);
847*4882a593Smuzhiyun 		spin_unlock(&wm0010->irq_lock);
848*4882a593Smuzhiyun 		return IRQ_HANDLED;
849*4882a593Smuzhiyun 	default:
850*4882a593Smuzhiyun 		return IRQ_NONE;
851*4882a593Smuzhiyun 	}
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	return IRQ_NONE;
854*4882a593Smuzhiyun }
855*4882a593Smuzhiyun 
wm0010_probe(struct snd_soc_component * component)856*4882a593Smuzhiyun static int wm0010_probe(struct snd_soc_component *component)
857*4882a593Smuzhiyun {
858*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = snd_soc_component_get_drvdata(component);
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun 	wm0010->component = component;
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun 	return 0;
863*4882a593Smuzhiyun }
864*4882a593Smuzhiyun 
wm0010_spi_probe(struct spi_device * spi)865*4882a593Smuzhiyun static int wm0010_spi_probe(struct spi_device *spi)
866*4882a593Smuzhiyun {
867*4882a593Smuzhiyun 	unsigned long gpio_flags;
868*4882a593Smuzhiyun 	int ret;
869*4882a593Smuzhiyun 	int trigger;
870*4882a593Smuzhiyun 	int irq;
871*4882a593Smuzhiyun 	struct wm0010_priv *wm0010;
872*4882a593Smuzhiyun 
873*4882a593Smuzhiyun 	wm0010 = devm_kzalloc(&spi->dev, sizeof(*wm0010),
874*4882a593Smuzhiyun 			      GFP_KERNEL);
875*4882a593Smuzhiyun 	if (!wm0010)
876*4882a593Smuzhiyun 		return -ENOMEM;
877*4882a593Smuzhiyun 
878*4882a593Smuzhiyun 	mutex_init(&wm0010->lock);
879*4882a593Smuzhiyun 	spin_lock_init(&wm0010->irq_lock);
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun 	spi_set_drvdata(spi, wm0010);
882*4882a593Smuzhiyun 	wm0010->dev = &spi->dev;
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	if (dev_get_platdata(&spi->dev))
885*4882a593Smuzhiyun 		memcpy(&wm0010->pdata, dev_get_platdata(&spi->dev),
886*4882a593Smuzhiyun 		       sizeof(wm0010->pdata));
887*4882a593Smuzhiyun 
888*4882a593Smuzhiyun 	init_completion(&wm0010->boot_completion);
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun 	wm0010->core_supplies[0].supply = "AVDD";
891*4882a593Smuzhiyun 	wm0010->core_supplies[1].supply = "DCVDD";
892*4882a593Smuzhiyun 	ret = devm_regulator_bulk_get(wm0010->dev, ARRAY_SIZE(wm0010->core_supplies),
893*4882a593Smuzhiyun 				      wm0010->core_supplies);
894*4882a593Smuzhiyun 	if (ret != 0) {
895*4882a593Smuzhiyun 		dev_err(wm0010->dev, "Failed to obtain core supplies: %d\n",
896*4882a593Smuzhiyun 			ret);
897*4882a593Smuzhiyun 		return ret;
898*4882a593Smuzhiyun 	}
899*4882a593Smuzhiyun 
900*4882a593Smuzhiyun 	wm0010->dbvdd = devm_regulator_get(wm0010->dev, "DBVDD");
901*4882a593Smuzhiyun 	if (IS_ERR(wm0010->dbvdd)) {
902*4882a593Smuzhiyun 		ret = PTR_ERR(wm0010->dbvdd);
903*4882a593Smuzhiyun 		dev_err(wm0010->dev, "Failed to obtain DBVDD: %d\n", ret);
904*4882a593Smuzhiyun 		return ret;
905*4882a593Smuzhiyun 	}
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	if (wm0010->pdata.gpio_reset) {
908*4882a593Smuzhiyun 		wm0010->gpio_reset = wm0010->pdata.gpio_reset;
909*4882a593Smuzhiyun 
910*4882a593Smuzhiyun 		if (wm0010->pdata.reset_active_high)
911*4882a593Smuzhiyun 			wm0010->gpio_reset_value = 1;
912*4882a593Smuzhiyun 		else
913*4882a593Smuzhiyun 			wm0010->gpio_reset_value = 0;
914*4882a593Smuzhiyun 
915*4882a593Smuzhiyun 		if (wm0010->gpio_reset_value)
916*4882a593Smuzhiyun 			gpio_flags = GPIOF_OUT_INIT_HIGH;
917*4882a593Smuzhiyun 		else
918*4882a593Smuzhiyun 			gpio_flags = GPIOF_OUT_INIT_LOW;
919*4882a593Smuzhiyun 
920*4882a593Smuzhiyun 		ret = devm_gpio_request_one(wm0010->dev, wm0010->gpio_reset,
921*4882a593Smuzhiyun 					    gpio_flags, "wm0010 reset");
922*4882a593Smuzhiyun 		if (ret < 0) {
923*4882a593Smuzhiyun 			dev_err(wm0010->dev,
924*4882a593Smuzhiyun 				"Failed to request GPIO for DSP reset: %d\n",
925*4882a593Smuzhiyun 				ret);
926*4882a593Smuzhiyun 			return ret;
927*4882a593Smuzhiyun 		}
928*4882a593Smuzhiyun 	} else {
929*4882a593Smuzhiyun 		dev_err(wm0010->dev, "No reset GPIO configured\n");
930*4882a593Smuzhiyun 		return -EINVAL;
931*4882a593Smuzhiyun 	}
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 	wm0010->state = WM0010_POWER_OFF;
934*4882a593Smuzhiyun 
935*4882a593Smuzhiyun 	irq = spi->irq;
936*4882a593Smuzhiyun 	if (wm0010->pdata.irq_flags)
937*4882a593Smuzhiyun 		trigger = wm0010->pdata.irq_flags;
938*4882a593Smuzhiyun 	else
939*4882a593Smuzhiyun 		trigger = IRQF_TRIGGER_FALLING;
940*4882a593Smuzhiyun 	trigger |= IRQF_ONESHOT;
941*4882a593Smuzhiyun 
942*4882a593Smuzhiyun 	ret = request_threaded_irq(irq, NULL, wm0010_irq, trigger,
943*4882a593Smuzhiyun 				   "wm0010", wm0010);
944*4882a593Smuzhiyun 	if (ret) {
945*4882a593Smuzhiyun 		dev_err(wm0010->dev, "Failed to request IRQ %d: %d\n",
946*4882a593Smuzhiyun 			irq, ret);
947*4882a593Smuzhiyun 		return ret;
948*4882a593Smuzhiyun 	}
949*4882a593Smuzhiyun 	wm0010->irq = irq;
950*4882a593Smuzhiyun 
951*4882a593Smuzhiyun 	ret = irq_set_irq_wake(irq, 1);
952*4882a593Smuzhiyun 	if (ret) {
953*4882a593Smuzhiyun 		dev_err(wm0010->dev, "Failed to set IRQ %d as wake source: %d\n",
954*4882a593Smuzhiyun 			irq, ret);
955*4882a593Smuzhiyun 		return ret;
956*4882a593Smuzhiyun 	}
957*4882a593Smuzhiyun 
958*4882a593Smuzhiyun 	if (spi->max_speed_hz)
959*4882a593Smuzhiyun 		wm0010->board_max_spi_speed = spi->max_speed_hz;
960*4882a593Smuzhiyun 	else
961*4882a593Smuzhiyun 		wm0010->board_max_spi_speed = 0;
962*4882a593Smuzhiyun 
963*4882a593Smuzhiyun 	ret = devm_snd_soc_register_component(&spi->dev,
964*4882a593Smuzhiyun 				     &soc_component_dev_wm0010, wm0010_dai,
965*4882a593Smuzhiyun 				     ARRAY_SIZE(wm0010_dai));
966*4882a593Smuzhiyun 	if (ret < 0)
967*4882a593Smuzhiyun 		return ret;
968*4882a593Smuzhiyun 
969*4882a593Smuzhiyun 	return 0;
970*4882a593Smuzhiyun }
971*4882a593Smuzhiyun 
wm0010_spi_remove(struct spi_device * spi)972*4882a593Smuzhiyun static int wm0010_spi_remove(struct spi_device *spi)
973*4882a593Smuzhiyun {
974*4882a593Smuzhiyun 	struct wm0010_priv *wm0010 = spi_get_drvdata(spi);
975*4882a593Smuzhiyun 
976*4882a593Smuzhiyun 	gpio_set_value_cansleep(wm0010->gpio_reset,
977*4882a593Smuzhiyun 				wm0010->gpio_reset_value);
978*4882a593Smuzhiyun 
979*4882a593Smuzhiyun 	irq_set_irq_wake(wm0010->irq, 0);
980*4882a593Smuzhiyun 
981*4882a593Smuzhiyun 	if (wm0010->irq)
982*4882a593Smuzhiyun 		free_irq(wm0010->irq, wm0010);
983*4882a593Smuzhiyun 
984*4882a593Smuzhiyun 	return 0;
985*4882a593Smuzhiyun }
986*4882a593Smuzhiyun 
987*4882a593Smuzhiyun static struct spi_driver wm0010_spi_driver = {
988*4882a593Smuzhiyun 	.driver = {
989*4882a593Smuzhiyun 		.name	= "wm0010",
990*4882a593Smuzhiyun 	},
991*4882a593Smuzhiyun 	.probe		= wm0010_spi_probe,
992*4882a593Smuzhiyun 	.remove		= wm0010_spi_remove,
993*4882a593Smuzhiyun };
994*4882a593Smuzhiyun 
995*4882a593Smuzhiyun module_spi_driver(wm0010_spi_driver);
996*4882a593Smuzhiyun 
997*4882a593Smuzhiyun MODULE_DESCRIPTION("ASoC WM0010 driver");
998*4882a593Smuzhiyun MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
999*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1000