Blame view
drivers/reset/reset-simple.c
5.01 KB
2874c5fd2 treewide: Replace... |
1 |
// SPDX-License-Identifier: GPL-2.0-or-later |
81c22ad0c reset: add reset-... |
2 3 4 5 6 7 8 9 10 11 |
/* * Simple Reset Controller Driver * * Copyright (C) 2017 Pengutronix, Philipp Zabel <kernel@pengutronix.de> * * Based on Allwinner SoCs Reset Controller driver * * Copyright 2013 Maxime Ripard * * Maxime Ripard <maxime.ripard@free-electrons.com> |
81c22ad0c reset: add reset-... |
12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 |
*/ #include <linux/device.h> #include <linux/err.h> #include <linux/io.h> #include <linux/of.h> #include <linux/of_device.h> #include <linux/platform_device.h> #include <linux/reset-controller.h> #include <linux/spinlock.h> #include "reset-simple.h" static inline struct reset_simple_data * to_reset_simple_data(struct reset_controller_dev *rcdev) { return container_of(rcdev, struct reset_simple_data, rcdev); } static int reset_simple_update(struct reset_controller_dev *rcdev, unsigned long id, bool assert) { struct reset_simple_data *data = to_reset_simple_data(rcdev); int reg_width = sizeof(u32); int bank = id / (reg_width * BITS_PER_BYTE); int offset = id % (reg_width * BITS_PER_BYTE); unsigned long flags; u32 reg; spin_lock_irqsave(&data->lock, flags); reg = readl(data->membase + (bank * reg_width)); if (assert ^ data->active_low) reg |= BIT(offset); else reg &= ~BIT(offset); writel(reg, data->membase + (bank * reg_width)); spin_unlock_irqrestore(&data->lock, flags); return 0; } static int reset_simple_assert(struct reset_controller_dev *rcdev, unsigned long id) { return reset_simple_update(rcdev, id, true); } static int reset_simple_deassert(struct reset_controller_dev *rcdev, unsigned long id) { return reset_simple_update(rcdev, id, false); } |
adf20d7ce reset: socfpga: u... |
66 67 68 69 70 71 72 73 74 75 76 77 78 |
static int reset_simple_status(struct reset_controller_dev *rcdev, unsigned long id) { struct reset_simple_data *data = to_reset_simple_data(rcdev); int reg_width = sizeof(u32); int bank = id / (reg_width * BITS_PER_BYTE); int offset = id % (reg_width * BITS_PER_BYTE); u32 reg; reg = readl(data->membase + (bank * reg_width)); return !(reg & BIT(offset)) ^ !data->status_active_low; } |
81c22ad0c reset: add reset-... |
79 80 81 |
const struct reset_control_ops reset_simple_ops = { .assert = reset_simple_assert, .deassert = reset_simple_deassert, |
adf20d7ce reset: socfpga: u... |
82 |
.status = reset_simple_status, |
81c22ad0c reset: add reset-... |
83 |
}; |
9ad39ab28 reset: simple: ex... |
84 |
EXPORT_SYMBOL_GPL(reset_simple_ops); |
81c22ad0c reset: add reset-... |
85 86 87 |
/** * struct reset_simple_devdata - simple reset controller properties |
adf20d7ce reset: socfpga: u... |
88 89 |
* @reg_offset: offset between base address and first reset register. * @nr_resets: number of resets. If not set, default to resource size in bits. |
81c22ad0c reset: add reset-... |
90 91 |
* @active_low: if true, bits are cleared to assert the reset. Otherwise, bits * are set to assert the reset. |
adf20d7ce reset: socfpga: u... |
92 93 94 |
* @status_active_low: if true, bits read back as cleared while the reset is * asserted. Otherwise, bits read back as set while the * reset is asserted. |
81c22ad0c reset: add reset-... |
95 96 |
*/ struct reset_simple_devdata { |
adf20d7ce reset: socfpga: u... |
97 98 |
u32 reg_offset; u32 nr_resets; |
81c22ad0c reset: add reset-... |
99 |
bool active_low; |
adf20d7ce reset: socfpga: u... |
100 101 102 103 104 105 |
bool status_active_low; }; #define SOCFPGA_NR_BANKS 8 static const struct reset_simple_devdata reset_simple_socfpga = { |
b3ca9888f reset: socfpga: a... |
106 |
.reg_offset = 0x20, |
adf20d7ce reset: socfpga: u... |
107 108 |
.nr_resets = SOCFPGA_NR_BANKS * 32, .status_active_low = true, |
81c22ad0c reset: add reset-... |
109 110 111 112 |
}; static const struct reset_simple_devdata reset_simple_active_low = { .active_low = true, |
adf20d7ce reset: socfpga: u... |
113 |
.status_active_low = true, |
81c22ad0c reset: add reset-... |
114 115 116 |
}; static const struct of_device_id reset_simple_dt_ids[] = { |
b3ca9888f reset: socfpga: a... |
117 118 |
{ .compatible = "altr,stratix10-rst-mgr", .data = &reset_simple_socfpga }, |
0af8a1373 reset: stm32: use... |
119 |
{ .compatible = "st,stm32-rcc", }, |
81c22ad0c reset: add reset-... |
120 121 |
{ .compatible = "allwinner,sun6i-a31-clock-reset", .data = &reset_simple_active_low }, |
f0e0ada67 reset: zx2967: us... |
122 123 |
{ .compatible = "zte,zx296718-reset", .data = &reset_simple_active_low }, |
1d7592f84 reset: simple: En... |
124 125 |
{ .compatible = "aspeed,ast2400-lpc-reset" }, { .compatible = "aspeed,ast2500-lpc-reset" }, |
64c47b624 reset: Add reset ... |
126 127 |
{ .compatible = "bitmain,bm1880-reset", .data = &reset_simple_active_low }, |
ea651ffd4 reset: Add Design... |
128 129 130 |
{ .compatible = "snps,dw-high-reset" }, { .compatible = "snps,dw-low-reset", .data = &reset_simple_active_low }, |
81c22ad0c reset: add reset-... |
131 132 133 134 135 136 137 138 139 140 |
{ /* sentinel */ }, }; static int reset_simple_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; const struct reset_simple_devdata *devdata; struct reset_simple_data *data; void __iomem *membase; struct resource *res; |
adf20d7ce reset: socfpga: u... |
141 |
u32 reg_offset = 0; |
81c22ad0c reset: add reset-... |
142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 |
devdata = of_device_get_match_data(dev); data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); if (!data) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); membase = devm_ioremap_resource(dev, res); if (IS_ERR(membase)) return PTR_ERR(membase); spin_lock_init(&data->lock); data->membase = membase; data->rcdev.owner = THIS_MODULE; data->rcdev.nr_resets = resource_size(res) * BITS_PER_BYTE; data->rcdev.ops = &reset_simple_ops; data->rcdev.of_node = dev->of_node; |
adf20d7ce reset: socfpga: u... |
160 161 162 163 |
if (devdata) { reg_offset = devdata->reg_offset; if (devdata->nr_resets) data->rcdev.nr_resets = devdata->nr_resets; |
81c22ad0c reset: add reset-... |
164 |
data->active_low = devdata->active_low; |
adf20d7ce reset: socfpga: u... |
165 166 |
data->status_active_low = devdata->status_active_low; } |
adf20d7ce reset: socfpga: u... |
167 |
data->membase += reg_offset; |
81c22ad0c reset: add reset-... |
168 169 170 171 172 173 174 175 176 177 178 179 |
return devm_reset_controller_register(dev, &data->rcdev); } static struct platform_driver reset_simple_driver = { .probe = reset_simple_probe, .driver = { .name = "simple-reset", .of_match_table = reset_simple_dt_ids, }, }; builtin_platform_driver(reset_simple_driver); |