33 lines
1.1 KiB
Diff
33 lines
1.1 KiB
Diff
--- a/drivers/pinctrl/pinctrl-rt2880.c
|
|
+++ b/drivers/pinctrl/pinctrl-rt2880.c
|
|
@@ -204,6 +204,7 @@ static int rt2880_pmx_group_enable(struc
|
|
{
|
|
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 @@ static int rt2880_pmx_group_enable(struc
|
|
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);
|