Mirrors/u-boot
2
0
Fork 0
mirror of https://github.com/AsahiLinux/u-boot synced 2025-02-17 22:49:02 +00:00
Code Issues Projects Releases Packages Wiki Activity

pinctrl: single: add register access functions

Browse source 
The configuration of pinmux registers was implemented with duplicate
code which can be removed by adding two functions for read/write access.
Access to 8-bit registers has also been added.

Signed-off-by: Dario Binacchi <dariobin@libero.it>
Reviewed-by: Simon Glass <sjg@chromium.org>
This commit is contained in:
Dario Binacchi 2021-04-11 09:39:46 +02:00 • committed by Lokesh Vutla
parent d85b93e80b
commit 180531fc2f
1 changed files with 46 additions and 25 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

71
drivers/pinctrl/pinctrl-single.c
View file

@ -56,6 +56,38 @@ struct single_fdt_bits_cfg {
fdt32_t mask;
};
static unsigned int single_read(struct udevice *dev, fdt_addr_t reg)
{
struct single_pdata *pdata = dev_get_plat(dev);
switch (pdata->width) {
case 8:
return readb(reg);
case 16:
return readw(reg);
default: /* 32 bits */
return readl(reg);
}
return readb(reg);
}
static void single_write(struct udevice *dev, unsigned int val, fdt_addr_t reg)
{
struct single_pdata *pdata = dev_get_plat(dev);
switch (pdata->width) {
case 8:
writeb(val, reg);
break;
case 16:
writew(val, reg);
break;
default: /* 32 bits */
writel(val, reg);
}
}
/**
* single_configure_pins() - Configure pins based on FDT data
*
@ -93,19 +125,10 @@ static int single_configure_pins(struct udevice *dev,
reg = pdata->base + offset;
val = fdt32_to_cpu(pins->val) & pdata->mask;
switch (pdata->width) {
case 16:
writew((readw(reg) & ~pdata->mask) | val, reg);
break;
case 32:
writel((readl(reg) & ~pdata->mask) | val, reg);
break;
default:
dev_warn(dev, "unsupported register width %i\n",
pdata->width);
continue;
}
single_write(dev, (single_read(dev, reg) & ~pdata->mask) | val,
reg);
dev_dbg(dev, " reg/val %pa/0x%08x\n", &reg, val);
}
return 0;
}
@ -131,19 +154,7 @@ static int single_configure_bits(struct udevice *dev,
mask = fdt32_to_cpu(pins->mask);
val = fdt32_to_cpu(pins->val) & mask;
switch (pdata->width) {
case 16:
writew((readw(reg) & ~mask) | val, reg);
break;
case 32:
writel((readl(reg) & ~mask) | val, reg);
break;
default:
dev_warn(dev, "unsupported register width %i\n",
pdata->width);
continue;
}
single_write(dev, (single_read(dev, reg) & ~mask) | val, reg);
dev_dbg(dev, " reg/val %pa/0x%08x\n", &reg, val);
}
return 0;
@ -196,6 +207,16 @@ static int single_of_to_plat(struct udevice *dev)
return ret;
}
switch (pdata->width) {
case 8:
case 16:
case 32:
break;
default:
dev_err(dev, "wrong register width\n");
return -EINVAL;
}
addr = dev_read_addr_size(dev, "reg", &size);
if (addr == FDT_ADDR_T_NONE) {
dev_err(dev, "failed to get base register size\n");