Create driver to support the soft reset (i.e. peripheral) of all Rockchip SoCs. Example of usage: i2c driver: ret = reset_get_by_name(dev, "i2c", &reset_ctl); if (ret) { error("reset_get_by_name() failed: %d\n", ret); } reset_assert(&reset_ctl); udelay(50); reset_deassert(&reset_ctl); i2c dts node: resets = <&cru SRST_P_I2C1>, <&cru SRST_I2C1>; reset-names = "p_i2c", "i2c"; Signed-off-by: Elaine Zhang <zhangqing@rock-chips.com> Signed-off-by: Kever Yang <kever.yang@rock-chips.com> Acked-by: Philipp Tomsich <philipp.tomsich@theobroma-systems.com> Reviewed-by: Philipp Tomsich <philipp.tomsich@theobroma-systems.com> [Fixed commit tag:] Signed-off-by: Philipp Tomsich <philipp.tomsich@theobroma-systems.com>master
parent
f3dd87e0b9
commit
760188c1aa
@ -0,0 +1,133 @@ |
||||
/*
|
||||
* (C) Copyright 2017 Rockchip Electronics Co., Ltd |
||||
* |
||||
* SPDX-License-Identifier: GPL-2.0 |
||||
*/ |
||||
|
||||
#include <common.h> |
||||
#include <dm.h> |
||||
#include <reset-uclass.h> |
||||
#include <linux/io.h> |
||||
#include <asm/arch/hardware.h> |
||||
#include <dm/lists.h> |
||||
/*
|
||||
* Each reg has 16 bits reset signal for devices |
||||
* Note: Not including rk2818 and older SoCs |
||||
*/ |
||||
#define ROCKCHIP_RESET_NUM_IN_REG 16 |
||||
|
||||
struct rockchip_reset_priv { |
||||
void __iomem *base; |
||||
/* Rockchip reset reg locate at cru controller */ |
||||
u32 reset_reg_offset; |
||||
/* Rockchip reset reg number */ |
||||
u32 reset_reg_num; |
||||
}; |
||||
|
||||
static int rockchip_reset_request(struct reset_ctl *reset_ctl) |
||||
{ |
||||
struct rockchip_reset_priv *priv = dev_get_priv(reset_ctl->dev); |
||||
|
||||
debug("%s(reset_ctl=%p) (dev=%p, id=%lu) (reg_num=%d)\n", __func__, |
||||
reset_ctl, reset_ctl->dev, reset_ctl->id, priv->reset_reg_num); |
||||
|
||||
if (reset_ctl->id / ROCKCHIP_RESET_NUM_IN_REG >= priv->reset_reg_num) |
||||
return -EINVAL; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int rockchip_reset_free(struct reset_ctl *reset_ctl) |
||||
{ |
||||
debug("%s(reset_ctl=%p) (dev=%p, id=%lu)\n", __func__, reset_ctl, |
||||
reset_ctl->dev, reset_ctl->id); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int rockchip_reset_assert(struct reset_ctl *reset_ctl) |
||||
{ |
||||
struct rockchip_reset_priv *priv = dev_get_priv(reset_ctl->dev); |
||||
int bank = reset_ctl->id / ROCKCHIP_RESET_NUM_IN_REG; |
||||
int offset = reset_ctl->id % ROCKCHIP_RESET_NUM_IN_REG; |
||||
|
||||
debug("%s(reset_ctl=%p) (dev=%p, id=%lu) (reg_addr=%p)\n", __func__, |
||||
reset_ctl, reset_ctl->dev, reset_ctl->id, |
||||
priv->base + (bank * 4)); |
||||
|
||||
rk_setreg(priv->base + (bank * 4), BIT(offset)); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int rockchip_reset_deassert(struct reset_ctl *reset_ctl) |
||||
{ |
||||
struct rockchip_reset_priv *priv = dev_get_priv(reset_ctl->dev); |
||||
int bank = reset_ctl->id / ROCKCHIP_RESET_NUM_IN_REG; |
||||
int offset = reset_ctl->id % ROCKCHIP_RESET_NUM_IN_REG; |
||||
|
||||
debug("%s(reset_ctl=%p) (dev=%p, id=%lu) (reg_addr=%p)\n", __func__, |
||||
reset_ctl, reset_ctl->dev, reset_ctl->id, |
||||
priv->base + (bank * 4)); |
||||
|
||||
rk_clrreg(priv->base + (bank * 4), BIT(offset)); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
struct reset_ops rockchip_reset_ops = { |
||||
.request = rockchip_reset_request, |
||||
.free = rockchip_reset_free, |
||||
.rst_assert = rockchip_reset_assert, |
||||
.rst_deassert = rockchip_reset_deassert, |
||||
}; |
||||
|
||||
static int rockchip_reset_probe(struct udevice *dev) |
||||
{ |
||||
struct rockchip_reset_priv *priv = dev_get_priv(dev); |
||||
fdt_addr_t addr; |
||||
fdt_size_t size; |
||||
|
||||
addr = dev_read_addr_size(dev, "reg", &size); |
||||
if (addr == FDT_ADDR_T_NONE) |
||||
return -EINVAL; |
||||
|
||||
if ((priv->reset_reg_offset == 0) && (priv->reset_reg_num == 0)) |
||||
return -EINVAL; |
||||
|
||||
addr += priv->reset_reg_offset; |
||||
priv->base = ioremap(addr, size); |
||||
|
||||
debug("%s(base=%p) (reg_offset=%x, reg_num=%d)\n", __func__, |
||||
priv->base, priv->reset_reg_offset, priv->reset_reg_num); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
int rockchip_reset_bind(struct udevice *pdev, u32 reg_offset, u32 reg_number) |
||||
{ |
||||
struct udevice *rst_dev; |
||||
struct rockchip_reset_priv *priv; |
||||
int ret; |
||||
|
||||
ret = device_bind_driver_to_node(pdev, "rockchip_reset", "reset", |
||||
dev_ofnode(pdev), &rst_dev); |
||||
if (ret) { |
||||
debug("Warning: No rockchip reset driver: ret=%d\n", ret); |
||||
return ret; |
||||
} |
||||
priv = malloc(sizeof(struct rockchip_reset_priv)); |
||||
priv->reset_reg_offset = reg_offset; |
||||
priv->reset_reg_num = reg_number; |
||||
rst_dev->priv = priv; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
U_BOOT_DRIVER(rockchip_reset) = { |
||||
.name = "rockchip_reset", |
||||
.id = UCLASS_RESET, |
||||
.probe = rockchip_reset_probe, |
||||
.ops = &rockchip_reset_ops, |
||||
.priv_auto_alloc_size = sizeof(struct rockchip_reset_priv), |
||||
}; |
Loading…
Reference in new issue