1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * 4 * Copyright (C) 2010 John Crispin <blogic@phrozen.org> 5 * Copyright (C) 2013-2015 Lantiq Beteiligungs-GmbH & Co.KG 6 * Copyright (C) 2016 Martin Blumenstingl <martin.blumenstingl@googlemail.com> 7 * Copyright (C) 2017 Hauke Mehrtens <hauke@hauke-m.de> 8 */ 9 10 #include <linux/mfd/syscon.h> 11 #include <linux/module.h> 12 #include <linux/regmap.h> 13 #include <linux/reset-controller.h> 14 #include <linux/of_address.h> 15 #include <linux/of_platform.h> 16 #include <linux/platform_device.h> 17 #include <linux/property.h> 18 19 #define LANTIQ_RCU_RESET_TIMEOUT 10000 20 21 struct lantiq_rcu_reset_priv { 22 struct reset_controller_dev rcdev; 23 struct device *dev; 24 struct regmap *regmap; 25 u32 reset_offset; 26 u32 status_offset; 27 }; 28 29 static struct lantiq_rcu_reset_priv *to_lantiq_rcu_reset_priv( 30 struct reset_controller_dev *rcdev) 31 { 32 return container_of(rcdev, struct lantiq_rcu_reset_priv, rcdev); 33 } 34 35 static int lantiq_rcu_reset_status(struct reset_controller_dev *rcdev, 36 unsigned long id) 37 { 38 struct lantiq_rcu_reset_priv *priv = to_lantiq_rcu_reset_priv(rcdev); 39 unsigned int status = (id >> 8) & 0x1f; 40 u32 val; 41 int ret; 42 43 ret = regmap_read(priv->regmap, priv->status_offset, &val); 44 if (ret) 45 return ret; 46 47 return !!(val & BIT(status)); 48 } 49 50 static int lantiq_rcu_reset_status_timeout(struct reset_controller_dev *rcdev, 51 unsigned long id, bool assert) 52 { 53 int ret; 54 int retry = LANTIQ_RCU_RESET_TIMEOUT; 55 56 do { 57 ret = lantiq_rcu_reset_status(rcdev, id); 58 if (ret < 0) 59 return ret; 60 if (ret == assert) 61 return 0; 62 usleep_range(20, 40); 63 } while (--retry); 64 65 return -ETIMEDOUT; 66 } 67 68 static int lantiq_rcu_reset_update(struct reset_controller_dev *rcdev, 69 unsigned long id, bool assert) 70 { 71 struct lantiq_rcu_reset_priv *priv = to_lantiq_rcu_reset_priv(rcdev); 72 unsigned int set = id & 0x1f; 73 u32 val = assert ? BIT(set) : 0; 74 int ret; 75 76 ret = regmap_update_bits(priv->regmap, priv->reset_offset, BIT(set), 77 val); 78 if (ret) { 79 dev_err(priv->dev, "Failed to set reset bit %u\n", set); 80 return ret; 81 } 82 83 84 ret = lantiq_rcu_reset_status_timeout(rcdev, id, assert); 85 if (ret) 86 dev_err(priv->dev, "Failed to %s bit %u\n", 87 assert ? "assert" : "deassert", set); 88 89 return ret; 90 } 91 92 static int lantiq_rcu_reset_assert(struct reset_controller_dev *rcdev, 93 unsigned long id) 94 { 95 return lantiq_rcu_reset_update(rcdev, id, true); 96 } 97 98 static int lantiq_rcu_reset_deassert(struct reset_controller_dev *rcdev, 99 unsigned long id) 100 { 101 return lantiq_rcu_reset_update(rcdev, id, false); 102 } 103 104 static int lantiq_rcu_reset_reset(struct reset_controller_dev *rcdev, 105 unsigned long id) 106 { 107 int ret; 108 109 ret = lantiq_rcu_reset_assert(rcdev, id); 110 if (ret) 111 return ret; 112 113 return lantiq_rcu_reset_deassert(rcdev, id); 114 } 115 116 static const struct reset_control_ops lantiq_rcu_reset_ops = { 117 .assert = lantiq_rcu_reset_assert, 118 .deassert = lantiq_rcu_reset_deassert, 119 .status = lantiq_rcu_reset_status, 120 .reset = lantiq_rcu_reset_reset, 121 }; 122 123 static int lantiq_rcu_reset_of_parse(struct platform_device *pdev, 124 struct lantiq_rcu_reset_priv *priv) 125 { 126 struct device *dev = &pdev->dev; 127 const __be32 *offset; 128 129 priv->regmap = syscon_node_to_regmap(dev->of_node->parent); 130 if (IS_ERR(priv->regmap)) { 131 dev_err(&pdev->dev, "Failed to lookup RCU regmap\n"); 132 return PTR_ERR(priv->regmap); 133 } 134 135 offset = of_get_address(dev->of_node, 0, NULL, NULL); 136 if (!offset) { 137 dev_err(&pdev->dev, "Failed to get RCU reset offset\n"); 138 return -ENOENT; 139 } 140 priv->reset_offset = __be32_to_cpu(*offset); 141 142 offset = of_get_address(dev->of_node, 1, NULL, NULL); 143 if (!offset) { 144 dev_err(&pdev->dev, "Failed to get RCU status offset\n"); 145 return -ENOENT; 146 } 147 priv->status_offset = __be32_to_cpu(*offset); 148 149 return 0; 150 } 151 152 static int lantiq_rcu_reset_xlate(struct reset_controller_dev *rcdev, 153 const struct of_phandle_args *reset_spec) 154 { 155 unsigned int status, set; 156 157 set = reset_spec->args[0]; 158 status = reset_spec->args[1]; 159 160 if (set >= rcdev->nr_resets || status >= rcdev->nr_resets) 161 return -EINVAL; 162 163 return (status << 8) | set; 164 } 165 166 static int lantiq_rcu_reset_probe(struct platform_device *pdev) 167 { 168 struct lantiq_rcu_reset_priv *priv; 169 int err; 170 171 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); 172 if (!priv) 173 return -ENOMEM; 174 175 priv->dev = &pdev->dev; 176 platform_set_drvdata(pdev, priv); 177 178 err = lantiq_rcu_reset_of_parse(pdev, priv); 179 if (err) 180 return err; 181 182 priv->rcdev.ops = &lantiq_rcu_reset_ops; 183 priv->rcdev.owner = THIS_MODULE; 184 priv->rcdev.of_node = pdev->dev.of_node; 185 priv->rcdev.nr_resets = 32; 186 priv->rcdev.of_xlate = lantiq_rcu_reset_xlate; 187 priv->rcdev.of_reset_n_cells = 2; 188 189 return devm_reset_controller_register(&pdev->dev, &priv->rcdev); 190 } 191 192 static const struct of_device_id lantiq_rcu_reset_dt_ids[] = { 193 { .compatible = "lantiq,danube-reset", }, 194 { .compatible = "lantiq,xrx200-reset", }, 195 { }, 196 }; 197 MODULE_DEVICE_TABLE(of, lantiq_rcu_reset_dt_ids); 198 199 static struct platform_driver lantiq_rcu_reset_driver = { 200 .probe = lantiq_rcu_reset_probe, 201 .driver = { 202 .name = "lantiq-reset", 203 .of_match_table = lantiq_rcu_reset_dt_ids, 204 }, 205 }; 206 module_platform_driver(lantiq_rcu_reset_driver); 207 208 MODULE_AUTHOR("Martin Blumenstingl <martin.blumenstingl@googlemail.com>"); 209 MODULE_DESCRIPTION("Lantiq XWAY RCU Reset Controller Driver"); 210