The BCM6345 contains a soft-reset controller activated by setting a bit (that must previously have cleared). Signed-off-by: Simon Arlott <simon@xxxxxxxxxxx> --- MAINTAINERS | 1 + drivers/reset/Kconfig | 1 + drivers/reset/Makefile | 17 +++--- drivers/reset/bcm/Kconfig | 10 ++++ drivers/reset/bcm/Makefile | 1 + drivers/reset/bcm/reset-bcm6345.c | 109 ++++++++++++++++++++++++++++++++++++++ 6 files changed, 131 insertions(+), 8 deletions(-) create mode 100644 drivers/reset/bcm/Kconfig create mode 100644 drivers/reset/bcm/Makefile create mode 100644 drivers/reset/bcm/reset-bcm6345.c diff --git a/MAINTAINERS b/MAINTAINERS index 07613dd..a20cecf 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -2378,6 +2378,7 @@ F: drivers/irqchip/irq-bcm63* F: drivers/irqchip/irq-bcm7* F: drivers/irqchip/irq-brcmstb* F: drivers/regulator/bcm63* +F: drivers/reset/bcm/reset-bcm6345* F: include/linux/bcm63xx_wdt.h BROADCOM TG3 GIGABIT ETHERNET DRIVER diff --git a/drivers/reset/Kconfig b/drivers/reset/Kconfig index 0615f50..ee73f5f 100644 --- a/drivers/reset/Kconfig +++ b/drivers/reset/Kconfig @@ -12,4 +12,5 @@ menuconfig RESET_CONTROLLER If unsure, say no. +source "drivers/reset/bcm/Kconfig" source "drivers/reset/sti/Kconfig" diff --git a/drivers/reset/Makefile b/drivers/reset/Makefile index 85d5904..a34f469 100644 --- a/drivers/reset/Makefile +++ b/drivers/reset/Makefile @@ -1,8 +1,9 @@ -obj-$(CONFIG_RESET_CONTROLLER) += core.o -obj-$(CONFIG_ARCH_LPC18XX) += reset-lpc18xx.o -obj-$(CONFIG_ARCH_SOCFPGA) += reset-socfpga.o -obj-$(CONFIG_ARCH_BERLIN) += reset-berlin.o -obj-$(CONFIG_ARCH_SUNXI) += reset-sunxi.o -obj-$(CONFIG_ARCH_STI) += sti/ -obj-$(CONFIG_ARCH_ZYNQ) += reset-zynq.o -obj-$(CONFIG_ATH79) += reset-ath79.o +obj-$(CONFIG_RESET_CONTROLLER) += core.o +obj-$(CONFIG_ARCH_LPC18XX) += reset-lpc18xx.o +obj-$(CONFIG_ARCH_SOCFPGA) += reset-socfpga.o +obj-$(CONFIG_ARCH_BERLIN) += reset-berlin.o +obj-$(CONFIG_ARCH_SUNXI) += reset-sunxi.o +obj-$(CONFIG_ARCH_STI) += sti/ +obj-$(CONFIG_ARCH_ZYNQ) += reset-zynq.o +obj-$(CONFIG_ATH79) += reset-ath79.o +obj-y += bcm/ diff --git a/drivers/reset/bcm/Kconfig b/drivers/reset/bcm/Kconfig new file mode 100644 index 0000000..85931c9 --- /dev/null +++ b/drivers/reset/bcm/Kconfig @@ -0,0 +1,10 @@ +if RESET_CONTROLLER + +config RESET_BCM6345 + bool "BCM6345 Reset Controller" + depends on BMIPS_GENERIC + default BMIPS_GENERIC + help + Support resetting of devices on BCM6345 boards. + +endif diff --git a/drivers/reset/bcm/Makefile b/drivers/reset/bcm/Makefile new file mode 100644 index 0000000..3d004bd --- /dev/null +++ b/drivers/reset/bcm/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_RESET_BCM6345) += reset-bcm6345.o diff --git a/drivers/reset/bcm/reset-bcm6345.c b/drivers/reset/bcm/reset-bcm6345.c new file mode 100644 index 0000000..a95433d --- /dev/null +++ b/drivers/reset/bcm/reset-bcm6345.c @@ -0,0 +1,109 @@ +/* + * Copyright 2015 Simon Arlott + * + * This file is licensed under the terms of the GNU General Public + * License version 2. This program is licensed "as is" without any + * warranty of any kind, whether express or implied. + * + * Derived from reset-berlin.c: + * Copyright (C) 2014 Marvell Technology Group Ltd. + * + * Antoine Tenart <antoine.tenart@xxxxxxxxxxxxxxxxxx> + * Sebastian Hesselbarth <sebastian.hesselbarth@xxxxxxxxx> + */ + +#include <linux/delay.h> +#include <linux/io.h> +#include <linux/mfd/syscon.h> +#include <linux/module.h> +#include <linux/mutex.h> +#include <linux/of.h> +#include <linux/of_address.h> +#include <linux/platform_device.h> +#include <linux/regmap.h> +#include <linux/reset-controller.h> +#include <linux/slab.h> +#include <linux/types.h> + +#define to_bcm6345_reset_priv(p) \ + container_of((p), struct bcm6345_reset_priv, rcdev) + +struct bcm6345_reset_priv { + struct regmap *map; + u32 offset; + struct reset_controller_dev rcdev; + struct mutex mutex; +}; + +static int bcm6345_reset_reset(struct reset_controller_dev *rcdev, + unsigned long id) +{ + struct bcm6345_reset_priv *priv = to_bcm6345_reset_priv(rcdev); + + mutex_lock(&priv->mutex); + regmap_write_bits(priv->map, priv->offset, BIT(id), 0); + usleep_range(10000, 20000); + regmap_write_bits(priv->map, priv->offset, BIT(id), BIT(id)); + usleep_range(10000, 20000); + mutex_unlock(&priv->mutex); + + return 0; +} + +static struct reset_control_ops bcm6345_reset_ops = { + .reset = bcm6345_reset_reset, +}; + +static int __init bcm6345_reset_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + struct bcm6345_reset_priv *priv; + int ret; + + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) + return -ENOMEM; + + mutex_init(&priv->mutex); + + priv->map = syscon_regmap_lookup_by_phandle(np, "regmap"); + if (IS_ERR(priv->map)) + return PTR_ERR(priv->map); + + if (of_property_read_u32(np, "offset", &priv->offset)) + return -EINVAL; + + priv->rcdev.owner = THIS_MODULE; + priv->rcdev.ops = &bcm6345_reset_ops; + priv->rcdev.nr_resets = 32; + priv->rcdev.of_node = pdev->dev.of_node; + + ret = reset_controller_register(&priv->rcdev); + if (ret) { + dev_err(&pdev->dev, + "unable to register reset controller: %d\n", ret); + return ret; + } + + dev_info(&pdev->dev, "registered reset controller\n"); + return 0; +} + +static const struct of_device_id bcm6345_reset_dt_match[] __initconst = { + { .compatible = "brcm,bcm6345-reset" }, + { }, +}; +MODULE_DEVICE_TABLE(of, bcm6345_reset_dt_match); + +static struct platform_driver bcm6345_reset_driver __refdata = { + .probe = bcm6345_reset_probe, + .driver = { + .name = "bcm6345-reset", + .of_match_table = bcm6345_reset_dt_match, + }, +}; +module_platform_driver(bcm6345_reset_driver); + +MODULE_DESCRIPTION("BCM6345 reset driver"); +MODULE_AUTHOR("Simon Arlott"); +MODULE_LICENSE("GPL"); -- 2.1.4 -- Simon Arlott