ralink: fix the gpio mode mapping

Signed-off-by: John Crispin <blogic@openwrt.org>

SVN-Revision: 39609
This commit is contained in:
John Crispin 2014-02-18 13:33:16 +00:00
parent 9bf6569f68
commit 363512b8c6
1 changed files with 35 additions and 0 deletions

View File

@ -0,0 +1,35 @@
Index: linux-3.10.28/drivers/pinctrl/pinctrl-rt2880.c
===================================================================
--- linux-3.10.28.orig/drivers/pinctrl/pinctrl-rt2880.c 2014-02-14 10:46:06.216549358 +0000
+++ linux-3.10.28/drivers/pinctrl/pinctrl-rt2880.c 2014-02-14 14:58:18.580040433 +0000
@@ -204,6 +204,7 @@
{
struct rt2880_priv *p = pinctrl_dev_get_drvdata(pctrldev);
u32 mode = 0;
+ int i;
/* dont allow double use */
if (p->groups[group].enabled) {
@@ -217,16 +218,16 @@
mode = rt_sysc_r32(SYSC_REG_GPIO_MODE);
mode &= ~(p->groups[group].mask << p->groups[group].shift);
+ /* mark the pins as gpio */
+ for (i = 0; i < p->groups[group].func[0].pin_count; i++)
+ p->gpio[p->groups[group].func[0].pins[i]] = 1;
+
/* function 0 is gpio and needs special handling */
if (func == 0) {
- int i;
-
-
mode |= p->groups[group].gpio << p->groups[group].shift;
- /* mark the pins as gpio */
- for (i = 0; i < p->groups[group].func[0].pin_count; i++)
- p->gpio[p->groups[group].func[0].pins[i]] = 1;
} else {
+ for (i = 0; i < p->func[func]->pin_count; i++)
+ p->gpio[p->func[func]->pins[i]] = 0;
mode |= p->func[func]->value << p->groups[group].shift;
}
rt_sysc_w32(mode, SYSC_REG_GPIO_MODE);