| 123456789101112131415161718192021222324252627282930313233 |
- --- 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);
|