2 * linux/arch/arm/mach-pxa/mfp-pxa2xx.c
4 * PXA2xx pin mux configuration support
6 * The GPIOs on PXA2xx can be configured as one of many alternate
7 * functions, this is by concept samilar to the MFP configuration
8 * on PXA3xx, what's more important, the low power pin state and
9 * wakeup detection are also supported by the same framework.
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/module.h>
17 #include <linux/kernel.h>
18 #include <linux/init.h>
19 #include <linux/sysdev.h>
21 #include <mach/hardware.h>
22 #include <mach/pxa-regs.h>
23 #include <mach/pxa2xx-regs.h>
24 #include <mach/mfp-pxa2xx.h>
28 #define gpio_to_bank(gpio) ((gpio) >> 5)
30 #define PGSR(x) __REG2(0x40F00020, (x) << 2)
31 #define __GAFR(u, x) __REG2((u) ? 0x40E00058 : 0x40E00054, (x) << 3)
32 #define GAFR_L(x) __GAFR(0, x)
33 #define GAFR_U(x) __GAFR(1, x)
35 #define PWER_WE35 (1 << 24)
39 unsigned can_wakeup
: 1;
40 unsigned keypad_gpio
: 1;
41 unsigned dir_inverted
: 1;
42 unsigned int mask
; /* bit mask in PWER or PKWR */
43 unsigned int mux_mask
; /* bit mask of muxed gpio bits, 0 if no mux */
47 static struct gpio_desc gpio_desc
[MFP_PIN_GPIO127
+ 1];
49 static unsigned long gpdr_lpm
[4];
51 static int __mfp_config_gpio(unsigned gpio
, unsigned long c
)
53 unsigned long gafr
, mask
= GPIO_bit(gpio
);
54 int bank
= gpio_to_bank(gpio
);
55 int uorl
= !!(gpio
& 0x10); /* GAFRx_U or GAFRx_L ? */
56 int shft
= (gpio
& 0xf) << 1;
58 int is_out
= (c
& MFP_DIR_OUT
) ? 1 : 0;
63 /* alternate function and direction at run-time */
64 gafr
= (uorl
== 0) ? GAFR_L(bank
) : GAFR_U(bank
);
65 gafr
= (gafr
& ~(0x3 << shft
)) | (fn
<< shft
);
72 if (is_out
^ gpio_desc
[gpio
].dir_inverted
)
77 /* alternate function and direction at low power mode */
78 switch (c
& MFP_LPM_STATE_MASK
) {
79 case MFP_LPM_DRIVE_HIGH
:
83 case MFP_LPM_DRIVE_LOW
:
90 /* warning and fall through, treat as MFP_LPM_DEFAULT */
91 pr_warning("%s: GPIO%d: unsupported low power mode\n",
96 if (is_out
^ gpio_desc
[gpio
].dir_inverted
)
97 gpdr_lpm
[bank
] |= mask
;
99 gpdr_lpm
[bank
] &= ~mask
;
101 /* give early warning if MFP_LPM_CAN_WAKEUP is set on the
102 * configurations of those pins not able to wakeup
104 if ((c
& MFP_LPM_CAN_WAKEUP
) && !gpio_desc
[gpio
].can_wakeup
) {
105 pr_warning("%s: GPIO%d unable to wakeup\n",
110 if ((c
& MFP_LPM_CAN_WAKEUP
) && is_out
) {
111 pr_warning("%s: output GPIO%d unable to wakeup\n",
119 static inline int __mfp_validate(int mfp
)
121 int gpio
= mfp_to_gpio(mfp
);
123 if ((mfp
> MFP_PIN_GPIO127
) || !gpio_desc
[gpio
].valid
) {
124 pr_warning("%s: GPIO%d is invalid pin\n", __func__
, gpio
);
131 void pxa2xx_mfp_config(unsigned long *mfp_cfgs
, int num
)
137 for (i
= 0, c
= mfp_cfgs
; i
< num
; i
++, c
++) {
139 gpio
= __mfp_validate(MFP_PIN(*c
));
143 local_irq_save(flags
);
145 gpio_desc
[gpio
].config
= *c
;
146 __mfp_config_gpio(gpio
, *c
);
148 local_irq_restore(flags
);
152 void pxa2xx_mfp_set_lpm(int mfp
, unsigned long lpm
)
154 unsigned long flags
, c
;
157 gpio
= __mfp_validate(mfp
);
161 local_irq_save(flags
);
163 c
= gpio_desc
[gpio
].config
;
164 c
= (c
& ~MFP_LPM_STATE_MASK
) | lpm
;
165 __mfp_config_gpio(gpio
, c
);
167 local_irq_restore(flags
);
170 int gpio_set_wake(unsigned int gpio
, unsigned int on
)
173 unsigned long c
, mux_taken
;
175 if (gpio
> mfp_to_gpio(MFP_PIN_GPIO127
))
178 d
= &gpio_desc
[gpio
];
187 mux_taken
= (PWER
& d
->mux_mask
) & (~d
->mask
);
191 if (d
->can_wakeup
&& (c
& MFP_LPM_CAN_WAKEUP
)) {
193 PWER
= (PWER
& ~d
->mux_mask
) | d
->mask
;
195 if (c
& MFP_LPM_EDGE_RISE
)
200 if (c
& MFP_LPM_EDGE_FALL
)
214 static void __init
pxa25x_mfp_init(void)
218 for (i
= 0; i
<= pxa_last_gpio
; i
++)
219 gpio_desc
[i
].valid
= 1;
221 for (i
= 0; i
<= 15; i
++) {
222 gpio_desc
[i
].can_wakeup
= 1;
223 gpio_desc
[i
].mask
= GPIO_bit(i
);
226 /* PXA26x has additional 4 GPIOs (86/87/88/89) which has the
227 * direction bit inverted in GPDR2. See PXA26x DM 4.1.1.
229 for (i
= 86; i
<= pxa_last_gpio
; i
++)
230 gpio_desc
[i
].dir_inverted
= 1;
233 static inline void pxa25x_mfp_init(void) {}
234 #endif /* CONFIG_PXA25x */
237 static int pxa27x_pkwr_gpio
[] = {
238 13, 16, 17, 34, 36, 37, 38, 39, 90, 91, 93, 94,
239 95, 96, 97, 98, 99, 100, 101, 102
242 int keypad_set_wake(unsigned int on
)
244 unsigned int i
, gpio
, mask
= 0;
251 for (i
= 0; i
< ARRAY_SIZE(pxa27x_pkwr_gpio
); i
++) {
253 gpio
= pxa27x_pkwr_gpio
[i
];
255 if (gpio_desc
[gpio
].config
& MFP_LPM_CAN_WAKEUP
)
256 mask
|= gpio_desc
[gpio
].mask
;
263 #define PWER_WEMUX2_GPIO38 (1 << 16)
264 #define PWER_WEMUX2_GPIO53 (2 << 16)
265 #define PWER_WEMUX2_GPIO40 (3 << 16)
266 #define PWER_WEMUX2_GPIO36 (4 << 16)
267 #define PWER_WEMUX2_MASK (7 << 16)
268 #define PWER_WEMUX3_GPIO31 (1 << 19)
269 #define PWER_WEMUX3_GPIO113 (2 << 19)
270 #define PWER_WEMUX3_MASK (3 << 19)
272 #define INIT_GPIO_DESC_MUXED(mux, gpio) \
274 gpio_desc[(gpio)].can_wakeup = 1; \
275 gpio_desc[(gpio)].mask = PWER_ ## mux ## _GPIO ##gpio; \
276 gpio_desc[(gpio)].mux_mask = PWER_ ## mux ## _MASK; \
279 static void __init
pxa27x_mfp_init(void)
283 for (i
= 0; i
<= pxa_last_gpio
; i
++) {
284 /* skip GPIO2, 5, 6, 7, 8, they are not
285 * valid pins allow configuration
287 if (i
== 2 || i
== 5 || i
== 6 || i
== 7 || i
== 8)
290 gpio_desc
[i
].valid
= 1;
294 for (i
= 0; i
< ARRAY_SIZE(pxa27x_pkwr_gpio
); i
++) {
295 gpio
= pxa27x_pkwr_gpio
[i
];
296 gpio_desc
[gpio
].can_wakeup
= 1;
297 gpio_desc
[gpio
].keypad_gpio
= 1;
298 gpio_desc
[gpio
].mask
= 1 << i
;
301 /* Overwrite GPIO13 as a PWER wakeup source */
302 for (i
= 0; i
<= 15; i
++) {
303 /* skip GPIO2, 5, 6, 7, 8 */
304 if (GPIO_bit(i
) & 0x1e4)
307 gpio_desc
[i
].can_wakeup
= 1;
308 gpio_desc
[i
].mask
= GPIO_bit(i
);
311 gpio_desc
[35].can_wakeup
= 1;
312 gpio_desc
[35].mask
= PWER_WE35
;
314 INIT_GPIO_DESC_MUXED(WEMUX3
, 31);
315 INIT_GPIO_DESC_MUXED(WEMUX3
, 113);
316 INIT_GPIO_DESC_MUXED(WEMUX2
, 38);
317 INIT_GPIO_DESC_MUXED(WEMUX2
, 53);
318 INIT_GPIO_DESC_MUXED(WEMUX2
, 40);
319 INIT_GPIO_DESC_MUXED(WEMUX2
, 36);
322 static inline void pxa27x_mfp_init(void) {}
323 #endif /* CONFIG_PXA27x */
326 static unsigned long saved_gafr
[2][4];
327 static unsigned long saved_gpdr
[4];
329 static int pxa2xx_mfp_suspend(struct sys_device
*d
, pm_message_t state
)
333 for (i
= 0; i
<= gpio_to_bank(pxa_last_gpio
); i
++) {
335 saved_gafr
[0][i
] = GAFR_L(i
);
336 saved_gafr
[1][i
] = GAFR_U(i
);
337 saved_gpdr
[i
] = GPDR(i
* 32);
339 GPDR(i
* 32) = gpdr_lpm
[i
];
344 static int pxa2xx_mfp_resume(struct sys_device
*d
)
348 for (i
= 0; i
<= gpio_to_bank(pxa_last_gpio
); i
++) {
349 GAFR_L(i
) = saved_gafr
[0][i
];
350 GAFR_U(i
) = saved_gafr
[1][i
];
351 GPDR(i
* 32) = saved_gpdr
[i
];
353 PSSR
= PSSR_RDH
| PSSR_PH
;
357 #define pxa2xx_mfp_suspend NULL
358 #define pxa2xx_mfp_resume NULL
361 struct sysdev_class pxa2xx_mfp_sysclass
= {
363 .suspend
= pxa2xx_mfp_suspend
,
364 .resume
= pxa2xx_mfp_resume
,
367 static int __init
pxa2xx_mfp_init(void)
371 if (!cpu_is_pxa2xx())
380 /* initialize gafr_run[], pgsr_lpm[] from existing values */
381 for (i
= 0; i
<= gpio_to_bank(pxa_last_gpio
); i
++)
382 gpdr_lpm
[i
] = GPDR(i
* 32);
384 return sysdev_class_register(&pxa2xx_mfp_sysclass
);
386 postcore_initcall(pxa2xx_mfp_init
);