2  *  linux/arch/arm/mach-pxa/mfp-pxa2xx.c
16 #include <linux/gpio-pxa.h>
23 #include <mach/pxa2xx-regs.h>
24 #include "mfp-pxa2xx.h"
33 #define BANK_OFF(n)	(((n) < 3) ? (n) << 2 : 0x100 + (((n) - 3) << 2))
42 	unsigned	valid		: 1;  member
46 	unsigned int	mask; /* bit mask in PWER or PKWR */  member
47 	unsigned int	mux_mask; /* bit mask of muxed gpio bits, 0 if no mux */
57 	unsigned long gafr, mask = GPIO_bit(gpio);  in __mfp_config_gpio()  local
65 		return -EINVAL;  in __mfp_config_gpio()
67 	/* alternate function and direction at run-time */  in __mfp_config_gpio()
77 		GPDR(gpio) |= mask;  in __mfp_config_gpio()
79 		GPDR(gpio) &= ~mask;  in __mfp_config_gpio()
84 		PGSR(bank) |= mask;  in __mfp_config_gpio()
88 		PGSR(bank) &= ~mask;  in __mfp_config_gpio()
102 		gpdr_lpm[bank] |= mask;  in __mfp_config_gpio()
104 		gpdr_lpm[bank] &= ~mask;  in __mfp_config_gpio()
111 		return -EINVAL;  in __mfp_config_gpio()
116 		return -EINVAL;  in __mfp_config_gpio()
126 	if ((mfp > MFP_PIN_GPIO127) || !gpio_desc[gpio].valid) {  in __mfp_validate()
128 		return -1;  in __mfp_validate()
179 		return -EINVAL;  in gpio_set_wake()
182 	c = d->config;  in gpio_set_wake()
184 	if (!d->valid)  in gpio_set_wake()
185 		return -EINVAL;  in gpio_set_wake()
190 	if (d->keypad_gpio && (MFP_AF(d->config) == 0) &&  in gpio_set_wake()
191 	    (d->config & MFP_LPM_CAN_WAKEUP)) {  in gpio_set_wake()
193 			PKWR |= d->mask;  in gpio_set_wake()
195 			PKWR &= ~d->mask;  in gpio_set_wake()
199 	mux_taken = (PWER & d->mux_mask) & (~d->mask);  in gpio_set_wake()
201 		return -EBUSY;  in gpio_set_wake()
203 	if (d->can_wakeup && (c & MFP_LPM_CAN_WAKEUP)) {  in gpio_set_wake()
205 			PWER = (PWER & ~d->mux_mask) | d->mask;  in gpio_set_wake()
208 				PRER |= d->mask;  in gpio_set_wake()
210 				PRER &= ~d->mask;  in gpio_set_wake()
213 				PFER |= d->mask;  in gpio_set_wake()
215 				PFER &= ~d->mask;  in gpio_set_wake()
217 			PWER &= ~d->mask;  in gpio_set_wake()
218 			PRER &= ~d->mask;  in gpio_set_wake()
219 			PFER &= ~d->mask;  in gpio_set_wake()
237 		gpio_desc[i].valid = 1;  in pxa25x_mfp_init()
241 		gpio_desc[i].mask = GPIO_bit(i);  in pxa25x_mfp_init()
262 	unsigned int i, gpio, mask = 0;  in keypad_set_wake()  local
271 		if (MFP_AF(d->config) == 0)  in keypad_set_wake()
274 		if (d->config & MFP_LPM_CAN_WAKEUP)  in keypad_set_wake()
275 			mask |= gpio_desc[gpio].mask;  in keypad_set_wake()
279 		PKWR |= mask;  in keypad_set_wake()
281 		PKWR &= ~mask;  in keypad_set_wake()
297 	gpio_desc[(gpio)].mask = PWER_ ## mux ## _GPIO ##gpio;	\
308 		 * valid pins allow configuration  in pxa27x_mfp_init()
313 		gpio_desc[i].valid = 1;  in pxa27x_mfp_init()
321 		gpio_desc[gpio].mask = 1 << i;  in pxa27x_mfp_init()
331 		gpio_desc[i].mask = GPIO_bit(i);  in pxa27x_mfp_init()
335 	gpio_desc[35].mask = PWER_WE35;  in pxa27x_mfp_init()