usb: dwc3: rockchip: fix possible circular deadlock
[firefly-linux-kernel-4.4.55.git] / drivers / gpio / gpio-samsung.c
1 /*
2  * Copyright (c) 2009-2011 Samsung Electronics Co., Ltd.
3  *              http://www.samsung.com/
4  *
5  * Copyright 2008 Openmoko, Inc.
6  * Copyright 2008 Simtec Electronics
7  *      Ben Dooks <ben@simtec.co.uk>
8  *      http://armlinux.simtec.co.uk/
9  *
10  * SAMSUNG - GPIOlib support
11  *
12  * This program is free software; you can redistribute it and/or modify
13  * it under the terms of the GNU General Public License version 2 as
14  * published by the Free Software Foundation.
15  */
16
17 #include <linux/kernel.h>
18 #include <linux/irq.h>
19 #include <linux/io.h>
20 #include <linux/gpio.h>
21 #include <linux/init.h>
22 #include <linux/spinlock.h>
23 #include <linux/module.h>
24 #include <linux/interrupt.h>
25 #include <linux/device.h>
26 #include <linux/ioport.h>
27 #include <linux/of.h>
28 #include <linux/slab.h>
29 #include <linux/of_address.h>
30
31 #include <asm/irq.h>
32
33 #include <mach/map.h>
34 #include <mach/regs-gpio.h>
35 #include <mach/gpio-samsung.h>
36
37 #include <plat/cpu.h>
38 #include <plat/gpio-core.h>
39 #include <plat/gpio-cfg.h>
40 #include <plat/gpio-cfg-helpers.h>
41 #include <plat/pm.h>
42
43 int samsung_gpio_setpull_updown(struct samsung_gpio_chip *chip,
44                                 unsigned int off, samsung_gpio_pull_t pull)
45 {
46         void __iomem *reg = chip->base + 0x08;
47         int shift = off * 2;
48         u32 pup;
49
50         pup = __raw_readl(reg);
51         pup &= ~(3 << shift);
52         pup |= pull << shift;
53         __raw_writel(pup, reg);
54
55         return 0;
56 }
57
58 samsung_gpio_pull_t samsung_gpio_getpull_updown(struct samsung_gpio_chip *chip,
59                                                 unsigned int off)
60 {
61         void __iomem *reg = chip->base + 0x08;
62         int shift = off * 2;
63         u32 pup = __raw_readl(reg);
64
65         pup >>= shift;
66         pup &= 0x3;
67
68         return (__force samsung_gpio_pull_t)pup;
69 }
70
71 int s3c2443_gpio_setpull(struct samsung_gpio_chip *chip,
72                          unsigned int off, samsung_gpio_pull_t pull)
73 {
74         switch (pull) {
75         case S3C_GPIO_PULL_NONE:
76                 pull = 0x01;
77                 break;
78         case S3C_GPIO_PULL_UP:
79                 pull = 0x00;
80                 break;
81         case S3C_GPIO_PULL_DOWN:
82                 pull = 0x02;
83                 break;
84         }
85         return samsung_gpio_setpull_updown(chip, off, pull);
86 }
87
88 samsung_gpio_pull_t s3c2443_gpio_getpull(struct samsung_gpio_chip *chip,
89                                          unsigned int off)
90 {
91         samsung_gpio_pull_t pull;
92
93         pull = samsung_gpio_getpull_updown(chip, off);
94
95         switch (pull) {
96         case 0x00:
97                 pull = S3C_GPIO_PULL_UP;
98                 break;
99         case 0x01:
100         case 0x03:
101                 pull = S3C_GPIO_PULL_NONE;
102                 break;
103         case 0x02:
104                 pull = S3C_GPIO_PULL_DOWN;
105                 break;
106         }
107
108         return pull;
109 }
110
111 static int s3c24xx_gpio_setpull_1(struct samsung_gpio_chip *chip,
112                                   unsigned int off, samsung_gpio_pull_t pull,
113                                   samsung_gpio_pull_t updown)
114 {
115         void __iomem *reg = chip->base + 0x08;
116         u32 pup = __raw_readl(reg);
117
118         if (pull == updown)
119                 pup &= ~(1 << off);
120         else if (pull == S3C_GPIO_PULL_NONE)
121                 pup |= (1 << off);
122         else
123                 return -EINVAL;
124
125         __raw_writel(pup, reg);
126         return 0;
127 }
128
129 static samsung_gpio_pull_t s3c24xx_gpio_getpull_1(struct samsung_gpio_chip *chip,
130                                                   unsigned int off,
131                                                   samsung_gpio_pull_t updown)
132 {
133         void __iomem *reg = chip->base + 0x08;
134         u32 pup = __raw_readl(reg);
135
136         pup &= (1 << off);
137         return pup ? S3C_GPIO_PULL_NONE : updown;
138 }
139
140 samsung_gpio_pull_t s3c24xx_gpio_getpull_1up(struct samsung_gpio_chip *chip,
141                                              unsigned int off)
142 {
143         return s3c24xx_gpio_getpull_1(chip, off, S3C_GPIO_PULL_UP);
144 }
145
146 int s3c24xx_gpio_setpull_1up(struct samsung_gpio_chip *chip,
147                              unsigned int off, samsung_gpio_pull_t pull)
148 {
149         return s3c24xx_gpio_setpull_1(chip, off, pull, S3C_GPIO_PULL_UP);
150 }
151
152 samsung_gpio_pull_t s3c24xx_gpio_getpull_1down(struct samsung_gpio_chip *chip,
153                                                unsigned int off)
154 {
155         return s3c24xx_gpio_getpull_1(chip, off, S3C_GPIO_PULL_DOWN);
156 }
157
158 int s3c24xx_gpio_setpull_1down(struct samsung_gpio_chip *chip,
159                                unsigned int off, samsung_gpio_pull_t pull)
160 {
161         return s3c24xx_gpio_setpull_1(chip, off, pull, S3C_GPIO_PULL_DOWN);
162 }
163
164 /*
165  * samsung_gpio_setcfg_2bit - Samsung 2bit style GPIO configuration.
166  * @chip: The gpio chip that is being configured.
167  * @off: The offset for the GPIO being configured.
168  * @cfg: The configuration value to set.
169  *
170  * This helper deal with the GPIO cases where the control register
171  * has two bits of configuration per gpio, which have the following
172  * functions:
173  *      00 = input
174  *      01 = output
175  *      1x = special function
176  */
177
178 static int samsung_gpio_setcfg_2bit(struct samsung_gpio_chip *chip,
179                                     unsigned int off, unsigned int cfg)
180 {
181         void __iomem *reg = chip->base;
182         unsigned int shift = off * 2;
183         u32 con;
184
185         if (samsung_gpio_is_cfg_special(cfg)) {
186                 cfg &= 0xf;
187                 if (cfg > 3)
188                         return -EINVAL;
189
190                 cfg <<= shift;
191         }
192
193         con = __raw_readl(reg);
194         con &= ~(0x3 << shift);
195         con |= cfg;
196         __raw_writel(con, reg);
197
198         return 0;
199 }
200
201 /*
202  * samsung_gpio_getcfg_2bit - Samsung 2bit style GPIO configuration read.
203  * @chip: The gpio chip that is being configured.
204  * @off: The offset for the GPIO being configured.
205  *
206  * The reverse of samsung_gpio_setcfg_2bit(). Will return a value which
207  * could be directly passed back to samsung_gpio_setcfg_2bit(), from the
208  * S3C_GPIO_SPECIAL() macro.
209  */
210
211 static unsigned int samsung_gpio_getcfg_2bit(struct samsung_gpio_chip *chip,
212                                              unsigned int off)
213 {
214         u32 con;
215
216         con = __raw_readl(chip->base);
217         con >>= off * 2;
218         con &= 3;
219
220         /* this conversion works for IN and OUT as well as special mode */
221         return S3C_GPIO_SPECIAL(con);
222 }
223
224 /*
225  * samsung_gpio_setcfg_4bit - Samsung 4bit single register GPIO config.
226  * @chip: The gpio chip that is being configured.
227  * @off: The offset for the GPIO being configured.
228  * @cfg: The configuration value to set.
229  *
230  * This helper deal with the GPIO cases where the control register has 4 bits
231  * of control per GPIO, generally in the form of:
232  *      0000 = Input
233  *      0001 = Output
234  *      others = Special functions (dependent on bank)
235  *
236  * Note, since the code to deal with the case where there are two control
237  * registers instead of one, we do not have a separate set of functions for
238  * each case.
239  */
240
241 static int samsung_gpio_setcfg_4bit(struct samsung_gpio_chip *chip,
242                                     unsigned int off, unsigned int cfg)
243 {
244         void __iomem *reg = chip->base;
245         unsigned int shift = (off & 7) * 4;
246         u32 con;
247
248         if (off < 8 && chip->chip.ngpio > 8)
249                 reg -= 4;
250
251         if (samsung_gpio_is_cfg_special(cfg)) {
252                 cfg &= 0xf;
253                 cfg <<= shift;
254         }
255
256         con = __raw_readl(reg);
257         con &= ~(0xf << shift);
258         con |= cfg;
259         __raw_writel(con, reg);
260
261         return 0;
262 }
263
264 /*
265  * samsung_gpio_getcfg_4bit - Samsung 4bit single register GPIO config read.
266  * @chip: The gpio chip that is being configured.
267  * @off: The offset for the GPIO being configured.
268  *
269  * The reverse of samsung_gpio_setcfg_4bit(), turning a gpio configuration
270  * register setting into a value the software can use, such as could be passed
271  * to samsung_gpio_setcfg_4bit().
272  *
273  * @sa samsung_gpio_getcfg_2bit
274  */
275
276 static unsigned samsung_gpio_getcfg_4bit(struct samsung_gpio_chip *chip,
277                                          unsigned int off)
278 {
279         void __iomem *reg = chip->base;
280         unsigned int shift = (off & 7) * 4;
281         u32 con;
282
283         if (off < 8 && chip->chip.ngpio > 8)
284                 reg -= 4;
285
286         con = __raw_readl(reg);
287         con >>= shift;
288         con &= 0xf;
289
290         /* this conversion works for IN and OUT as well as special mode */
291         return S3C_GPIO_SPECIAL(con);
292 }
293
294 #ifdef CONFIG_PLAT_S3C24XX
295 /*
296  * s3c24xx_gpio_setcfg_abank - S3C24XX style GPIO configuration (Bank A)
297  * @chip: The gpio chip that is being configured.
298  * @off: The offset for the GPIO being configured.
299  * @cfg: The configuration value to set.
300  *
301  * This helper deal with the GPIO cases where the control register
302  * has one bit of configuration for the gpio, where setting the bit
303  * means the pin is in special function mode and unset means output.
304  */
305
306 static int s3c24xx_gpio_setcfg_abank(struct samsung_gpio_chip *chip,
307                                      unsigned int off, unsigned int cfg)
308 {
309         void __iomem *reg = chip->base;
310         unsigned int shift = off;
311         u32 con;
312
313         if (samsung_gpio_is_cfg_special(cfg)) {
314                 cfg &= 0xf;
315
316                 /* Map output to 0, and SFN2 to 1 */
317                 cfg -= 1;
318                 if (cfg > 1)
319                         return -EINVAL;
320
321                 cfg <<= shift;
322         }
323
324         con = __raw_readl(reg);
325         con &= ~(0x1 << shift);
326         con |= cfg;
327         __raw_writel(con, reg);
328
329         return 0;
330 }
331
332 /*
333  * s3c24xx_gpio_getcfg_abank - S3C24XX style GPIO configuration read (Bank A)
334  * @chip: The gpio chip that is being configured.
335  * @off: The offset for the GPIO being configured.
336  *
337  * The reverse of s3c24xx_gpio_setcfg_abank() turning an GPIO into a usable
338  * GPIO configuration value.
339  *
340  * @sa samsung_gpio_getcfg_2bit
341  * @sa samsung_gpio_getcfg_4bit
342  */
343
344 static unsigned s3c24xx_gpio_getcfg_abank(struct samsung_gpio_chip *chip,
345                                           unsigned int off)
346 {
347         u32 con;
348
349         con = __raw_readl(chip->base);
350         con >>= off;
351         con &= 1;
352         con++;
353
354         return S3C_GPIO_SFN(con);
355 }
356 #endif
357
358 static void __init samsung_gpiolib_set_cfg(struct samsung_gpio_cfg *chipcfg,
359                                            int nr_chips)
360 {
361         for (; nr_chips > 0; nr_chips--, chipcfg++) {
362                 if (!chipcfg->set_config)
363                         chipcfg->set_config = samsung_gpio_setcfg_4bit;
364                 if (!chipcfg->get_config)
365                         chipcfg->get_config = samsung_gpio_getcfg_4bit;
366                 if (!chipcfg->set_pull)
367                         chipcfg->set_pull = samsung_gpio_setpull_updown;
368                 if (!chipcfg->get_pull)
369                         chipcfg->get_pull = samsung_gpio_getpull_updown;
370         }
371 }
372
373 struct samsung_gpio_cfg s3c24xx_gpiocfg_default = {
374         .set_config     = samsung_gpio_setcfg_2bit,
375         .get_config     = samsung_gpio_getcfg_2bit,
376 };
377
378 #ifdef CONFIG_PLAT_S3C24XX
379 static struct samsung_gpio_cfg s3c24xx_gpiocfg_banka = {
380         .set_config     = s3c24xx_gpio_setcfg_abank,
381         .get_config     = s3c24xx_gpio_getcfg_abank,
382 };
383 #endif
384
385 static struct samsung_gpio_cfg samsung_gpio_cfgs[] = {
386         [0] = {
387                 .cfg_eint       = 0x0,
388         },
389         [1] = {
390                 .cfg_eint       = 0x3,
391         },
392         [2] = {
393                 .cfg_eint       = 0x7,
394         },
395         [3] = {
396                 .cfg_eint       = 0xF,
397         },
398         [4] = {
399                 .cfg_eint       = 0x0,
400                 .set_config     = samsung_gpio_setcfg_2bit,
401                 .get_config     = samsung_gpio_getcfg_2bit,
402         },
403         [5] = {
404                 .cfg_eint       = 0x2,
405                 .set_config     = samsung_gpio_setcfg_2bit,
406                 .get_config     = samsung_gpio_getcfg_2bit,
407         },
408         [6] = {
409                 .cfg_eint       = 0x3,
410                 .set_config     = samsung_gpio_setcfg_2bit,
411                 .get_config     = samsung_gpio_getcfg_2bit,
412         },
413         [7] = {
414                 .set_config     = samsung_gpio_setcfg_2bit,
415                 .get_config     = samsung_gpio_getcfg_2bit,
416         },
417 };
418
419 /*
420  * Default routines for controlling GPIO, based on the original S3C24XX
421  * GPIO functions which deal with the case where each gpio bank of the
422  * chip is as following:
423  *
424  * base + 0x00: Control register, 2 bits per gpio
425  *              gpio n: 2 bits starting at (2*n)
426  *              00 = input, 01 = output, others mean special-function
427  * base + 0x04: Data register, 1 bit per gpio
428  *              bit n: data bit n
429 */
430
431 static int samsung_gpiolib_2bit_input(struct gpio_chip *chip, unsigned offset)
432 {
433         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
434         void __iomem *base = ourchip->base;
435         unsigned long flags;
436         unsigned long con;
437
438         samsung_gpio_lock(ourchip, flags);
439
440         con = __raw_readl(base + 0x00);
441         con &= ~(3 << (offset * 2));
442
443         __raw_writel(con, base + 0x00);
444
445         samsung_gpio_unlock(ourchip, flags);
446         return 0;
447 }
448
449 static int samsung_gpiolib_2bit_output(struct gpio_chip *chip,
450                                        unsigned offset, int value)
451 {
452         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
453         void __iomem *base = ourchip->base;
454         unsigned long flags;
455         unsigned long dat;
456         unsigned long con;
457
458         samsung_gpio_lock(ourchip, flags);
459
460         dat = __raw_readl(base + 0x04);
461         dat &= ~(1 << offset);
462         if (value)
463                 dat |= 1 << offset;
464         __raw_writel(dat, base + 0x04);
465
466         con = __raw_readl(base + 0x00);
467         con &= ~(3 << (offset * 2));
468         con |= 1 << (offset * 2);
469
470         __raw_writel(con, base + 0x00);
471         __raw_writel(dat, base + 0x04);
472
473         samsung_gpio_unlock(ourchip, flags);
474         return 0;
475 }
476
477 /*
478  * The samsung_gpiolib_4bit routines are to control the gpio banks where
479  * the gpio configuration register (GPxCON) has 4 bits per GPIO, as the
480  * following example:
481  *
482  * base + 0x00: Control register, 4 bits per gpio
483  *              gpio n: 4 bits starting at (4*n)
484  *              0000 = input, 0001 = output, others mean special-function
485  * base + 0x04: Data register, 1 bit per gpio
486  *              bit n: data bit n
487  *
488  * Note, since the data register is one bit per gpio and is at base + 0x4
489  * we can use samsung_gpiolib_get and samsung_gpiolib_set to change the
490  * state of the output.
491  */
492
493 static int samsung_gpiolib_4bit_input(struct gpio_chip *chip,
494                                       unsigned int offset)
495 {
496         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
497         void __iomem *base = ourchip->base;
498         unsigned long con;
499
500         con = __raw_readl(base + GPIOCON_OFF);
501         if (ourchip->bitmap_gpio_int & BIT(offset))
502                 con |= 0xf << con_4bit_shift(offset);
503         else
504                 con &= ~(0xf << con_4bit_shift(offset));
505         __raw_writel(con, base + GPIOCON_OFF);
506
507         pr_debug("%s: %p: CON now %08lx\n", __func__, base, con);
508
509         return 0;
510 }
511
512 static int samsung_gpiolib_4bit_output(struct gpio_chip *chip,
513                                        unsigned int offset, int value)
514 {
515         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
516         void __iomem *base = ourchip->base;
517         unsigned long con;
518         unsigned long dat;
519
520         con = __raw_readl(base + GPIOCON_OFF);
521         con &= ~(0xf << con_4bit_shift(offset));
522         con |= 0x1 << con_4bit_shift(offset);
523
524         dat = __raw_readl(base + GPIODAT_OFF);
525
526         if (value)
527                 dat |= 1 << offset;
528         else
529                 dat &= ~(1 << offset);
530
531         __raw_writel(dat, base + GPIODAT_OFF);
532         __raw_writel(con, base + GPIOCON_OFF);
533         __raw_writel(dat, base + GPIODAT_OFF);
534
535         pr_debug("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
536
537         return 0;
538 }
539
540 /*
541  * The next set of routines are for the case where the GPIO configuration
542  * registers are 4 bits per GPIO but there is more than one register (the
543  * bank has more than 8 GPIOs.
544  *
545  * This case is the similar to the 4 bit case, but the registers are as
546  * follows:
547  *
548  * base + 0x00: Control register, 4 bits per gpio (lower 8 GPIOs)
549  *              gpio n: 4 bits starting at (4*n)
550  *              0000 = input, 0001 = output, others mean special-function
551  * base + 0x04: Control register, 4 bits per gpio (up to 8 additions GPIOs)
552  *              gpio n: 4 bits starting at (4*n)
553  *              0000 = input, 0001 = output, others mean special-function
554  * base + 0x08: Data register, 1 bit per gpio
555  *              bit n: data bit n
556  *
557  * To allow us to use the samsung_gpiolib_get and samsung_gpiolib_set
558  * routines we store the 'base + 0x4' address so that these routines see
559  * the data register at ourchip->base + 0x04.
560  */
561
562 static int samsung_gpiolib_4bit2_input(struct gpio_chip *chip,
563                                        unsigned int offset)
564 {
565         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
566         void __iomem *base = ourchip->base;
567         void __iomem *regcon = base;
568         unsigned long con;
569
570         if (offset > 7)
571                 offset -= 8;
572         else
573                 regcon -= 4;
574
575         con = __raw_readl(regcon);
576         con &= ~(0xf << con_4bit_shift(offset));
577         __raw_writel(con, regcon);
578
579         pr_debug("%s: %p: CON %08lx\n", __func__, base, con);
580
581         return 0;
582 }
583
584 static int samsung_gpiolib_4bit2_output(struct gpio_chip *chip,
585                                         unsigned int offset, int value)
586 {
587         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
588         void __iomem *base = ourchip->base;
589         void __iomem *regcon = base;
590         unsigned long con;
591         unsigned long dat;
592         unsigned con_offset = offset;
593
594         if (con_offset > 7)
595                 con_offset -= 8;
596         else
597                 regcon -= 4;
598
599         con = __raw_readl(regcon);
600         con &= ~(0xf << con_4bit_shift(con_offset));
601         con |= 0x1 << con_4bit_shift(con_offset);
602
603         dat = __raw_readl(base + GPIODAT_OFF);
604
605         if (value)
606                 dat |= 1 << offset;
607         else
608                 dat &= ~(1 << offset);
609
610         __raw_writel(dat, base + GPIODAT_OFF);
611         __raw_writel(con, regcon);
612         __raw_writel(dat, base + GPIODAT_OFF);
613
614         pr_debug("%s: %p: CON %08lx, DAT %08lx\n", __func__, base, con, dat);
615
616         return 0;
617 }
618
619 #ifdef CONFIG_PLAT_S3C24XX
620 /* The next set of routines are for the case of s3c24xx bank a */
621
622 static int s3c24xx_gpiolib_banka_input(struct gpio_chip *chip, unsigned offset)
623 {
624         return -EINVAL;
625 }
626
627 static int s3c24xx_gpiolib_banka_output(struct gpio_chip *chip,
628                                         unsigned offset, int value)
629 {
630         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
631         void __iomem *base = ourchip->base;
632         unsigned long flags;
633         unsigned long dat;
634         unsigned long con;
635
636         local_irq_save(flags);
637
638         con = __raw_readl(base + 0x00);
639         dat = __raw_readl(base + 0x04);
640
641         dat &= ~(1 << offset);
642         if (value)
643                 dat |= 1 << offset;
644
645         __raw_writel(dat, base + 0x04);
646
647         con &= ~(1 << offset);
648
649         __raw_writel(con, base + 0x00);
650         __raw_writel(dat, base + 0x04);
651
652         local_irq_restore(flags);
653         return 0;
654 }
655 #endif
656
657 static void samsung_gpiolib_set(struct gpio_chip *chip,
658                                 unsigned offset, int value)
659 {
660         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
661         void __iomem *base = ourchip->base;
662         unsigned long flags;
663         unsigned long dat;
664
665         samsung_gpio_lock(ourchip, flags);
666
667         dat = __raw_readl(base + 0x04);
668         dat &= ~(1 << offset);
669         if (value)
670                 dat |= 1 << offset;
671         __raw_writel(dat, base + 0x04);
672
673         samsung_gpio_unlock(ourchip, flags);
674 }
675
676 static int samsung_gpiolib_get(struct gpio_chip *chip, unsigned offset)
677 {
678         struct samsung_gpio_chip *ourchip = to_samsung_gpio(chip);
679         unsigned long val;
680
681         val = __raw_readl(ourchip->base + 0x04);
682         val >>= offset;
683         val &= 1;
684
685         return val;
686 }
687
688 /*
689  * CONFIG_S3C_GPIO_TRACK enables the tracking of the s3c specific gpios
690  * for use with the configuration calls, and other parts of the s3c gpiolib
691  * support code.
692  *
693  * Not all s3c support code will need this, as some configurations of cpu
694  * may only support one or two different configuration options and have an
695  * easy gpio to samsung_gpio_chip mapping function. If this is the case, then
696  * the machine support file should provide its own samsung_gpiolib_getchip()
697  * and any other necessary functions.
698  */
699
700 #ifdef CONFIG_S3C_GPIO_TRACK
701 struct samsung_gpio_chip *s3c_gpios[S3C_GPIO_END];
702
703 static __init void s3c_gpiolib_track(struct samsung_gpio_chip *chip)
704 {
705         unsigned int gpn;
706         int i;
707
708         gpn = chip->chip.base;
709         for (i = 0; i < chip->chip.ngpio; i++, gpn++) {
710                 BUG_ON(gpn >= ARRAY_SIZE(s3c_gpios));
711                 s3c_gpios[gpn] = chip;
712         }
713 }
714 #endif /* CONFIG_S3C_GPIO_TRACK */
715
716 /*
717  * samsung_gpiolib_add() - add the Samsung gpio_chip.
718  * @chip: The chip to register
719  *
720  * This is a wrapper to gpiochip_add() that takes our specific gpio chip
721  * information and makes the necessary alterations for the platform and
722  * notes the information for use with the configuration systems and any
723  * other parts of the system.
724  */
725
726 static void __init samsung_gpiolib_add(struct samsung_gpio_chip *chip)
727 {
728         struct gpio_chip *gc = &chip->chip;
729         int ret;
730
731         BUG_ON(!chip->base);
732         BUG_ON(!gc->label);
733         BUG_ON(!gc->ngpio);
734
735         spin_lock_init(&chip->lock);
736
737         if (!gc->direction_input)
738                 gc->direction_input = samsung_gpiolib_2bit_input;
739         if (!gc->direction_output)
740                 gc->direction_output = samsung_gpiolib_2bit_output;
741         if (!gc->set)
742                 gc->set = samsung_gpiolib_set;
743         if (!gc->get)
744                 gc->get = samsung_gpiolib_get;
745
746 #ifdef CONFIG_PM
747         if (chip->pm != NULL) {
748                 if (!chip->pm->save || !chip->pm->resume)
749                         pr_err("gpio: %s has missing PM functions\n",
750                                gc->label);
751         } else
752                 pr_err("gpio: %s has no PM function\n", gc->label);
753 #endif
754
755         /* gpiochip_add() prints own failure message on error. */
756         ret = gpiochip_add(gc);
757         if (ret >= 0)
758                 s3c_gpiolib_track(chip);
759 }
760
761 static void __init s3c24xx_gpiolib_add_chips(struct samsung_gpio_chip *chip,
762                                              int nr_chips, void __iomem *base)
763 {
764         int i;
765         struct gpio_chip *gc = &chip->chip;
766
767         for (i = 0 ; i < nr_chips; i++, chip++) {
768                 /* skip banks not present on SoC */
769                 if (chip->chip.base >= S3C_GPIO_END)
770                         continue;
771
772                 if (!chip->config)
773                         chip->config = &s3c24xx_gpiocfg_default;
774                 if (!chip->pm)
775                         chip->pm = __gpio_pm(&samsung_gpio_pm_2bit);
776                 if ((base != NULL) && (chip->base == NULL))
777                         chip->base = base + ((i) * 0x10);
778
779                 if (!gc->direction_input)
780                         gc->direction_input = samsung_gpiolib_2bit_input;
781                 if (!gc->direction_output)
782                         gc->direction_output = samsung_gpiolib_2bit_output;
783
784                 samsung_gpiolib_add(chip);
785         }
786 }
787
788 static void __init samsung_gpiolib_add_2bit_chips(struct samsung_gpio_chip *chip,
789                                                   int nr_chips, void __iomem *base,
790                                                   unsigned int offset)
791 {
792         int i;
793
794         for (i = 0 ; i < nr_chips; i++, chip++) {
795                 chip->chip.direction_input = samsung_gpiolib_2bit_input;
796                 chip->chip.direction_output = samsung_gpiolib_2bit_output;
797
798                 if (!chip->config)
799                         chip->config = &samsung_gpio_cfgs[7];
800                 if (!chip->pm)
801                         chip->pm = __gpio_pm(&samsung_gpio_pm_2bit);
802                 if ((base != NULL) && (chip->base == NULL))
803                         chip->base = base + ((i) * offset);
804
805                 samsung_gpiolib_add(chip);
806         }
807 }
808
809 /*
810  * samsung_gpiolib_add_4bit_chips - 4bit single register GPIO config.
811  * @chip: The gpio chip that is being configured.
812  * @nr_chips: The no of chips (gpio ports) for the GPIO being configured.
813  *
814  * This helper deal with the GPIO cases where the control register has 4 bits
815  * of control per GPIO, generally in the form of:
816  * 0000 = Input
817  * 0001 = Output
818  * others = Special functions (dependent on bank)
819  *
820  * Note, since the code to deal with the case where there are two control
821  * registers instead of one, we do not have a separate set of function
822  * (samsung_gpiolib_add_4bit2_chips)for each case.
823  */
824
825 static void __init samsung_gpiolib_add_4bit_chips(struct samsung_gpio_chip *chip,
826                                                   int nr_chips, void __iomem *base)
827 {
828         int i;
829
830         for (i = 0 ; i < nr_chips; i++, chip++) {
831                 chip->chip.direction_input = samsung_gpiolib_4bit_input;
832                 chip->chip.direction_output = samsung_gpiolib_4bit_output;
833
834                 if (!chip->config)
835                         chip->config = &samsung_gpio_cfgs[2];
836                 if (!chip->pm)
837                         chip->pm = __gpio_pm(&samsung_gpio_pm_4bit);
838                 if ((base != NULL) && (chip->base == NULL))
839                         chip->base = base + ((i) * 0x20);
840
841                 chip->bitmap_gpio_int = 0;
842
843                 samsung_gpiolib_add(chip);
844         }
845 }
846
847 static void __init samsung_gpiolib_add_4bit2_chips(struct samsung_gpio_chip *chip,
848                                                    int nr_chips)
849 {
850         for (; nr_chips > 0; nr_chips--, chip++) {
851                 chip->chip.direction_input = samsung_gpiolib_4bit2_input;
852                 chip->chip.direction_output = samsung_gpiolib_4bit2_output;
853
854                 if (!chip->config)
855                         chip->config = &samsung_gpio_cfgs[2];
856                 if (!chip->pm)
857                         chip->pm = __gpio_pm(&samsung_gpio_pm_4bit);
858
859                 samsung_gpiolib_add(chip);
860         }
861 }
862
863 int samsung_gpiolib_to_irq(struct gpio_chip *chip, unsigned int offset)
864 {
865         struct samsung_gpio_chip *samsung_chip = container_of(chip, struct samsung_gpio_chip, chip);
866
867         return samsung_chip->irq_base + offset;
868 }
869
870 #ifdef CONFIG_PLAT_S3C24XX
871 static int s3c24xx_gpiolib_fbank_to_irq(struct gpio_chip *chip, unsigned offset)
872 {
873         if (offset < 4) {
874                 if (soc_is_s3c2412())
875                         return IRQ_EINT0_2412 + offset;
876                 else
877                         return IRQ_EINT0 + offset;
878         }
879
880         if (offset < 8)
881                 return IRQ_EINT4 + offset - 4;
882
883         return -EINVAL;
884 }
885 #endif
886
887 #ifdef CONFIG_ARCH_S3C64XX
888 static int s3c64xx_gpiolib_mbank_to_irq(struct gpio_chip *chip, unsigned pin)
889 {
890         return pin < 5 ? IRQ_EINT(23) + pin : -ENXIO;
891 }
892
893 static int s3c64xx_gpiolib_lbank_to_irq(struct gpio_chip *chip, unsigned pin)
894 {
895         return pin >= 8 ? IRQ_EINT(16) + pin - 8 : -ENXIO;
896 }
897 #endif
898
899 struct samsung_gpio_chip s3c24xx_gpios[] = {
900 #ifdef CONFIG_PLAT_S3C24XX
901         {
902                 .config = &s3c24xx_gpiocfg_banka,
903                 .chip   = {
904                         .base                   = S3C2410_GPA(0),
905                         .owner                  = THIS_MODULE,
906                         .label                  = "GPIOA",
907                         .ngpio                  = 27,
908                         .direction_input        = s3c24xx_gpiolib_banka_input,
909                         .direction_output       = s3c24xx_gpiolib_banka_output,
910                 },
911         }, {
912                 .chip   = {
913                         .base   = S3C2410_GPB(0),
914                         .owner  = THIS_MODULE,
915                         .label  = "GPIOB",
916                         .ngpio  = 11,
917                 },
918         }, {
919                 .chip   = {
920                         .base   = S3C2410_GPC(0),
921                         .owner  = THIS_MODULE,
922                         .label  = "GPIOC",
923                         .ngpio  = 16,
924                 },
925         }, {
926                 .chip   = {
927                         .base   = S3C2410_GPD(0),
928                         .owner  = THIS_MODULE,
929                         .label  = "GPIOD",
930                         .ngpio  = 16,
931                 },
932         }, {
933                 .chip   = {
934                         .base   = S3C2410_GPE(0),
935                         .label  = "GPIOE",
936                         .owner  = THIS_MODULE,
937                         .ngpio  = 16,
938                 },
939         }, {
940                 .chip   = {
941                         .base   = S3C2410_GPF(0),
942                         .owner  = THIS_MODULE,
943                         .label  = "GPIOF",
944                         .ngpio  = 8,
945                         .to_irq = s3c24xx_gpiolib_fbank_to_irq,
946                 },
947         }, {
948                 .irq_base = IRQ_EINT8,
949                 .chip   = {
950                         .base   = S3C2410_GPG(0),
951                         .owner  = THIS_MODULE,
952                         .label  = "GPIOG",
953                         .ngpio  = 16,
954                         .to_irq = samsung_gpiolib_to_irq,
955                 },
956         }, {
957                 .chip   = {
958                         .base   = S3C2410_GPH(0),
959                         .owner  = THIS_MODULE,
960                         .label  = "GPIOH",
961                         .ngpio  = 15,
962                 },
963         },
964                 /* GPIOS for the S3C2443 and later devices. */
965         {
966                 .base   = S3C2440_GPJCON,
967                 .chip   = {
968                         .base   = S3C2410_GPJ(0),
969                         .owner  = THIS_MODULE,
970                         .label  = "GPIOJ",
971                         .ngpio  = 16,
972                 },
973         }, {
974                 .base   = S3C2443_GPKCON,
975                 .chip   = {
976                         .base   = S3C2410_GPK(0),
977                         .owner  = THIS_MODULE,
978                         .label  = "GPIOK",
979                         .ngpio  = 16,
980                 },
981         }, {
982                 .base   = S3C2443_GPLCON,
983                 .chip   = {
984                         .base   = S3C2410_GPL(0),
985                         .owner  = THIS_MODULE,
986                         .label  = "GPIOL",
987                         .ngpio  = 15,
988                 },
989         }, {
990                 .base   = S3C2443_GPMCON,
991                 .chip   = {
992                         .base   = S3C2410_GPM(0),
993                         .owner  = THIS_MODULE,
994                         .label  = "GPIOM",
995                         .ngpio  = 2,
996                 },
997         },
998 #endif
999 };
1000
1001 /*
1002  * GPIO bank summary:
1003  *
1004  * Bank GPIOs   Style   SlpCon  ExtInt Group
1005  * A    8       4Bit    Yes     1
1006  * B    7       4Bit    Yes     1
1007  * C    8       4Bit    Yes     2
1008  * D    5       4Bit    Yes     3
1009  * E    5       4Bit    Yes     None
1010  * F    16      2Bit    Yes     4 [1]
1011  * G    7       4Bit    Yes     5
1012  * H    10      4Bit[2] Yes     6
1013  * I    16      2Bit    Yes     None
1014  * J    12      2Bit    Yes     None
1015  * K    16      4Bit[2] No      None
1016  * L    15      4Bit[2] No      None
1017  * M    6       4Bit    No      IRQ_EINT
1018  * N    16      2Bit    No      IRQ_EINT
1019  * O    16      2Bit    Yes     7
1020  * P    15      2Bit    Yes     8
1021  * Q    9       2Bit    Yes     9
1022  *
1023  * [1] BANKF pins 14,15 do not form part of the external interrupt sources
1024  * [2] BANK has two control registers, GPxCON0 and GPxCON1
1025  */
1026
1027 static struct samsung_gpio_chip s3c64xx_gpios_4bit[] = {
1028 #ifdef CONFIG_ARCH_S3C64XX
1029         {
1030                 .chip   = {
1031                         .base   = S3C64XX_GPA(0),
1032                         .ngpio  = S3C64XX_GPIO_A_NR,
1033                         .label  = "GPA",
1034                 },
1035         }, {
1036                 .chip   = {
1037                         .base   = S3C64XX_GPB(0),
1038                         .ngpio  = S3C64XX_GPIO_B_NR,
1039                         .label  = "GPB",
1040                 },
1041         }, {
1042                 .chip   = {
1043                         .base   = S3C64XX_GPC(0),
1044                         .ngpio  = S3C64XX_GPIO_C_NR,
1045                         .label  = "GPC",
1046                 },
1047         }, {
1048                 .chip   = {
1049                         .base   = S3C64XX_GPD(0),
1050                         .ngpio  = S3C64XX_GPIO_D_NR,
1051                         .label  = "GPD",
1052                 },
1053         }, {
1054                 .config = &samsung_gpio_cfgs[0],
1055                 .chip   = {
1056                         .base   = S3C64XX_GPE(0),
1057                         .ngpio  = S3C64XX_GPIO_E_NR,
1058                         .label  = "GPE",
1059                 },
1060         }, {
1061                 .base   = S3C64XX_GPG_BASE,
1062                 .chip   = {
1063                         .base   = S3C64XX_GPG(0),
1064                         .ngpio  = S3C64XX_GPIO_G_NR,
1065                         .label  = "GPG",
1066                 },
1067         }, {
1068                 .base   = S3C64XX_GPM_BASE,
1069                 .config = &samsung_gpio_cfgs[1],
1070                 .chip   = {
1071                         .base   = S3C64XX_GPM(0),
1072                         .ngpio  = S3C64XX_GPIO_M_NR,
1073                         .label  = "GPM",
1074                         .to_irq = s3c64xx_gpiolib_mbank_to_irq,
1075                 },
1076         },
1077 #endif
1078 };
1079
1080 static struct samsung_gpio_chip s3c64xx_gpios_4bit2[] = {
1081 #ifdef CONFIG_ARCH_S3C64XX
1082         {
1083                 .base   = S3C64XX_GPH_BASE + 0x4,
1084                 .chip   = {
1085                         .base   = S3C64XX_GPH(0),
1086                         .ngpio  = S3C64XX_GPIO_H_NR,
1087                         .label  = "GPH",
1088                 },
1089         }, {
1090                 .base   = S3C64XX_GPK_BASE + 0x4,
1091                 .config = &samsung_gpio_cfgs[0],
1092                 .chip   = {
1093                         .base   = S3C64XX_GPK(0),
1094                         .ngpio  = S3C64XX_GPIO_K_NR,
1095                         .label  = "GPK",
1096                 },
1097         }, {
1098                 .base   = S3C64XX_GPL_BASE + 0x4,
1099                 .config = &samsung_gpio_cfgs[1],
1100                 .chip   = {
1101                         .base   = S3C64XX_GPL(0),
1102                         .ngpio  = S3C64XX_GPIO_L_NR,
1103                         .label  = "GPL",
1104                         .to_irq = s3c64xx_gpiolib_lbank_to_irq,
1105                 },
1106         },
1107 #endif
1108 };
1109
1110 static struct samsung_gpio_chip s3c64xx_gpios_2bit[] = {
1111 #ifdef CONFIG_ARCH_S3C64XX
1112         {
1113                 .base   = S3C64XX_GPF_BASE,
1114                 .config = &samsung_gpio_cfgs[6],
1115                 .chip   = {
1116                         .base   = S3C64XX_GPF(0),
1117                         .ngpio  = S3C64XX_GPIO_F_NR,
1118                         .label  = "GPF",
1119                 },
1120         }, {
1121                 .config = &samsung_gpio_cfgs[7],
1122                 .chip   = {
1123                         .base   = S3C64XX_GPI(0),
1124                         .ngpio  = S3C64XX_GPIO_I_NR,
1125                         .label  = "GPI",
1126                 },
1127         }, {
1128                 .config = &samsung_gpio_cfgs[7],
1129                 .chip   = {
1130                         .base   = S3C64XX_GPJ(0),
1131                         .ngpio  = S3C64XX_GPIO_J_NR,
1132                         .label  = "GPJ",
1133                 },
1134         }, {
1135                 .config = &samsung_gpio_cfgs[6],
1136                 .chip   = {
1137                         .base   = S3C64XX_GPO(0),
1138                         .ngpio  = S3C64XX_GPIO_O_NR,
1139                         .label  = "GPO",
1140                 },
1141         }, {
1142                 .config = &samsung_gpio_cfgs[6],
1143                 .chip   = {
1144                         .base   = S3C64XX_GPP(0),
1145                         .ngpio  = S3C64XX_GPIO_P_NR,
1146                         .label  = "GPP",
1147                 },
1148         }, {
1149                 .config = &samsung_gpio_cfgs[6],
1150                 .chip   = {
1151                         .base   = S3C64XX_GPQ(0),
1152                         .ngpio  = S3C64XX_GPIO_Q_NR,
1153                         .label  = "GPQ",
1154                 },
1155         }, {
1156                 .base   = S3C64XX_GPN_BASE,
1157                 .irq_base = IRQ_EINT(0),
1158                 .config = &samsung_gpio_cfgs[5],
1159                 .chip   = {
1160                         .base   = S3C64XX_GPN(0),
1161                         .ngpio  = S3C64XX_GPIO_N_NR,
1162                         .label  = "GPN",
1163                         .to_irq = samsung_gpiolib_to_irq,
1164                 },
1165         },
1166 #endif
1167 };
1168
1169 /* TODO: cleanup soc_is_* */
1170 static __init int samsung_gpiolib_init(void)
1171 {
1172         /*
1173          * Currently there are two drivers that can provide GPIO support for
1174          * Samsung SoCs. For device tree enabled platforms, the new
1175          * pinctrl-samsung driver is used, providing both GPIO and pin control
1176          * interfaces. For legacy (non-DT) platforms this driver is used.
1177          */
1178         if (of_have_populated_dt())
1179                 return -ENODEV;
1180
1181         samsung_gpiolib_set_cfg(samsung_gpio_cfgs, ARRAY_SIZE(samsung_gpio_cfgs));
1182
1183         if (soc_is_s3c24xx()) {
1184                 s3c24xx_gpiolib_add_chips(s3c24xx_gpios,
1185                                 ARRAY_SIZE(s3c24xx_gpios), S3C24XX_VA_GPIO);
1186         } else if (soc_is_s3c64xx()) {
1187                 samsung_gpiolib_add_2bit_chips(s3c64xx_gpios_2bit,
1188                                 ARRAY_SIZE(s3c64xx_gpios_2bit),
1189                                 S3C64XX_VA_GPIO + 0xE0, 0x20);
1190                 samsung_gpiolib_add_4bit_chips(s3c64xx_gpios_4bit,
1191                                 ARRAY_SIZE(s3c64xx_gpios_4bit),
1192                                 S3C64XX_VA_GPIO);
1193                 samsung_gpiolib_add_4bit2_chips(s3c64xx_gpios_4bit2,
1194                                 ARRAY_SIZE(s3c64xx_gpios_4bit2));
1195         } else {
1196                 WARN(1, "Unknown SoC in gpio-samsung, no GPIOs added\n");
1197                 return -ENODEV;
1198         }
1199
1200         return 0;
1201 }
1202 core_initcall(samsung_gpiolib_init);
1203
1204 int s3c_gpio_cfgpin(unsigned int pin, unsigned int config)
1205 {
1206         struct samsung_gpio_chip *chip = samsung_gpiolib_getchip(pin);
1207         unsigned long flags;
1208         int offset;
1209         int ret;
1210
1211         if (!chip)
1212                 return -EINVAL;
1213
1214         offset = pin - chip->chip.base;
1215
1216         samsung_gpio_lock(chip, flags);
1217         ret = samsung_gpio_do_setcfg(chip, offset, config);
1218         samsung_gpio_unlock(chip, flags);
1219
1220         return ret;
1221 }
1222 EXPORT_SYMBOL(s3c_gpio_cfgpin);
1223
1224 int s3c_gpio_cfgpin_range(unsigned int start, unsigned int nr,
1225                           unsigned int cfg)
1226 {
1227         int ret;
1228
1229         for (; nr > 0; nr--, start++) {
1230                 ret = s3c_gpio_cfgpin(start, cfg);
1231                 if (ret != 0)
1232                         return ret;
1233         }
1234
1235         return 0;
1236 }
1237 EXPORT_SYMBOL_GPL(s3c_gpio_cfgpin_range);
1238
1239 int s3c_gpio_cfgall_range(unsigned int start, unsigned int nr,
1240                           unsigned int cfg, samsung_gpio_pull_t pull)
1241 {
1242         int ret;
1243
1244         for (; nr > 0; nr--, start++) {
1245                 s3c_gpio_setpull(start, pull);
1246                 ret = s3c_gpio_cfgpin(start, cfg);
1247                 if (ret != 0)
1248                         return ret;
1249         }
1250
1251         return 0;
1252 }
1253 EXPORT_SYMBOL_GPL(s3c_gpio_cfgall_range);
1254
1255 unsigned s3c_gpio_getcfg(unsigned int pin)
1256 {
1257         struct samsung_gpio_chip *chip = samsung_gpiolib_getchip(pin);
1258         unsigned long flags;
1259         unsigned ret = 0;
1260         int offset;
1261
1262         if (chip) {
1263                 offset = pin - chip->chip.base;
1264
1265                 samsung_gpio_lock(chip, flags);
1266                 ret = samsung_gpio_do_getcfg(chip, offset);
1267                 samsung_gpio_unlock(chip, flags);
1268         }
1269
1270         return ret;
1271 }
1272 EXPORT_SYMBOL(s3c_gpio_getcfg);
1273
1274 int s3c_gpio_setpull(unsigned int pin, samsung_gpio_pull_t pull)
1275 {
1276         struct samsung_gpio_chip *chip = samsung_gpiolib_getchip(pin);
1277         unsigned long flags;
1278         int offset, ret;
1279
1280         if (!chip)
1281                 return -EINVAL;
1282
1283         offset = pin - chip->chip.base;
1284
1285         samsung_gpio_lock(chip, flags);
1286         ret = samsung_gpio_do_setpull(chip, offset, pull);
1287         samsung_gpio_unlock(chip, flags);
1288
1289         return ret;
1290 }
1291 EXPORT_SYMBOL(s3c_gpio_setpull);
1292
1293 samsung_gpio_pull_t s3c_gpio_getpull(unsigned int pin)
1294 {
1295         struct samsung_gpio_chip *chip = samsung_gpiolib_getchip(pin);
1296         unsigned long flags;
1297         int offset;
1298         u32 pup = 0;
1299
1300         if (chip) {
1301                 offset = pin - chip->chip.base;
1302
1303                 samsung_gpio_lock(chip, flags);
1304                 pup = samsung_gpio_do_getpull(chip, offset);
1305                 samsung_gpio_unlock(chip, flags);
1306         }
1307
1308         return (__force samsung_gpio_pull_t)pup;
1309 }
1310 EXPORT_SYMBOL(s3c_gpio_getpull);
1311
1312 #ifdef CONFIG_PLAT_S3C24XX
1313 unsigned int s3c2410_modify_misccr(unsigned int clear, unsigned int change)
1314 {
1315         unsigned long flags;
1316         unsigned long misccr;
1317
1318         local_irq_save(flags);
1319         misccr = __raw_readl(S3C24XX_MISCCR);
1320         misccr &= ~clear;
1321         misccr ^= change;
1322         __raw_writel(misccr, S3C24XX_MISCCR);
1323         local_irq_restore(flags);
1324
1325         return misccr;
1326 }
1327 EXPORT_SYMBOL(s3c2410_modify_misccr);
1328 #endif