mfd: Convert 88pm860x to use regmap api
[linux-2.6.git] / drivers / mfd / ab5500-core.c
1 /*
2  * Copyright (C) 2007-2011 ST-Ericsson
3  * License terms: GNU General Public License (GPL) version 2
4  * Low-level core for exclusive access to the AB5500 IC on the I2C bus
5  * and some basic chip-configuration.
6  * Author: Bengt Jonsson <bengt.g.jonsson@stericsson.com>
7  * Author: Mattias Nilsson <mattias.i.nilsson@stericsson.com>
8  * Author: Mattias Wallin <mattias.wallin@stericsson.com>
9  * Author: Rickard Andersson <rickard.andersson@stericsson.com>
10  * Author: Karl Komierowski  <karl.komierowski@stericsson.com>
11  * Author: Bibek Basu <bibek.basu@stericsson.com>
12  *
13  * TODO: Event handling with irq_chip. Waiting for PRCMU fw support.
14  */
15
16 #include <linux/module.h>
17 #include <linux/mutex.h>
18 #include <linux/err.h>
19 #include <linux/platform_device.h>
20 #include <linux/slab.h>
21 #include <linux/device.h>
22 #include <linux/irq.h>
23 #include <linux/interrupt.h>
24 #include <linux/random.h>
25 #include <linux/mfd/ab5500/ab5500.h>
26 #include <linux/mfd/abx500.h>
27 #include <linux/list.h>
28 #include <linux/bitops.h>
29 #include <linux/spinlock.h>
30 #include <linux/mfd/core.h>
31 #include <linux/version.h>
32 #include <linux/mfd/db5500-prcmu.h>
33
34 #include "ab5500-core.h"
35 #include "ab5500-debugfs.h"
36
37 #define AB5500_NUM_EVENT_REG 23
38 #define AB5500_IT_LATCH0_REG 0x40
39 #define AB5500_IT_MASK0_REG 0x60
40
41 /*
42  * Permissible register ranges for reading and writing per device and bank.
43  *
44  * The ranges must be listed in increasing address order, and no overlaps are
45  * allowed. It is assumed that write permission implies read permission
46  * (i.e. only RO and RW permissions should be used).  Ranges with write
47  * permission must not be split up.
48  */
49
50 #define NO_RANGE {.count = 0, .range = NULL,}
51 static struct ab5500_i2c_banks ab5500_bank_ranges[AB5500_NUM_DEVICES] = {
52         [AB5500_DEVID_USB] =  {
53                 .nbanks = 1,
54                 .bank = (struct ab5500_i2c_ranges []) {
55                         {
56                                 .bankid = AB5500_BANK_USB,
57                                 .nranges = 12,
58                                 .range = (struct ab5500_reg_range[]) {
59                                         {
60                                                 .first = 0x01,
61                                                 .last = 0x01,
62                                                 .perm = AB5500_PERM_RW,
63                                         },
64                                         {
65                                                 .first = 0x80,
66                                                 .last = 0x83,
67                                                 .perm = AB5500_PERM_RW,
68                                         },
69                                         {
70                                                 .first = 0x87,
71                                                 .last = 0x8A,
72                                                 .perm = AB5500_PERM_RW,
73                                         },
74                                         {
75                                                 .first = 0x8B,
76                                                 .last = 0x8B,
77                                                 .perm = AB5500_PERM_RO,
78                                         },
79                                         {
80                                                 .first = 0x91,
81                                                 .last = 0x92,
82                                                 .perm = AB5500_PERM_RO,
83                                         },
84                                         {
85                                                 .first = 0x93,
86                                                 .last = 0x93,
87                                                 .perm = AB5500_PERM_RW,
88                                         },
89                                         {
90                                                 .first = 0x94,
91                                                 .last = 0x94,
92                                                 .perm = AB5500_PERM_RO,
93                                         },
94                                         {
95                                                 .first = 0xA8,
96                                                 .last = 0xB0,
97                                                 .perm = AB5500_PERM_RO,
98                                         },
99                                         {
100                                                 .first = 0xB2,
101                                                 .last = 0xB2,
102                                                 .perm = AB5500_PERM_RO,
103                                         },
104                                         {
105                                                 .first = 0xB4,
106                                                 .last = 0xBC,
107                                                 .perm = AB5500_PERM_RO,
108                                         },
109                                         {
110                                                 .first = 0xBF,
111                                                 .last = 0xBF,
112                                                 .perm = AB5500_PERM_RO,
113                                         },
114                                         {
115                                                 .first = 0xC1,
116                                                 .last = 0xC5,
117                                                 .perm = AB5500_PERM_RO,
118                                         },
119                                 },
120                         },
121                 },
122         },
123         [AB5500_DEVID_ADC] =  {
124                 .nbanks = 1,
125                 .bank = (struct ab5500_i2c_ranges []) {
126                         {
127                                 .bankid = AB5500_BANK_ADC,
128                                 .nranges = 6,
129                                 .range = (struct ab5500_reg_range[]) {
130                                         {
131                                                 .first = 0x1F,
132                                                 .last = 0x22,
133                                                 .perm = AB5500_PERM_RO,
134                                         },
135                                         {
136                                                 .first = 0x23,
137                                                 .last = 0x24,
138                                                 .perm = AB5500_PERM_RW,
139                                         },
140                                         {
141                                                 .first = 0x26,
142                                                 .last = 0x2D,
143                                                 .perm = AB5500_PERM_RO,
144                                         },
145                                         {
146                                                 .first = 0x2F,
147                                                 .last = 0x34,
148                                                 .perm = AB5500_PERM_RW,
149                                         },
150                                         {
151                                                 .first = 0x37,
152                                                 .last = 0x57,
153                                                 .perm = AB5500_PERM_RW,
154                                         },
155                                         {
156                                                 .first = 0x58,
157                                                 .last = 0x58,
158                                                 .perm = AB5500_PERM_RO,
159                                         },
160                                 },
161                         },
162                 },
163         },
164         [AB5500_DEVID_LEDS] =  {
165                 .nbanks = 1,
166                 .bank = (struct ab5500_i2c_ranges []) {
167                         {
168                                 .bankid = AB5500_BANK_LED,
169                                 .nranges = 1,
170                                 .range = (struct ab5500_reg_range[]) {
171                                         {
172                                                 .first = 0x00,
173                                                 .last = 0x0C,
174                                                 .perm = AB5500_PERM_RW,
175                                         },
176                                 },
177                         },
178                 },
179         },
180         [AB5500_DEVID_VIDEO] =   {
181                 .nbanks = 1,
182                 .bank = (struct ab5500_i2c_ranges []) {
183                         {
184                                 .bankid = AB5500_BANK_VDENC,
185                                 .nranges = 12,
186                                 .range = (struct ab5500_reg_range[]) {
187                                         {
188                                                 .first = 0x00,
189                                                 .last = 0x08,
190                                                 .perm = AB5500_PERM_RW,
191                                         },
192                                         {
193                                                 .first = 0x09,
194                                                 .last = 0x09,
195                                                 .perm = AB5500_PERM_RO,
196                                         },
197                                         {
198                                                 .first = 0x0A,
199                                                 .last = 0x12,
200                                                 .perm = AB5500_PERM_RW,
201                                         },
202                                         {
203                                                 .first = 0x15,
204                                                 .last = 0x19,
205                                                 .perm = AB5500_PERM_RW,
206                                         },
207                                         {
208                                                 .first = 0x1B,
209                                                 .last = 0x21,
210                                                 .perm = AB5500_PERM_RW,
211                                         },
212                                         {
213                                                 .first = 0x27,
214                                                 .last = 0x2C,
215                                                 .perm = AB5500_PERM_RW,
216                                         },
217                                         {
218                                                 .first = 0x41,
219                                                 .last = 0x41,
220                                                 .perm = AB5500_PERM_RW,
221                                         },
222                                         {
223                                                 .first = 0x45,
224                                                 .last = 0x5B,
225                                                 .perm = AB5500_PERM_RW,
226                                         },
227                                         {
228                                                 .first = 0x5D,
229                                                 .last = 0x5D,
230                                                 .perm = AB5500_PERM_RW,
231                                         },
232                                         {
233                                                 .first = 0x69,
234                                                 .last = 0x69,
235                                                 .perm = AB5500_PERM_RW,
236                                         },
237                                         {
238                                                 .first = 0x6C,
239                                                 .last = 0x6D,
240                                                 .perm = AB5500_PERM_RW,
241                                         },
242                                         {
243                                                 .first = 0x80,
244                                                 .last = 0x81,
245                                                 .perm = AB5500_PERM_RW,
246                                         },
247                                 },
248                         },
249                 },
250         },
251         [AB5500_DEVID_REGULATORS] =   {
252                 .nbanks = 2,
253                 .bank =  (struct ab5500_i2c_ranges []) {
254                         {
255                                 .bankid = AB5500_BANK_STARTUP,
256                                 .nranges = 12,
257                                 .range = (struct ab5500_reg_range[]) {
258                                         {
259                                                 .first = 0x00,
260                                                 .last = 0x01,
261                                                 .perm = AB5500_PERM_RW,
262                                         },
263                                         {
264                                                 .first = 0x1F,
265                                                 .last = 0x1F,
266                                                 .perm = AB5500_PERM_RW,
267                                         },
268                                         {
269                                                 .first = 0x2E,
270                                                 .last = 0x2E,
271                                                 .perm = AB5500_PERM_RO,
272                                         },
273                                         {
274                                                 .first = 0x2F,
275                                                 .last = 0x30,
276                                                 .perm = AB5500_PERM_RW,
277                                         },
278                                         {
279                                                 .first = 0x50,
280                                                 .last = 0x51,
281                                                 .perm = AB5500_PERM_RW,
282                                         },
283                                         {
284                                                 .first = 0x60,
285                                                 .last = 0x61,
286                                                 .perm = AB5500_PERM_RW,
287                                         },
288                                         {
289                                                 .first = 0x66,
290                                                 .last = 0x8A,
291                                                 .perm = AB5500_PERM_RW,
292                                         },
293                                         {
294                                                 .first = 0x8C,
295                                                 .last = 0x96,
296                                                 .perm = AB5500_PERM_RW,
297                                         },
298                                         {
299                                                 .first = 0xAA,
300                                                 .last = 0xB4,
301                                                 .perm = AB5500_PERM_RW,
302                                         },
303                                         {
304                                                 .first = 0xB7,
305                                                 .last = 0xBF,
306                                                 .perm = AB5500_PERM_RW,
307                                         },
308                                         {
309                                                 .first = 0xC1,
310                                                 .last = 0xCA,
311                                                 .perm = AB5500_PERM_RW,
312                                         },
313                                         {
314                                                 .first = 0xD3,
315                                                 .last = 0xE0,
316                                                 .perm = AB5500_PERM_RW,
317                                         },
318                                 },
319                         },
320                         {
321                                 .bankid = AB5500_BANK_SIM_USBSIM,
322                                 .nranges = 1,
323                                 .range = (struct ab5500_reg_range[]) {
324                                         {
325                                                 .first = 0x13,
326                                                 .last = 0x19,
327                                                 .perm = AB5500_PERM_RW,
328                                         },
329                                 },
330                         },
331                 },
332         },
333         [AB5500_DEVID_SIM] =   {
334                 .nbanks = 1,
335                 .bank = (struct ab5500_i2c_ranges []) {
336                         {
337                                 .bankid = AB5500_BANK_SIM_USBSIM,
338                                 .nranges = 1,
339                                 .range = (struct ab5500_reg_range[]) {
340                                         {
341                                                 .first = 0x13,
342                                                 .last = 0x19,
343                                                 .perm = AB5500_PERM_RW,
344                                         },
345                                 },
346                         },
347                 },
348         },
349         [AB5500_DEVID_RTC] =   {
350                 .nbanks = 1,
351                 .bank = (struct ab5500_i2c_ranges []) {
352                         {
353                                 .bankid = AB5500_BANK_RTC,
354                                 .nranges = 2,
355                                 .range = (struct ab5500_reg_range[]) {
356                                         {
357                                                 .first = 0x00,
358                                                 .last = 0x04,
359                                                 .perm = AB5500_PERM_RW,
360                                         },
361                                         {
362                                                 .first = 0x06,
363                                                 .last = 0x0C,
364                                                 .perm = AB5500_PERM_RW,
365                                         },
366                                 },
367                         },
368                 },
369         },
370         [AB5500_DEVID_CHARGER] =   {
371                 .nbanks = 1,
372                 .bank = (struct ab5500_i2c_ranges []) {
373                         {
374                                 .bankid = AB5500_BANK_CHG,
375                                 .nranges = 2,
376                                 .range = (struct ab5500_reg_range[]) {
377                                         {
378                                                 .first = 0x11,
379                                                 .last = 0x11,
380                                                 .perm = AB5500_PERM_RO,
381                                         },
382                                         {
383                                                 .first = 0x12,
384                                                 .last = 0x1B,
385                                                 .perm = AB5500_PERM_RW,
386                                         },
387                                 },
388                         },
389                 },
390         },
391         [AB5500_DEVID_FUELGAUGE] =   {
392                 .nbanks = 1,
393                 .bank = (struct ab5500_i2c_ranges []) {
394                         {
395                                 .bankid = AB5500_BANK_FG_BATTCOM_ACC,
396                                 .nranges = 2,
397                                 .range = (struct ab5500_reg_range[]) {
398                                         {
399                                                 .first = 0x00,
400                                                 .last = 0x0B,
401                                                 .perm = AB5500_PERM_RO,
402                                         },
403                                         {
404                                                 .first = 0x0C,
405                                                 .last = 0x10,
406                                                 .perm = AB5500_PERM_RW,
407                                         },
408                                 },
409                         },
410                 },
411         },
412         [AB5500_DEVID_VIBRATOR] =   {
413                 .nbanks = 1,
414                 .bank = (struct ab5500_i2c_ranges []) {
415                         {
416                                 .bankid = AB5500_BANK_VIBRA,
417                                 .nranges = 2,
418                                 .range = (struct ab5500_reg_range[]) {
419                                         {
420                                                 .first = 0x10,
421                                                 .last = 0x13,
422                                                 .perm = AB5500_PERM_RW,
423                                         },
424                                         {
425                                                 .first = 0xFE,
426                                                 .last = 0xFE,
427                                                 .perm = AB5500_PERM_RW,
428                                         },
429                                 },
430                         },
431                 },
432         },
433         [AB5500_DEVID_CODEC] =   {
434                 .nbanks = 1,
435                 .bank = (struct ab5500_i2c_ranges []) {
436                         {
437                                 .bankid = AB5500_BANK_AUDIO_HEADSETUSB,
438                                 .nranges = 2,
439                                 .range = (struct ab5500_reg_range[]) {
440                                         {
441                                                 .first = 0x00,
442                                                 .last = 0x48,
443                                                 .perm = AB5500_PERM_RW,
444                                         },
445                                         {
446                                                 .first = 0xEB,
447                                                 .last = 0xFB,
448                                                 .perm = AB5500_PERM_RW,
449                                         },
450                                 },
451                         },
452                 },
453         },
454         [AB5500_DEVID_POWER] = {
455                 .nbanks = 2,
456                 .bank   = (struct ab5500_i2c_ranges []) {
457                         {
458                                 .bankid = AB5500_BANK_STARTUP,
459                                 .nranges = 1,
460                                 .range = (struct ab5500_reg_range[]) {
461                                         {
462                                                 .first = 0x30,
463                                                 .last = 0x30,
464                                                 .perm = AB5500_PERM_RW,
465                                         },
466                                 },
467                         },
468                         {
469                                 .bankid = AB5500_BANK_VIT_IO_I2C_CLK_TST_OTP,
470                                 .nranges = 1,
471                                 .range = (struct ab5500_reg_range[]) {
472                                         {
473                                                 .first = 0x01,
474                                                 .last = 0x01,
475                                                 .perm = AB5500_PERM_RW,
476                                         },
477                                 },
478                         },
479                 },
480         },
481 };
482
483 #define AB5500_IRQ(bank, bit)   ((bank) * 8 + (bit))
484
485 /* I appologize for the resource names beeing a mix of upper case
486  * and lower case but I want them to be exact as the documentation */
487 static struct mfd_cell ab5500_devs[AB5500_NUM_DEVICES] = {
488         [AB5500_DEVID_LEDS] = {
489                 .name = "ab5500-leds",
490                 .id = AB5500_DEVID_LEDS,
491         },
492         [AB5500_DEVID_POWER] = {
493                 .name = "ab5500-power",
494                 .id = AB5500_DEVID_POWER,
495         },
496         [AB5500_DEVID_REGULATORS] = {
497                 .name = "ab5500-regulator",
498                 .id = AB5500_DEVID_REGULATORS,
499         },
500         [AB5500_DEVID_SIM] = {
501                 .name = "ab5500-sim",
502                 .id = AB5500_DEVID_SIM,
503                 .num_resources = 1,
504                 .resources = (struct resource[]) {
505                         {
506                                 .name = "SIMOFF",
507                                 .flags = IORESOURCE_IRQ,
508                                 .start = AB5500_IRQ(2, 0), /*rising*/
509                                 .end = AB5500_IRQ(2, 1), /*falling*/
510                         },
511                 },
512         },
513         [AB5500_DEVID_RTC] = {
514                 .name = "ab5500-rtc",
515                 .id = AB5500_DEVID_RTC,
516                 .num_resources = 1,
517                 .resources = (struct resource[]) {
518                         {
519                                 .name   = "RTC_Alarm",
520                                 .flags  = IORESOURCE_IRQ,
521                                 .start  = AB5500_IRQ(1, 7),
522                                 .end    = AB5500_IRQ(1, 7),
523                         }
524                 },
525         },
526         [AB5500_DEVID_CHARGER] = {
527                 .name = "ab5500-charger",
528                 .id = AB5500_DEVID_CHARGER,
529         },
530         [AB5500_DEVID_ADC] = {
531                 .name = "ab5500-adc",
532                 .id = AB5500_DEVID_ADC,
533                 .num_resources = 10,
534                 .resources = (struct resource[]) {
535                         {
536                                 .name = "TRIGGER-0",
537                                 .flags = IORESOURCE_IRQ,
538                                 .start = AB5500_IRQ(0, 0),
539                                 .end = AB5500_IRQ(0, 0),
540                         },
541                         {
542                                 .name = "TRIGGER-1",
543                                 .flags = IORESOURCE_IRQ,
544                                 .start = AB5500_IRQ(0, 1),
545                                 .end = AB5500_IRQ(0, 1),
546                         },
547                         {
548                                 .name = "TRIGGER-2",
549                                 .flags = IORESOURCE_IRQ,
550                                 .start = AB5500_IRQ(0, 2),
551                                 .end = AB5500_IRQ(0, 2),
552                         },
553                         {
554                                 .name = "TRIGGER-3",
555                                 .flags = IORESOURCE_IRQ,
556                                 .start = AB5500_IRQ(0, 3),
557                                 .end = AB5500_IRQ(0, 3),
558                         },
559                         {
560                                 .name = "TRIGGER-4",
561                                 .flags = IORESOURCE_IRQ,
562                                 .start = AB5500_IRQ(0, 4),
563                                 .end = AB5500_IRQ(0, 4),
564                         },
565                         {
566                                 .name = "TRIGGER-5",
567                                 .flags = IORESOURCE_IRQ,
568                                 .start = AB5500_IRQ(0, 5),
569                                 .end = AB5500_IRQ(0, 5),
570                         },
571                         {
572                                 .name = "TRIGGER-6",
573                                 .flags = IORESOURCE_IRQ,
574                                 .start = AB5500_IRQ(0, 6),
575                                 .end = AB5500_IRQ(0, 6),
576                         },
577                         {
578                                 .name = "TRIGGER-7",
579                                 .flags = IORESOURCE_IRQ,
580                                 .start = AB5500_IRQ(0, 7),
581                                 .end = AB5500_IRQ(0, 7),
582                         },
583                         {
584                                 .name = "TRIGGER-VBAT",
585                                 .flags = IORESOURCE_IRQ,
586                                 .start = AB5500_IRQ(0, 8),
587                                 .end = AB5500_IRQ(0, 8),
588                         },
589                         {
590                                 .name = "TRIGGER-VBAT-TXON",
591                                 .flags = IORESOURCE_IRQ,
592                                 .start = AB5500_IRQ(0, 9),
593                                 .end = AB5500_IRQ(0, 9),
594                         },
595                 },
596         },
597         [AB5500_DEVID_FUELGAUGE] = {
598                 .name = "ab5500-fuelgauge",
599                 .id = AB5500_DEVID_FUELGAUGE,
600                 .num_resources = 6,
601                 .resources = (struct resource[]) {
602                         {
603                                 .name = "Batt_attach",
604                                 .flags = IORESOURCE_IRQ,
605                                 .start = AB5500_IRQ(7, 5),
606                                 .end = AB5500_IRQ(7, 5),
607                         },
608                         {
609                                 .name = "Batt_removal",
610                                 .flags = IORESOURCE_IRQ,
611                                 .start = AB5500_IRQ(7, 6),
612                                 .end = AB5500_IRQ(7, 6),
613                         },
614                         {
615                                 .name = "UART_framing",
616                                 .flags = IORESOURCE_IRQ,
617                                 .start = AB5500_IRQ(7, 7),
618                                 .end = AB5500_IRQ(7, 7),
619                         },
620                         {
621                                 .name = "UART_overrun",
622                                 .flags = IORESOURCE_IRQ,
623                                 .start = AB5500_IRQ(8, 0),
624                                 .end = AB5500_IRQ(8, 0),
625                         },
626                         {
627                                 .name = "UART_Rdy_RX",
628                                 .flags = IORESOURCE_IRQ,
629                                 .start = AB5500_IRQ(8, 1),
630                                 .end = AB5500_IRQ(8, 1),
631                         },
632                         {
633                                 .name = "UART_Rdy_TX",
634                                 .flags = IORESOURCE_IRQ,
635                                 .start = AB5500_IRQ(8, 2),
636                                 .end = AB5500_IRQ(8, 2),
637                         },
638                 },
639         },
640         [AB5500_DEVID_VIBRATOR] = {
641                 .name = "ab5500-vibrator",
642                 .id = AB5500_DEVID_VIBRATOR,
643         },
644         [AB5500_DEVID_CODEC] = {
645                 .name = "ab5500-codec",
646                 .id = AB5500_DEVID_CODEC,
647                 .num_resources = 3,
648                 .resources = (struct resource[]) {
649                         {
650                                 .name = "audio_spkr1_ovc",
651                                 .flags = IORESOURCE_IRQ,
652                                 .start = AB5500_IRQ(9, 5),
653                                 .end = AB5500_IRQ(9, 5),
654                         },
655                         {
656                                 .name = "audio_plllocked",
657                                 .flags = IORESOURCE_IRQ,
658                                 .start = AB5500_IRQ(9, 6),
659                                 .end = AB5500_IRQ(9, 6),
660                         },
661                         {
662                                 .name = "audio_spkr2_ovc",
663                                 .flags = IORESOURCE_IRQ,
664                                 .start = AB5500_IRQ(17, 4),
665                                 .end = AB5500_IRQ(17, 4),
666                         },
667                 },
668         },
669         [AB5500_DEVID_USB] = {
670                 .name = "ab5500-usb",
671                 .id = AB5500_DEVID_USB,
672                 .num_resources = 36,
673                 .resources = (struct resource[]) {
674                         {
675                                 .name = "Link_Update",
676                                 .flags = IORESOURCE_IRQ,
677                                 .start = AB5500_IRQ(22, 1),
678                                 .end = AB5500_IRQ(22, 1),
679                         },
680                         {
681                                 .name = "DCIO",
682                                 .flags = IORESOURCE_IRQ,
683                                 .start = AB5500_IRQ(8, 3),
684                                 .end = AB5500_IRQ(8, 4),
685                         },
686                         {
687                                 .name = "VBUS_R",
688                                 .flags = IORESOURCE_IRQ,
689                                 .start = AB5500_IRQ(8, 5),
690                                 .end = AB5500_IRQ(8, 5),
691                         },
692                         {
693                                 .name = "VBUS_F",
694                                 .flags = IORESOURCE_IRQ,
695                                 .start = AB5500_IRQ(8, 6),
696                                 .end = AB5500_IRQ(8, 6),
697                         },
698                         {
699                                 .name = "CHGstate_10_PCVBUSchg",
700                                 .flags = IORESOURCE_IRQ,
701                                 .start = AB5500_IRQ(8, 7),
702                                 .end = AB5500_IRQ(8, 7),
703                         },
704                         {
705                                 .name = "DCIOreverse_ovc",
706                                 .flags = IORESOURCE_IRQ,
707                                 .start = AB5500_IRQ(9, 0),
708                                 .end = AB5500_IRQ(9, 0),
709                         },
710                         {
711                                 .name = "USBCharDetDone",
712                                 .flags = IORESOURCE_IRQ,
713                                 .start = AB5500_IRQ(9, 1),
714                                 .end = AB5500_IRQ(9, 1),
715                         },
716                         {
717                                 .name = "DCIO_no_limit",
718                                 .flags = IORESOURCE_IRQ,
719                                 .start = AB5500_IRQ(9, 2),
720                                 .end = AB5500_IRQ(9, 2),
721                         },
722                         {
723                                 .name = "USB_suspend",
724                                 .flags = IORESOURCE_IRQ,
725                                 .start = AB5500_IRQ(9, 3),
726                                 .end = AB5500_IRQ(9, 3),
727                         },
728                         {
729                                 .name = "DCIOreverse_fwdcurrent",
730                                 .flags = IORESOURCE_IRQ,
731                                 .start = AB5500_IRQ(9, 4),
732                                 .end = AB5500_IRQ(9, 4),
733                         },
734                         {
735                                 .name = "Vbus_Imeasmax_change",
736                                 .flags = IORESOURCE_IRQ,
737                                 .start = AB5500_IRQ(9, 5),
738                                 .end = AB5500_IRQ(9, 6),
739                         },
740                         {
741                                 .name = "OVV",
742                                 .flags = IORESOURCE_IRQ,
743                                 .start = AB5500_IRQ(14, 5),
744                                 .end = AB5500_IRQ(14, 5),
745                         },
746                         {
747                                 .name = "USBcharging_NOTok",
748                                 .flags = IORESOURCE_IRQ,
749                                 .start = AB5500_IRQ(15, 3),
750                                 .end = AB5500_IRQ(15, 3),
751                         },
752                         {
753                                 .name = "usb_adp_sensoroff",
754                                 .flags = IORESOURCE_IRQ,
755                                 .start = AB5500_IRQ(15, 6),
756                                 .end = AB5500_IRQ(15, 6),
757                         },
758                         {
759                                 .name = "usb_adp_probeplug",
760                                 .flags = IORESOURCE_IRQ,
761                                 .start = AB5500_IRQ(15, 7),
762                                 .end = AB5500_IRQ(15, 7),
763                         },
764                         {
765                                 .name = "usb_adp_sinkerror",
766                                 .flags = IORESOURCE_IRQ,
767                                 .start = AB5500_IRQ(16, 0),
768                                 .end = AB5500_IRQ(16, 6),
769                         },
770                         {
771                                 .name = "usb_adp_sourceerror",
772                                 .flags = IORESOURCE_IRQ,
773                                 .start = AB5500_IRQ(16, 1),
774                                 .end = AB5500_IRQ(16, 1),
775                         },
776                         {
777                                 .name = "usb_idgnd_r",
778                                 .flags = IORESOURCE_IRQ,
779                                 .start = AB5500_IRQ(16, 2),
780                                 .end = AB5500_IRQ(16, 2),
781                         },
782                         {
783                                 .name = "usb_idgnd_f",
784                                 .flags = IORESOURCE_IRQ,
785                                 .start = AB5500_IRQ(16, 3),
786                                 .end = AB5500_IRQ(16, 3),
787                         },
788                         {
789                                 .name = "usb_iddetR1",
790                                 .flags = IORESOURCE_IRQ,
791                                 .start = AB5500_IRQ(16, 4),
792                                 .end = AB5500_IRQ(16, 5),
793                         },
794                         {
795                                 .name = "usb_iddetR2",
796                                 .flags = IORESOURCE_IRQ,
797                                 .start = AB5500_IRQ(16, 6),
798                                 .end = AB5500_IRQ(16, 7),
799                         },
800                         {
801                                 .name = "usb_iddetR3",
802                                 .flags = IORESOURCE_IRQ,
803                                 .start = AB5500_IRQ(17, 0),
804                                 .end = AB5500_IRQ(17, 1),
805                         },
806                         {
807                                 .name = "usb_iddetR4",
808                                 .flags = IORESOURCE_IRQ,
809                                 .start = AB5500_IRQ(17, 2),
810                                 .end = AB5500_IRQ(17, 3),
811                         },
812                         {
813                                 .name = "CharTempWindowOk",
814                                 .flags = IORESOURCE_IRQ,
815                                 .start = AB5500_IRQ(17, 7),
816                                 .end = AB5500_IRQ(18, 0),
817                         },
818                         {
819                                 .name = "USB_SprDetect",
820                                 .flags = IORESOURCE_IRQ,
821                                 .start = AB5500_IRQ(18, 1),
822                                 .end = AB5500_IRQ(18, 1),
823                         },
824                         {
825                                 .name = "usb_adp_probe_unplug",
826                                 .flags = IORESOURCE_IRQ,
827                                 .start = AB5500_IRQ(18, 2),
828                                 .end = AB5500_IRQ(18, 2),
829                         },
830                         {
831                                 .name = "VBUSChDrop",
832                                 .flags = IORESOURCE_IRQ,
833                                 .start = AB5500_IRQ(18, 3),
834                                 .end = AB5500_IRQ(18, 4),
835                         },
836                         {
837                                 .name = "dcio_char_rec_done",
838                                 .flags = IORESOURCE_IRQ,
839                                 .start = AB5500_IRQ(18, 5),
840                                 .end = AB5500_IRQ(18, 5),
841                         },
842                         {
843                                 .name = "Charging_stopped_by_temp",
844                                 .flags = IORESOURCE_IRQ,
845                                 .start = AB5500_IRQ(18, 6),
846                                 .end = AB5500_IRQ(18, 6),
847                         },
848                         {
849                                 .name = "CHGstate_11_SafeModeVBUS",
850                                 .flags = IORESOURCE_IRQ,
851                                 .start = AB5500_IRQ(21, 1),
852                                 .end = AB5500_IRQ(21, 2),
853                         },
854                         {
855                                 .name = "CHGstate_12_comletedVBUS",
856                                 .flags = IORESOURCE_IRQ,
857                                 .start = AB5500_IRQ(21, 2),
858                                 .end = AB5500_IRQ(21, 2),
859                         },
860                         {
861                                 .name = "CHGstate_13_completedVBUS",
862                                 .flags = IORESOURCE_IRQ,
863                                 .start = AB5500_IRQ(21, 3),
864                                 .end = AB5500_IRQ(21, 3),
865                         },
866                         {
867                                 .name = "CHGstate_14_FullChgDCIO",
868                                 .flags = IORESOURCE_IRQ,
869                                 .start = AB5500_IRQ(21, 4),
870                                 .end = AB5500_IRQ(21, 4),
871                         },
872                         {
873                                 .name = "CHGstate_15_SafeModeDCIO",
874                                 .flags = IORESOURCE_IRQ,
875                                 .start = AB5500_IRQ(21, 5),
876                                 .end = AB5500_IRQ(21, 5),
877                         },
878                         {
879                                 .name = "CHGstate_16_OFFsuspendDCIO",
880                                 .flags = IORESOURCE_IRQ,
881                                 .start = AB5500_IRQ(21, 6),
882                                 .end = AB5500_IRQ(21, 6),
883                         },
884                         {
885                                 .name = "CHGstate_17_completedDCIO",
886                                 .flags = IORESOURCE_IRQ,
887                                 .start = AB5500_IRQ(21, 7),
888                                 .end = AB5500_IRQ(21, 7),
889                         },
890                 },
891         },
892         [AB5500_DEVID_OTP] = {
893                 .name = "ab5500-otp",
894                 .id = AB5500_DEVID_OTP,
895         },
896         [AB5500_DEVID_VIDEO] = {
897                 .name = "ab5500-video",
898                 .id = AB5500_DEVID_VIDEO,
899                 .num_resources = 1,
900                 .resources = (struct resource[]) {
901                         {
902                                 .name = "plugTVdet",
903                                 .flags = IORESOURCE_IRQ,
904                                 .start = AB5500_IRQ(22, 2),
905                                 .end = AB5500_IRQ(22, 2),
906                         },
907                 },
908         },
909         [AB5500_DEVID_DBIECI] = {
910                 .name = "ab5500-dbieci",
911                 .id = AB5500_DEVID_DBIECI,
912                 .num_resources = 10,
913                 .resources = (struct resource[]) {
914                         {
915                                 .name = "COLL",
916                                 .flags = IORESOURCE_IRQ,
917                                 .start = AB5500_IRQ(14, 0),
918                                 .end = AB5500_IRQ(14, 0),
919                         },
920                         {
921                                 .name = "RESERR",
922                                 .flags = IORESOURCE_IRQ,
923                                 .start = AB5500_IRQ(14, 1),
924                                 .end = AB5500_IRQ(14, 1),
925                         },
926                         {
927                                 .name = "FRAERR",
928                                 .flags = IORESOURCE_IRQ,
929                                 .start = AB5500_IRQ(14, 2),
930                                 .end = AB5500_IRQ(14, 2),
931                         },
932                         {
933                                 .name = "COMERR",
934                                 .flags = IORESOURCE_IRQ,
935                                 .start = AB5500_IRQ(14, 3),
936                                 .end = AB5500_IRQ(14, 3),
937                         },
938                         {
939                                 .name = "BSI_indicator",
940                                 .flags = IORESOURCE_IRQ,
941                                 .start = AB5500_IRQ(14, 4),
942                                 .end = AB5500_IRQ(14, 4),
943                         },
944                         {
945                                 .name = "SPDSET",
946                                 .flags = IORESOURCE_IRQ,
947                                 .start = AB5500_IRQ(14, 6),
948                                 .end = AB5500_IRQ(14, 6),
949                         },
950                         {
951                                 .name = "DSENT",
952                                 .flags = IORESOURCE_IRQ,
953                                 .start = AB5500_IRQ(14, 7),
954                                 .end = AB5500_IRQ(14, 7),
955                         },
956                         {
957                                 .name = "DREC",
958                                 .flags = IORESOURCE_IRQ,
959                                 .start = AB5500_IRQ(15, 0),
960                                 .end = AB5500_IRQ(15, 0),
961                         },
962                         {
963                                 .name = "ACCINT",
964                                 .flags = IORESOURCE_IRQ,
965                                 .start = AB5500_IRQ(15, 1),
966                                 .end = AB5500_IRQ(15, 1),
967                         },
968                         {
969                                 .name = "NOPINT",
970                                 .flags = IORESOURCE_IRQ,
971                                 .start = AB5500_IRQ(15, 2),
972                                 .end = AB5500_IRQ(15, 2),
973                         },
974                 },
975         },
976         [AB5500_DEVID_ONSWA] = {
977                 .name = "ab5500-onswa",
978                 .id = AB5500_DEVID_ONSWA,
979                 .num_resources = 2,
980                 .resources = (struct resource[]) {
981                         {
982                                 .name   = "ONSWAn_rising",
983                                 .flags  = IORESOURCE_IRQ,
984                                 .start  = AB5500_IRQ(1, 3),
985                                 .end    = AB5500_IRQ(1, 3),
986                         },
987                         {
988                                 .name   = "ONSWAn_falling",
989                                 .flags  = IORESOURCE_IRQ,
990                                 .start  = AB5500_IRQ(1, 4),
991                                 .end    = AB5500_IRQ(1, 4),
992                         },
993                 },
994         },
995 };
996
997 /*
998  * Functionality for getting/setting register values.
999  */
1000 int ab5500_get_register_interruptible_raw(struct ab5500 *ab,
1001                                           u8 bank, u8 reg,
1002                                           u8 *value)
1003 {
1004         int err;
1005
1006         if (bank >= AB5500_NUM_BANKS)
1007                 return -EINVAL;
1008
1009         err = mutex_lock_interruptible(&ab->access_mutex);
1010         if (err)
1011                 return err;
1012         err = db5500_prcmu_abb_read(bankinfo[bank].slave_addr, reg, value, 1);
1013
1014         mutex_unlock(&ab->access_mutex);
1015         return err;
1016 }
1017
1018 static int get_register_page_interruptible(struct ab5500 *ab, u8 bank,
1019         u8 first_reg, u8 *regvals, u8 numregs)
1020 {
1021         int err;
1022
1023         if (bank >= AB5500_NUM_BANKS)
1024                 return -EINVAL;
1025
1026         err = mutex_lock_interruptible(&ab->access_mutex);
1027         if (err)
1028                 return err;
1029
1030         while (numregs) {
1031                 /* The hardware limit for get page is 4 */
1032                 u8 curnum = min_t(u8, numregs, 4u);
1033
1034                 err = db5500_prcmu_abb_read(bankinfo[bank].slave_addr,
1035                                             first_reg, regvals, curnum);
1036                 if (err)
1037                         goto out;
1038
1039                 numregs -= curnum;
1040                 first_reg += curnum;
1041                 regvals += curnum;
1042         }
1043
1044 out:
1045         mutex_unlock(&ab->access_mutex);
1046         return err;
1047 }
1048
1049 int ab5500_mask_and_set_register_interruptible_raw(struct ab5500 *ab, u8 bank,
1050         u8 reg, u8 bitmask, u8 bitvalues)
1051 {
1052         int err = 0;
1053
1054         if (bank >= AB5500_NUM_BANKS)
1055                 return -EINVAL;
1056
1057         if (bitmask) {
1058                 u8 buf;
1059
1060                 err = mutex_lock_interruptible(&ab->access_mutex);
1061                 if (err)
1062                         return err;
1063
1064                 if (bitmask == 0xFF) /* No need to read in this case. */
1065                         buf = bitvalues;
1066                 else { /* Read and modify the register value. */
1067                         err = db5500_prcmu_abb_read(bankinfo[bank].slave_addr,
1068                                 reg, &buf, 1);
1069                         if (err)
1070                                 return err;
1071
1072                         buf = ((~bitmask & buf) | (bitmask & bitvalues));
1073                 }
1074                 /* Write the new value. */
1075                 err = db5500_prcmu_abb_write(bankinfo[bank].slave_addr, reg,
1076                                              &buf, 1);
1077
1078                 mutex_unlock(&ab->access_mutex);
1079         }
1080         return err;
1081 }
1082
1083 static int
1084 set_register_interruptible(struct ab5500 *ab, u8 bank, u8 reg, u8 value)
1085 {
1086         return ab5500_mask_and_set_register_interruptible_raw(ab, bank, reg,
1087                                                               0xff, value);
1088 }
1089
1090 /*
1091  * Read/write permission checking functions.
1092  */
1093 static const struct ab5500_i2c_ranges *get_bankref(u8 devid, u8 bank)
1094 {
1095         u8 i;
1096
1097         if (devid < AB5500_NUM_DEVICES) {
1098                 for (i = 0; i < ab5500_bank_ranges[devid].nbanks; i++) {
1099                         if (ab5500_bank_ranges[devid].bank[i].bankid == bank)
1100                                 return &ab5500_bank_ranges[devid].bank[i];
1101                 }
1102         }
1103         return NULL;
1104 }
1105
1106 static bool page_write_allowed(u8 devid, u8 bank, u8 first_reg, u8 last_reg)
1107 {
1108         u8 i; /* range loop index */
1109         const struct ab5500_i2c_ranges *bankref;
1110
1111         bankref = get_bankref(devid, bank);
1112         if (bankref == NULL || last_reg < first_reg)
1113                 return false;
1114
1115         for (i = 0; i < bankref->nranges; i++) {
1116                 if (first_reg < bankref->range[i].first)
1117                         break;
1118                 if ((last_reg <= bankref->range[i].last) &&
1119                         (bankref->range[i].perm & AB5500_PERM_WR))
1120                         return true;
1121         }
1122         return false;
1123 }
1124
1125 static bool reg_write_allowed(u8 devid, u8 bank, u8 reg)
1126 {
1127         return page_write_allowed(devid, bank, reg, reg);
1128 }
1129
1130 static bool page_read_allowed(u8 devid, u8 bank, u8 first_reg, u8 last_reg)
1131 {
1132         u8 i;
1133         const struct ab5500_i2c_ranges *bankref;
1134
1135         bankref = get_bankref(devid, bank);
1136         if (bankref == NULL || last_reg < first_reg)
1137                 return false;
1138
1139
1140         /* Find the range (if it exists in the list) that includes first_reg. */
1141         for (i = 0; i < bankref->nranges; i++) {
1142                 if (first_reg < bankref->range[i].first)
1143                         return false;
1144                 if (first_reg <= bankref->range[i].last)
1145                         break;
1146         }
1147         /* Make sure that the entire range up to and including last_reg is
1148          * readable. This may span several of the ranges in the list.
1149          */
1150         while ((i < bankref->nranges) &&
1151                 (bankref->range[i].perm & AB5500_PERM_RD)) {
1152                 if (last_reg <= bankref->range[i].last)
1153                         return true;
1154                 if ((++i >= bankref->nranges) ||
1155                         (bankref->range[i].first !=
1156                                 (bankref->range[i - 1].last + 1))) {
1157                         break;
1158                 }
1159         }
1160         return false;
1161 }
1162
1163 static bool reg_read_allowed(u8 devid, u8 bank, u8 reg)
1164 {
1165         return page_read_allowed(devid, bank, reg, reg);
1166 }
1167
1168
1169 /*
1170  * The exported register access functionality.
1171  */
1172 static int ab5500_get_chip_id(struct device *dev)
1173 {
1174         struct ab5500 *ab = dev_get_drvdata(dev->parent);
1175
1176         return (int)ab->chip_id;
1177 }
1178
1179 static int ab5500_mask_and_set_register_interruptible(struct device *dev,
1180                 u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
1181 {
1182         struct ab5500 *ab;
1183         struct platform_device *pdev = to_platform_device(dev);
1184
1185         if ((AB5500_NUM_BANKS <= bank) ||
1186                 !reg_write_allowed(pdev->id, bank, reg))
1187                 return -EINVAL;
1188
1189         ab = dev_get_drvdata(dev->parent);
1190         return ab5500_mask_and_set_register_interruptible_raw(ab, bank, reg,
1191                 bitmask, bitvalues);
1192 }
1193
1194 static int ab5500_set_register_interruptible(struct device *dev, u8 bank,
1195         u8 reg, u8 value)
1196 {
1197         return ab5500_mask_and_set_register_interruptible(dev, bank, reg, 0xFF,
1198                 value);
1199 }
1200
1201 static int ab5500_get_register_interruptible(struct device *dev, u8 bank,
1202                 u8 reg, u8 *value)
1203 {
1204         struct ab5500 *ab;
1205         struct platform_device *pdev = to_platform_device(dev);
1206
1207         if ((AB5500_NUM_BANKS <= bank) ||
1208                 !reg_read_allowed(pdev->id, bank, reg))
1209                 return -EINVAL;
1210
1211         ab = dev_get_drvdata(dev->parent);
1212         return ab5500_get_register_interruptible_raw(ab, bank, reg, value);
1213 }
1214
1215 static int ab5500_get_register_page_interruptible(struct device *dev, u8 bank,
1216                 u8 first_reg, u8 *regvals, u8 numregs)
1217 {
1218         struct ab5500 *ab;
1219         struct platform_device *pdev = to_platform_device(dev);
1220
1221         if ((AB5500_NUM_BANKS <= bank) ||
1222                 !page_read_allowed(pdev->id, bank,
1223                         first_reg, (first_reg + numregs - 1)))
1224                 return -EINVAL;
1225
1226         ab = dev_get_drvdata(dev->parent);
1227         return get_register_page_interruptible(ab, bank, first_reg, regvals,
1228                 numregs);
1229 }
1230
1231 static int
1232 ab5500_event_registers_startup_state_get(struct device *dev, u8 *event)
1233 {
1234         struct ab5500 *ab;
1235
1236         ab = dev_get_drvdata(dev->parent);
1237         if (!ab->startup_events_read)
1238                 return -EAGAIN; /* Try again later */
1239
1240         memcpy(event, ab->startup_events, AB5500_NUM_EVENT_REG);
1241         return 0;
1242 }
1243
1244 static struct abx500_ops ab5500_ops = {
1245         .get_chip_id = ab5500_get_chip_id,
1246         .get_register = ab5500_get_register_interruptible,
1247         .set_register = ab5500_set_register_interruptible,
1248         .get_register_page = ab5500_get_register_page_interruptible,
1249         .set_register_page = NULL,
1250         .mask_and_set_register = ab5500_mask_and_set_register_interruptible,
1251         .event_registers_startup_state_get =
1252                 ab5500_event_registers_startup_state_get,
1253         .startup_irq_enabled = NULL,
1254 };
1255
1256 /*
1257  * ab5500_setup : Basic set-up, datastructure creation/destruction
1258  *                and I2C interface.This sets up a default config
1259  *                in the AB5500 chip so that it will work as expected.
1260  * @ab :          Pointer to ab5500 structure
1261  * @settings :    Pointer to struct abx500_init_settings
1262  * @size :        Size of init data
1263  */
1264 static int __init ab5500_setup(struct ab5500 *ab,
1265         struct abx500_init_settings *settings, unsigned int size)
1266 {
1267         int err = 0;
1268         int i;
1269
1270         for (i = 0; i < size; i++) {
1271                 err = ab5500_mask_and_set_register_interruptible_raw(ab,
1272                         settings[i].bank,
1273                         settings[i].reg,
1274                         0xFF, settings[i].setting);
1275                 if (err)
1276                         goto exit_no_setup;
1277
1278                 /* If event mask register update the event mask in ab5500 */
1279                 if ((settings[i].bank == AB5500_BANK_IT) &&
1280                         (AB5500_MASK_BASE <= settings[i].reg) &&
1281                         (settings[i].reg <= AB5500_MASK_END)) {
1282                         ab->mask[settings[i].reg - AB5500_MASK_BASE] =
1283                                 settings[i].setting;
1284                 }
1285         }
1286 exit_no_setup:
1287         return err;
1288 }
1289
1290 struct ab_family_id {
1291         u8      id;
1292         char    *name;
1293 };
1294
1295 static const struct ab_family_id ids[] __initdata = {
1296         /* AB5500 */
1297         {
1298                 .id = AB5500_1_0,
1299                 .name = "1.0"
1300         },
1301         {
1302                 .id = AB5500_1_1,
1303                 .name = "1.1"
1304         },
1305         /* Terminator */
1306         {
1307                 .id = 0x00,
1308         }
1309 };
1310
1311 static int __init ab5500_probe(struct platform_device *pdev)
1312 {
1313         struct ab5500 *ab;
1314         struct ab5500_platform_data *ab5500_plf_data =
1315                 pdev->dev.platform_data;
1316         int err;
1317         int i;
1318
1319         ab = kzalloc(sizeof(struct ab5500), GFP_KERNEL);
1320         if (!ab) {
1321                 dev_err(&pdev->dev,
1322                         "could not allocate ab5500 device\n");
1323                 return -ENOMEM;
1324         }
1325
1326         /* Initialize data structure */
1327         mutex_init(&ab->access_mutex);
1328         mutex_init(&ab->irq_lock);
1329         ab->dev = &pdev->dev;
1330
1331         platform_set_drvdata(pdev, ab);
1332
1333         /* Read chip ID register */
1334         err = ab5500_get_register_interruptible_raw(ab,
1335                                         AB5500_BANK_VIT_IO_I2C_CLK_TST_OTP,
1336                                         AB5500_CHIP_ID, &ab->chip_id);
1337         if (err) {
1338                 dev_err(&pdev->dev, "could not communicate with the analog "
1339                         "baseband chip\n");
1340                 goto exit_no_detect;
1341         }
1342
1343         for (i = 0; ids[i].id != 0x0; i++) {
1344                 if (ids[i].id == ab->chip_id) {
1345                         snprintf(&ab->chip_name[0], sizeof(ab->chip_name) - 1,
1346                                 "AB5500 %s", ids[i].name);
1347                         break;
1348                 }
1349         }
1350         if (ids[i].id == 0x0) {
1351                 dev_err(&pdev->dev, "unknown analog baseband chip id: 0x%x\n",
1352                         ab->chip_id);
1353                 dev_err(&pdev->dev, "driver not started!\n");
1354                 goto exit_no_detect;
1355         }
1356
1357         /* Clear and mask all interrupts */
1358         for (i = 0; i < AB5500_NUM_IRQ_REGS; i++) {
1359                 u8 latchreg = AB5500_IT_LATCH0_REG + i;
1360                 u8 maskreg = AB5500_IT_MASK0_REG + i;
1361                 u8 val;
1362
1363                 ab5500_get_register_interruptible_raw(ab, AB5500_BANK_IT,
1364                                                       latchreg, &val);
1365                 set_register_interruptible(ab, AB5500_BANK_IT, maskreg, 0xff);
1366                 ab->mask[i] = ab->oldmask[i] = 0xff;
1367         }
1368
1369         err = abx500_register_ops(&pdev->dev, &ab5500_ops);
1370         if (err) {
1371                 dev_err(&pdev->dev, "ab5500_register ops error\n");
1372                 goto exit_no_detect;
1373         }
1374
1375         /* Set up and register the platform devices. */
1376         for (i = 0; i < AB5500_NUM_DEVICES; i++) {
1377                 ab5500_devs[i].platform_data = ab5500_plf_data->dev_data[i];
1378                 ab5500_devs[i].pdata_size =
1379                         sizeof(ab5500_plf_data->dev_data[i]);
1380         }
1381
1382         err = mfd_add_devices(&pdev->dev, 0, ab5500_devs,
1383                 ARRAY_SIZE(ab5500_devs), NULL,
1384                 ab5500_plf_data->irq.base);
1385         if (err) {
1386                 dev_err(&pdev->dev, "ab5500_mfd_add_device error\n");
1387                 goto exit_no_detect;
1388         }
1389
1390         err = ab5500_setup(ab, ab5500_plf_data->init_settings,
1391                 ab5500_plf_data->init_settings_sz);
1392         if (err) {
1393                 dev_err(&pdev->dev, "ab5500_setup error\n");
1394                 goto exit_no_detect;
1395         }
1396
1397         ab5500_setup_debugfs(ab);
1398
1399         dev_info(&pdev->dev, "detected AB chip: %s\n", &ab->chip_name[0]);
1400         return 0;
1401
1402 exit_no_detect:
1403         kfree(ab);
1404         return err;
1405 }
1406
1407 static int __exit ab5500_remove(struct platform_device *pdev)
1408 {
1409         struct ab5500 *ab = platform_get_drvdata(pdev);
1410
1411         ab5500_remove_debugfs();
1412         mfd_remove_devices(&pdev->dev);
1413         kfree(ab);
1414         return 0;
1415 }
1416
1417 static struct platform_driver ab5500_driver = {
1418         .driver = {
1419                 .name = "ab5500-core",
1420                 .owner = THIS_MODULE,
1421         },
1422         .remove  = __exit_p(ab5500_remove),
1423 };
1424
1425 static int __init ab5500_core_init(void)
1426 {
1427         return platform_driver_probe(&ab5500_driver, ab5500_probe);
1428 }
1429
1430 static void __exit ab5500_core_exit(void)
1431 {
1432         platform_driver_unregister(&ab5500_driver);
1433 }
1434
1435 subsys_initcall(ab5500_core_init);
1436 module_exit(ab5500_core_exit);
1437
1438 MODULE_AUTHOR("Mattias Wallin <mattias.wallin@stericsson.com>");
1439 MODULE_DESCRIPTION("AB5500 core driver");
1440 MODULE_LICENSE("GPL");