Blame view

drivers/mfd/wm8350-irq.c 14.3 KB
e0a3389ab   Mark Brown   mfd: Split wm8350...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
  /*
   * wm8350-irq.c  --  IRQ support for Wolfson WM8350
   *
   * Copyright 2007, 2008, 2009 Wolfson Microelectronics PLC.
   *
   * Author: Liam Girdwood, Mark Brown
   *
   *  This program is free software; you can redistribute  it and/or modify it
   *  under  the terms of  the GNU General  Public License as published by the
   *  Free Software Foundation;  either version 2 of the  License, or (at your
   *  option) any later version.
   *
   */
  
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/bug.h>
  #include <linux/device.h>
  #include <linux/interrupt.h>
760e45187   Mark Brown   mfd: Convert WM83...
21
  #include <linux/irq.h>
e0a3389ab   Mark Brown   mfd: Split wm8350...
22
23
24
25
26
27
28
29
30
  
  #include <linux/mfd/wm8350/core.h>
  #include <linux/mfd/wm8350/audio.h>
  #include <linux/mfd/wm8350/comparator.h>
  #include <linux/mfd/wm8350/gpio.h>
  #include <linux/mfd/wm8350/pmic.h>
  #include <linux/mfd/wm8350/rtc.h>
  #include <linux/mfd/wm8350/supply.h>
  #include <linux/mfd/wm8350/wdt.h>
0c7229f93   Mark Brown   mfd: Convert WM83...
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
  #define WM8350_INT_OFFSET_1                     0
  #define WM8350_INT_OFFSET_2                     1
  #define WM8350_POWER_UP_INT_OFFSET              2
  #define WM8350_UNDER_VOLTAGE_INT_OFFSET         3
  #define WM8350_OVER_CURRENT_INT_OFFSET          4
  #define WM8350_GPIO_INT_OFFSET                  5
  #define WM8350_COMPARATOR_INT_OFFSET            6
  
  struct wm8350_irq_data {
  	int primary;
  	int reg;
  	int mask;
  	int primary_only;
  };
  
  static struct wm8350_irq_data wm8350_irqs[] = {
  	[WM8350_IRQ_OC_LS] = {
  		.primary = WM8350_OC_INT,
  		.reg = WM8350_OVER_CURRENT_INT_OFFSET,
  		.mask = WM8350_OC_LS_EINT,
  		.primary_only = 1,
  	},
  	[WM8350_IRQ_UV_DC1] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC1_EINT,
  	},
  	[WM8350_IRQ_UV_DC2] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC2_EINT,
  	},
  	[WM8350_IRQ_UV_DC3] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC3_EINT,
  	},
  	[WM8350_IRQ_UV_DC4] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC4_EINT,
  	},
  	[WM8350_IRQ_UV_DC5] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC5_EINT,
  	},
  	[WM8350_IRQ_UV_DC6] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_DC6_EINT,
  	},
  	[WM8350_IRQ_UV_LDO1] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_LDO1_EINT,
  	},
  	[WM8350_IRQ_UV_LDO2] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_LDO2_EINT,
  	},
  	[WM8350_IRQ_UV_LDO3] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_LDO3_EINT,
  	},
  	[WM8350_IRQ_UV_LDO4] = {
  		.primary = WM8350_UV_INT,
  		.reg = WM8350_UNDER_VOLTAGE_INT_OFFSET,
  		.mask = WM8350_UV_LDO4_EINT,
  	},
  	[WM8350_IRQ_CHG_BAT_HOT] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_BAT_HOT_EINT,
  	},
  	[WM8350_IRQ_CHG_BAT_COLD] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_BAT_COLD_EINT,
  	},
  	[WM8350_IRQ_CHG_BAT_FAIL] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_BAT_FAIL_EINT,
  	},
  	[WM8350_IRQ_CHG_TO] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_TO_EINT,
  	},
  	[WM8350_IRQ_CHG_END] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_END_EINT,
  	},
  	[WM8350_IRQ_CHG_START] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_START_EINT,
  	},
  	[WM8350_IRQ_CHG_FAST_RDY] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_FAST_RDY_EINT,
  	},
  	[WM8350_IRQ_CHG_VBATT_LT_3P9] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_VBATT_LT_3P9_EINT,
  	},
  	[WM8350_IRQ_CHG_VBATT_LT_3P1] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_VBATT_LT_3P1_EINT,
  	},
  	[WM8350_IRQ_CHG_VBATT_LT_2P85] = {
  		.primary = WM8350_CHG_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_CHG_VBATT_LT_2P85_EINT,
  	},
  	[WM8350_IRQ_RTC_ALM] = {
  		.primary = WM8350_RTC_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_RTC_ALM_EINT,
  	},
  	[WM8350_IRQ_RTC_SEC] = {
  		.primary = WM8350_RTC_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_RTC_SEC_EINT,
  	},
  	[WM8350_IRQ_RTC_PER] = {
  		.primary = WM8350_RTC_INT,
  		.reg = WM8350_INT_OFFSET_1,
  		.mask = WM8350_RTC_PER_EINT,
  	},
  	[WM8350_IRQ_CS1] = {
  		.primary = WM8350_CS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_CS1_EINT,
  	},
  	[WM8350_IRQ_CS2] = {
  		.primary = WM8350_CS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_CS2_EINT,
  	},
  	[WM8350_IRQ_SYS_HYST_COMP_FAIL] = {
  		.primary = WM8350_SYS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_SYS_HYST_COMP_FAIL_EINT,
  	},
  	[WM8350_IRQ_SYS_CHIP_GT115] = {
  		.primary = WM8350_SYS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_SYS_CHIP_GT115_EINT,
  	},
  	[WM8350_IRQ_SYS_CHIP_GT140] = {
  		.primary = WM8350_SYS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_SYS_CHIP_GT140_EINT,
  	},
  	[WM8350_IRQ_SYS_WDOG_TO] = {
  		.primary = WM8350_SYS_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_SYS_WDOG_TO_EINT,
  	},
  	[WM8350_IRQ_AUXADC_DATARDY] = {
  		.primary = WM8350_AUXADC_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_AUXADC_DATARDY_EINT,
  	},
  	[WM8350_IRQ_AUXADC_DCOMP4] = {
  		.primary = WM8350_AUXADC_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_AUXADC_DCOMP4_EINT,
  	},
  	[WM8350_IRQ_AUXADC_DCOMP3] = {
  		.primary = WM8350_AUXADC_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_AUXADC_DCOMP3_EINT,
  	},
  	[WM8350_IRQ_AUXADC_DCOMP2] = {
  		.primary = WM8350_AUXADC_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_AUXADC_DCOMP2_EINT,
  	},
  	[WM8350_IRQ_AUXADC_DCOMP1] = {
  		.primary = WM8350_AUXADC_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_AUXADC_DCOMP1_EINT,
  	},
  	[WM8350_IRQ_USB_LIMIT] = {
  		.primary = WM8350_USB_INT,
  		.reg = WM8350_INT_OFFSET_2,
  		.mask = WM8350_USB_LIMIT_EINT,
  		.primary_only = 1,
  	},
  	[WM8350_IRQ_WKUP_OFF_STATE] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_OFF_STATE_EINT,
  	},
  	[WM8350_IRQ_WKUP_HIB_STATE] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_HIB_STATE_EINT,
  	},
  	[WM8350_IRQ_WKUP_CONV_FAULT] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_CONV_FAULT_EINT,
  	},
  	[WM8350_IRQ_WKUP_WDOG_RST] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_WDOG_RST_EINT,
  	},
  	[WM8350_IRQ_WKUP_GP_PWR_ON] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_GP_PWR_ON_EINT,
  	},
  	[WM8350_IRQ_WKUP_ONKEY] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_ONKEY_EINT,
  	},
  	[WM8350_IRQ_WKUP_GP_WAKEUP] = {
  		.primary = WM8350_WKUP_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_WKUP_GP_WAKEUP_EINT,
  	},
  	[WM8350_IRQ_CODEC_JCK_DET_L] = {
  		.primary = WM8350_CODEC_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_CODEC_JCK_DET_L_EINT,
  	},
  	[WM8350_IRQ_CODEC_JCK_DET_R] = {
  		.primary = WM8350_CODEC_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_CODEC_JCK_DET_R_EINT,
  	},
  	[WM8350_IRQ_CODEC_MICSCD] = {
  		.primary = WM8350_CODEC_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_CODEC_MICSCD_EINT,
  	},
  	[WM8350_IRQ_CODEC_MICD] = {
  		.primary = WM8350_CODEC_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_CODEC_MICD_EINT,
  	},
  	[WM8350_IRQ_EXT_USB_FB] = {
  		.primary = WM8350_EXT_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_EXT_USB_FB_EINT,
  	},
  	[WM8350_IRQ_EXT_WALL_FB] = {
  		.primary = WM8350_EXT_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_EXT_WALL_FB_EINT,
  	},
  	[WM8350_IRQ_EXT_BAT_FB] = {
  		.primary = WM8350_EXT_INT,
  		.reg = WM8350_COMPARATOR_INT_OFFSET,
  		.mask = WM8350_EXT_BAT_FB_EINT,
  	},
  	[WM8350_IRQ_GPIO(0)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP0_EINT,
  	},
  	[WM8350_IRQ_GPIO(1)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP1_EINT,
  	},
  	[WM8350_IRQ_GPIO(2)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP2_EINT,
  	},
  	[WM8350_IRQ_GPIO(3)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP3_EINT,
  	},
  	[WM8350_IRQ_GPIO(4)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP4_EINT,
  	},
  	[WM8350_IRQ_GPIO(5)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP5_EINT,
  	},
  	[WM8350_IRQ_GPIO(6)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP6_EINT,
  	},
  	[WM8350_IRQ_GPIO(7)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP7_EINT,
  	},
  	[WM8350_IRQ_GPIO(8)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP8_EINT,
  	},
  	[WM8350_IRQ_GPIO(9)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP9_EINT,
  	},
  	[WM8350_IRQ_GPIO(10)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP10_EINT,
  	},
  	[WM8350_IRQ_GPIO(11)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP11_EINT,
  	},
  	[WM8350_IRQ_GPIO(12)] = {
  		.primary = WM8350_GP_INT,
  		.reg = WM8350_GPIO_INT_OFFSET,
  		.mask = WM8350_GP12_EINT,
  	},
  };
760e45187   Mark Brown   mfd: Convert WM83...
365
366
  static inline struct wm8350_irq_data *irq_to_wm8350_irq(struct wm8350 *wm8350,
  							int irq)
e0a3389ab   Mark Brown   mfd: Split wm8350...
367
  {
760e45187   Mark Brown   mfd: Convert WM83...
368
  	return &wm8350_irqs[irq - wm8350->irq_base];
e0a3389ab   Mark Brown   mfd: Split wm8350...
369
370
371
372
373
374
375
  }
  
  /*
   * This is a threaded IRQ handler so can access I2C/SPI.  Since all
   * interrupts are clear on read the IRQ line will be reasserted and
   * the physical IRQ will be handled again if another interrupt is
   * asserted while we run - in the normal course of events this is a
760e45187   Mark Brown   mfd: Convert WM83...
376
377
378
   * rare occurrence so we save I2C/SPI reads.  We're also assuming that
   * it's rare to get lots of interrupts firing simultaneously so try to
   * minimise I/O.
e0a3389ab   Mark Brown   mfd: Split wm8350...
379
   */
0c7229f93   Mark Brown   mfd: Convert WM83...
380
  static irqreturn_t wm8350_irq(int irq, void *irq_data)
e0a3389ab   Mark Brown   mfd: Split wm8350...
381
  {
0c7229f93   Mark Brown   mfd: Convert WM83...
382
383
384
385
386
387
  	struct wm8350 *wm8350 = irq_data;
  	u16 level_one;
  	u16 sub_reg[WM8350_NUM_IRQ_REGS];
  	int read_done[WM8350_NUM_IRQ_REGS];
  	struct wm8350_irq_data *data;
  	int i;
e0a3389ab   Mark Brown   mfd: Split wm8350...
388

e0a3389ab   Mark Brown   mfd: Split wm8350...
389
390
  	level_one = wm8350_reg_read(wm8350, WM8350_SYSTEM_INTERRUPTS)
  		& ~wm8350_reg_read(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK);
e0a3389ab   Mark Brown   mfd: Split wm8350...
391

0c7229f93   Mark Brown   mfd: Convert WM83...
392
393
  	if (!level_one)
  		return IRQ_NONE;
e0a3389ab   Mark Brown   mfd: Split wm8350...
394

0c7229f93   Mark Brown   mfd: Convert WM83...
395
  	memset(&read_done, 0, sizeof(read_done));
e0a3389ab   Mark Brown   mfd: Split wm8350...
396

0c7229f93   Mark Brown   mfd: Convert WM83...
397
398
  	for (i = 0; i < ARRAY_SIZE(wm8350_irqs); i++) {
  		data = &wm8350_irqs[i];
e0a3389ab   Mark Brown   mfd: Split wm8350...
399

0c7229f93   Mark Brown   mfd: Convert WM83...
400
401
  		if (!(level_one & data->primary))
  			continue;
e0a3389ab   Mark Brown   mfd: Split wm8350...
402

0c7229f93   Mark Brown   mfd: Convert WM83...
403
404
405
406
  		if (!read_done[data->reg]) {
  			sub_reg[data->reg] =
  				wm8350_reg_read(wm8350, WM8350_INT_STATUS_1 +
  						data->reg);
760e45187   Mark Brown   mfd: Convert WM83...
407
  			sub_reg[data->reg] &= ~wm8350->irq_masks[data->reg];
0c7229f93   Mark Brown   mfd: Convert WM83...
408
  			read_done[data->reg] = 1;
e0a3389ab   Mark Brown   mfd: Split wm8350...
409
  		}
0c7229f93   Mark Brown   mfd: Convert WM83...
410
411
  
  		if (sub_reg[data->reg] & data->mask)
760e45187   Mark Brown   mfd: Convert WM83...
412
  			handle_nested_irq(wm8350->irq_base + i);
e0a3389ab   Mark Brown   mfd: Split wm8350...
413
414
415
416
  	}
  
  	return IRQ_HANDLED;
  }
fdcc475b9   Mark Brown   mfd: Convert WM83...
417
  static void wm8350_irq_lock(struct irq_data *data)
e0a3389ab   Mark Brown   mfd: Split wm8350...
418
  {
25a947f80   Mark Brown   mfd: Convert Wolf...
419
  	struct wm8350 *wm8350 = irq_data_get_irq_chip_data(data);
6a6127462   Mark Brown   mfd: Mask and unm...
420

760e45187   Mark Brown   mfd: Convert WM83...
421
  	mutex_lock(&wm8350->irq_lock);
e0a3389ab   Mark Brown   mfd: Split wm8350...
422
  }
e0a3389ab   Mark Brown   mfd: Split wm8350...
423

fdcc475b9   Mark Brown   mfd: Convert WM83...
424
  static void wm8350_irq_sync_unlock(struct irq_data *data)
e0a3389ab   Mark Brown   mfd: Split wm8350...
425
  {
25a947f80   Mark Brown   mfd: Convert Wolf...
426
  	struct wm8350 *wm8350 = irq_data_get_irq_chip_data(data);
760e45187   Mark Brown   mfd: Convert WM83...
427
  	int i;
e0a3389ab   Mark Brown   mfd: Split wm8350...
428

760e45187   Mark Brown   mfd: Convert WM83...
429
430
431
432
433
434
435
436
437
  	for (i = 0; i < ARRAY_SIZE(wm8350->irq_masks); i++) {
  		/* If there's been a change in the mask write it back
  		 * to the hardware. */
  		if (wm8350->irq_masks[i] !=
  		    wm8350->reg_cache[WM8350_INT_STATUS_1_MASK + i])
  			WARN_ON(wm8350_reg_write(wm8350,
  					 WM8350_INT_STATUS_1_MASK + i,
  						 wm8350->irq_masks[i]));
  	}
6a6127462   Mark Brown   mfd: Mask and unm...
438

760e45187   Mark Brown   mfd: Convert WM83...
439
  	mutex_unlock(&wm8350->irq_lock);
e0a3389ab   Mark Brown   mfd: Split wm8350...
440
  }
e0a3389ab   Mark Brown   mfd: Split wm8350...
441

fdcc475b9   Mark Brown   mfd: Convert WM83...
442
  static void wm8350_irq_enable(struct irq_data *data)
e0a3389ab   Mark Brown   mfd: Split wm8350...
443
  {
25a947f80   Mark Brown   mfd: Convert Wolf...
444
  	struct wm8350 *wm8350 = irq_data_get_irq_chip_data(data);
fdcc475b9   Mark Brown   mfd: Convert WM83...
445
446
  	struct wm8350_irq_data *irq_data = irq_to_wm8350_irq(wm8350,
  							     data->irq);
760e45187   Mark Brown   mfd: Convert WM83...
447
448
  
  	wm8350->irq_masks[irq_data->reg] &= ~irq_data->mask;
e0a3389ab   Mark Brown   mfd: Split wm8350...
449
  }
e0a3389ab   Mark Brown   mfd: Split wm8350...
450

fdcc475b9   Mark Brown   mfd: Convert WM83...
451
  static void wm8350_irq_disable(struct irq_data *data)
e0a3389ab   Mark Brown   mfd: Split wm8350...
452
  {
25a947f80   Mark Brown   mfd: Convert Wolf...
453
  	struct wm8350 *wm8350 = irq_data_get_irq_chip_data(data);
fdcc475b9   Mark Brown   mfd: Convert WM83...
454
455
  	struct wm8350_irq_data *irq_data = irq_to_wm8350_irq(wm8350,
  							     data->irq);
760e45187   Mark Brown   mfd: Convert WM83...
456
457
  
  	wm8350->irq_masks[irq_data->reg] |= irq_data->mask;
e0a3389ab   Mark Brown   mfd: Split wm8350...
458
  }
760e45187   Mark Brown   mfd: Convert WM83...
459
460
  
  static struct irq_chip wm8350_irq_chip = {
fdcc475b9   Mark Brown   mfd: Convert WM83...
461
462
463
464
465
  	.name			= "wm8350",
  	.irq_bus_lock		= wm8350_irq_lock,
  	.irq_bus_sync_unlock	= wm8350_irq_sync_unlock,
  	.irq_disable		= wm8350_irq_disable,
  	.irq_enable		= wm8350_irq_enable,
760e45187   Mark Brown   mfd: Convert WM83...
466
  };
e0a3389ab   Mark Brown   mfd: Split wm8350...
467
468
469
470
  
  int wm8350_irq_init(struct wm8350 *wm8350, int irq,
  		    struct wm8350_platform_data *pdata)
  {
760e45187   Mark Brown   mfd: Convert WM83...
471
  	int ret, cur_irq, i;
e0a3389ab   Mark Brown   mfd: Split wm8350...
472
  	int flags = IRQF_ONESHOT;
d1738aef3   Sascha Hauer   mfd: Allocate wm8...
473
  	int irq_base = -1;
e0a3389ab   Mark Brown   mfd: Split wm8350...
474
475
  
  	if (!irq) {
760e45187   Mark Brown   mfd: Convert WM83...
476
477
478
479
  		dev_warn(wm8350->dev, "No interrupt support, no core IRQ
  ");
  		return 0;
  	}
760e45187   Mark Brown   mfd: Convert WM83...
480
  	/* Mask top level interrupts */
e0a3389ab   Mark Brown   mfd: Split wm8350...
481
  	wm8350_reg_write(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK, 0xFFFF);
e0a3389ab   Mark Brown   mfd: Split wm8350...
482

760e45187   Mark Brown   mfd: Convert WM83...
483
484
485
486
487
488
489
490
491
492
493
494
  	/* Mask all individual interrupts by default and cache the
  	 * masks.  We read the masks back since there are unwritable
  	 * bits in the mask registers. */
  	for (i = 0; i < ARRAY_SIZE(wm8350->irq_masks); i++) {
  		wm8350_reg_write(wm8350, WM8350_INT_STATUS_1_MASK + i,
  				 0xFFFF);
  		wm8350->irq_masks[i] =
  			wm8350_reg_read(wm8350,
  					WM8350_INT_STATUS_1_MASK + i);
  	}
  
  	mutex_init(&wm8350->irq_lock);
e0a3389ab   Mark Brown   mfd: Split wm8350...
495
  	wm8350->chip_irq = irq;
760e45187   Mark Brown   mfd: Convert WM83...
496
  	wm8350->irq_base = pdata->irq_base;
e0a3389ab   Mark Brown   mfd: Split wm8350...
497

d1738aef3   Sascha Hauer   mfd: Allocate wm8...
498
499
500
501
502
503
504
505
506
507
508
509
  	if (pdata && pdata->irq_base > 0)
  		irq_base = pdata->irq_base;
  
  	wm8350->irq_base = irq_alloc_descs(irq_base, 0, ARRAY_SIZE(wm8350_irqs), 0);
  	if (wm8350->irq_base < 0) {
  		dev_warn(wm8350->dev, "Allocating irqs failed with %d
  ",
  			wm8350->irq_base);
  		return 0;
  	}
  
  	if (pdata && pdata->irq_high) {
e0a3389ab   Mark Brown   mfd: Split wm8350...
510
511
512
513
514
515
516
517
518
519
  		flags |= IRQF_TRIGGER_HIGH;
  
  		wm8350_set_bits(wm8350, WM8350_SYSTEM_CONTROL_1,
  				WM8350_IRQ_POL);
  	} else {
  		flags |= IRQF_TRIGGER_LOW;
  
  		wm8350_clear_bits(wm8350, WM8350_SYSTEM_CONTROL_1,
  				  WM8350_IRQ_POL);
  	}
760e45187   Mark Brown   mfd: Convert WM83...
520
521
522
523
  	/* Register with genirq */
  	for (cur_irq = wm8350->irq_base;
  	     cur_irq < ARRAY_SIZE(wm8350_irqs) + wm8350->irq_base;
  	     cur_irq++) {
d5bb12216   Thomas Gleixner   mfd: Cleanup irq ...
524
525
  		irq_set_chip_data(cur_irq, wm8350);
  		irq_set_chip_and_handler(cur_irq, &wm8350_irq_chip,
760e45187   Mark Brown   mfd: Convert WM83...
526
  					 handle_edge_irq);
d5bb12216   Thomas Gleixner   mfd: Cleanup irq ...
527
  		irq_set_nested_thread(cur_irq, 1);
760e45187   Mark Brown   mfd: Convert WM83...
528
529
530
531
532
533
  
  		/* ARM needs us to explicitly flag the IRQ as valid
  		 * and will set them noprobe when we do so. */
  #ifdef CONFIG_ARM
  		set_irq_flags(cur_irq, IRQF_VALID);
  #else
d5bb12216   Thomas Gleixner   mfd: Cleanup irq ...
534
  		irq_set_noprobe(cur_irq);
760e45187   Mark Brown   mfd: Convert WM83...
535
536
  #endif
  	}
e0a3389ab   Mark Brown   mfd: Split wm8350...
537
538
539
540
541
  	ret = request_threaded_irq(irq, NULL, wm8350_irq, flags,
  				   "wm8350", wm8350);
  	if (ret != 0)
  		dev_err(wm8350->dev, "Failed to request IRQ: %d
  ", ret);
760e45187   Mark Brown   mfd: Convert WM83...
542
543
  	/* Allow interrupts to fire */
  	wm8350_reg_write(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK, 0);
e0a3389ab   Mark Brown   mfd: Split wm8350...
544
545
546
547
548
549
550
551
  	return ret;
  }
  
  int wm8350_irq_exit(struct wm8350 *wm8350)
  {
  	free_irq(wm8350->chip_irq, wm8350);
  	return 0;
  }