mirror of
https://github.com/u-boot/u-boot.git
synced 2024-11-23 20:24:26 +08:00
pinctrl: single: fix offset management
The pinmux configuration DT node of a peripheral does not define a physical address but an offset. Only by adding it to the base address of the controller it is possible to calculate the physical address of the register to be configured. Printing an offset also requires a different formatting option than a physical address. Signed-off-by: Dario Binacchi <dariobin@libero.it> Reviewed-by: Pratyush Yadav <p.yadav@ti.com>
This commit is contained in:
parent
6719294694
commit
9b884e79a6
@ -77,15 +77,17 @@ static int single_configure_pins(struct udevice *dev,
|
||||
struct single_pdata *pdata = dev_get_plat(dev);
|
||||
int n, count = size / sizeof(struct single_fdt_pin_cfg);
|
||||
phys_addr_t reg;
|
||||
u32 val;
|
||||
u32 offset, val;
|
||||
|
||||
for (n = 0; n < count; n++, pins++) {
|
||||
reg = fdt32_to_cpu(pins->reg);
|
||||
if ((reg < 0) || (reg > pdata->offset)) {
|
||||
dev_dbg(dev, " invalid register offset 0x%pa\n", ®);
|
||||
offset = fdt32_to_cpu(pins->reg);
|
||||
if (offset < 0 || offset > pdata->offset) {
|
||||
dev_dbg(dev, " invalid register offset 0x%x\n",
|
||||
offset);
|
||||
continue;
|
||||
}
|
||||
reg += pdata->base;
|
||||
|
||||
reg = pdata->base + offset;
|
||||
val = fdt32_to_cpu(pins->val) & pdata->mask;
|
||||
switch (pdata->width) {
|
||||
case 16:
|
||||
@ -111,15 +113,17 @@ static int single_configure_bits(struct udevice *dev,
|
||||
struct single_pdata *pdata = dev_get_plat(dev);
|
||||
int n, count = size / sizeof(struct single_fdt_bits_cfg);
|
||||
phys_addr_t reg;
|
||||
u32 val, mask;
|
||||
u32 offset, val, mask;
|
||||
|
||||
for (n = 0; n < count; n++, pins++) {
|
||||
reg = fdt32_to_cpu(pins->reg);
|
||||
if ((reg < 0) || (reg > pdata->offset)) {
|
||||
dev_dbg(dev, " invalid register offset 0x%pa\n", ®);
|
||||
offset = fdt32_to_cpu(pins->reg);
|
||||
if (offset < 0 || offset > pdata->offset) {
|
||||
dev_dbg(dev, " invalid register offset 0x%x\n",
|
||||
offset);
|
||||
continue;
|
||||
}
|
||||
reg += pdata->base;
|
||||
|
||||
reg = pdata->base + offset;
|
||||
|
||||
mask = fdt32_to_cpu(pins->mask);
|
||||
val = fdt32_to_cpu(pins->val) & mask;
|
||||
|
Loading…
Reference in New Issue
Block a user