Commit 7101e022 authored by Andy Shevchenko's avatar Andy Shevchenko

pinctrl: intel: Introduce intel_restore_hostown() helper

Refactor restoring HOSTSW_OWN registers by using an introduced helper.
Signed-off-by: default avatarAndy Shevchenko <andriy.shevchenko@linux.intel.com>
Acked-by: default avatarMika Westerberg <mika.westerberg@linux.intel.com>
parent f78f152a
...@@ -1607,6 +1607,25 @@ intel_gpio_update_pad_mode(void __iomem *hostown, u32 mask, u32 value) ...@@ -1607,6 +1607,25 @@ intel_gpio_update_pad_mode(void __iomem *hostown, u32 mask, u32 value)
return curr; return curr;
} }
static void intel_restore_hostown(struct intel_pinctrl *pctrl, unsigned int c,
void __iomem *base, unsigned int gpp, u32 saved)
{
const struct intel_community *community = &pctrl->communities[c];
const struct intel_padgroup *padgrp = &community->gpps[gpp];
struct device *dev = pctrl->dev;
u32 requested, value;
if (padgrp->gpio_base < 0)
return;
requested = intel_gpio_is_requested(&pctrl->chip, padgrp->gpio_base, padgrp->size);
value = intel_gpio_update_pad_mode(base + gpp * 4, requested, saved);
if (!((value ^ saved) & requested))
return;
dev_warn(dev, "restored hostown %u/%u %#8x->%#8x\n", c, gpp, value, saved);
}
static void intel_restore_padcfg(struct intel_pinctrl *pctrl, unsigned int pin, static void intel_restore_padcfg(struct intel_pinctrl *pctrl, unsigned int pin,
unsigned int reg, u32 saved) unsigned int reg, u32 saved)
{ {
...@@ -1664,23 +1683,8 @@ int intel_pinctrl_resume_noirq(struct device *dev) ...@@ -1664,23 +1683,8 @@ int intel_pinctrl_resume_noirq(struct device *dev)
} }
base = community->regs + community->hostown_offset; base = community->regs + community->hostown_offset;
for (gpp = 0; gpp < community->ngpps; gpp++) { for (gpp = 0; gpp < community->ngpps; gpp++)
const struct intel_padgroup *padgrp = &community->gpps[gpp]; intel_restore_hostown(pctrl, i, base, gpp, communities[i].hostown[gpp]);
u32 requested = 0, value = 0;
u32 saved = communities[i].hostown[gpp];
if (padgrp->gpio_base < 0)
continue;
requested = intel_gpio_is_requested(&pctrl->chip,
padgrp->gpio_base, padgrp->size);
value = intel_gpio_update_pad_mode(base + gpp * 4,
requested, saved);
if ((value ^ saved) & requested) {
dev_warn(dev, "restore hostown %d/%u %#8x->%#8x\n",
i, gpp, value, saved);
}
}
} }
return 0; return 0;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment