1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * PRU-ICSS platform driver for various TI SoCs 4 * 5 * Copyright (C) 2014-2020 Texas Instruments Incorporated - http://www.ti.com/ 6 * Author(s): 7 * Suman Anna <s-anna@ti.com> 8 * Andrew F. Davis <afd@ti.com> 9 */ 10 11 #include <linux/clk-provider.h> 12 #include <linux/dma-mapping.h> 13 #include <linux/io.h> 14 #include <linux/mfd/syscon.h> 15 #include <linux/module.h> 16 #include <linux/of_address.h> 17 #include <linux/of_device.h> 18 #include <linux/pm_runtime.h> 19 #include <linux/pruss_driver.h> 20 #include <linux/regmap.h> 21 #include <linux/slab.h> 22 23 /** 24 * struct pruss_private_data - PRUSS driver private data 25 * @has_no_sharedram: flag to indicate the absence of PRUSS Shared Data RAM 26 * @has_core_mux_clock: flag to indicate the presence of PRUSS core clock 27 */ 28 struct pruss_private_data { 29 bool has_no_sharedram; 30 bool has_core_mux_clock; 31 }; 32 33 static void pruss_of_free_clk_provider(void *data) 34 { 35 struct device_node *clk_mux_np = data; 36 37 of_clk_del_provider(clk_mux_np); 38 of_node_put(clk_mux_np); 39 } 40 41 static int pruss_clk_mux_setup(struct pruss *pruss, struct clk *clk_mux, 42 char *mux_name, struct device_node *clks_np) 43 { 44 struct device_node *clk_mux_np; 45 struct device *dev = pruss->dev; 46 char *clk_mux_name; 47 unsigned int num_parents; 48 const char **parent_names; 49 void __iomem *reg; 50 u32 reg_offset; 51 int ret; 52 53 clk_mux_np = of_get_child_by_name(clks_np, mux_name); 54 if (!clk_mux_np) { 55 dev_err(dev, "%pOF is missing its '%s' node\n", clks_np, 56 mux_name); 57 return -ENODEV; 58 } 59 60 num_parents = of_clk_get_parent_count(clk_mux_np); 61 if (num_parents < 1) { 62 dev_err(dev, "mux-clock %pOF must have parents\n", clk_mux_np); 63 ret = -EINVAL; 64 goto put_clk_mux_np; 65 } 66 67 parent_names = devm_kcalloc(dev, sizeof(*parent_names), num_parents, 68 GFP_KERNEL); 69 if (!parent_names) { 70 ret = -ENOMEM; 71 goto put_clk_mux_np; 72 } 73 74 of_clk_parent_fill(clk_mux_np, parent_names, num_parents); 75 76 clk_mux_name = devm_kasprintf(dev, GFP_KERNEL, "%s.%pOFn", 77 dev_name(dev), clk_mux_np); 78 if (!clk_mux_name) { 79 ret = -ENOMEM; 80 goto put_clk_mux_np; 81 } 82 83 ret = of_property_read_u32(clk_mux_np, "reg", ®_offset); 84 if (ret) 85 goto put_clk_mux_np; 86 87 reg = pruss->cfg_base + reg_offset; 88 89 clk_mux = clk_register_mux(NULL, clk_mux_name, parent_names, 90 num_parents, 0, reg, 0, 1, 0, NULL); 91 if (IS_ERR(clk_mux)) { 92 ret = PTR_ERR(clk_mux); 93 goto put_clk_mux_np; 94 } 95 96 ret = devm_add_action_or_reset(dev, (void(*)(void *))clk_unregister_mux, 97 clk_mux); 98 if (ret) { 99 dev_err(dev, "failed to add clkmux unregister action %d", ret); 100 goto put_clk_mux_np; 101 } 102 103 ret = of_clk_add_provider(clk_mux_np, of_clk_src_simple_get, clk_mux); 104 if (ret) 105 goto put_clk_mux_np; 106 107 ret = devm_add_action_or_reset(dev, pruss_of_free_clk_provider, 108 clk_mux_np); 109 if (ret) { 110 dev_err(dev, "failed to add clkmux free action %d", ret); 111 goto put_clk_mux_np; 112 } 113 114 return 0; 115 116 put_clk_mux_np: 117 of_node_put(clk_mux_np); 118 return ret; 119 } 120 121 static int pruss_clk_init(struct pruss *pruss, struct device_node *cfg_node) 122 { 123 const struct pruss_private_data *data; 124 struct device_node *clks_np; 125 struct device *dev = pruss->dev; 126 int ret = 0; 127 128 data = of_device_get_match_data(dev); 129 130 clks_np = of_get_child_by_name(cfg_node, "clocks"); 131 if (!clks_np) { 132 dev_err(dev, "%pOF is missing its 'clocks' node\n", clks_np); 133 return -ENODEV; 134 } 135 136 if (data && data->has_core_mux_clock) { 137 ret = pruss_clk_mux_setup(pruss, pruss->core_clk_mux, 138 "coreclk-mux", clks_np); 139 if (ret) { 140 dev_err(dev, "failed to setup coreclk-mux\n"); 141 goto put_clks_node; 142 } 143 } 144 145 ret = pruss_clk_mux_setup(pruss, pruss->iep_clk_mux, "iepclk-mux", 146 clks_np); 147 if (ret) { 148 dev_err(dev, "failed to setup iepclk-mux\n"); 149 goto put_clks_node; 150 } 151 152 put_clks_node: 153 of_node_put(clks_np); 154 155 return ret; 156 } 157 158 static struct regmap_config regmap_conf = { 159 .reg_bits = 32, 160 .val_bits = 32, 161 .reg_stride = 4, 162 }; 163 164 static int pruss_probe(struct platform_device *pdev) 165 { 166 struct device *dev = &pdev->dev; 167 struct device_node *np = dev_of_node(dev); 168 struct device_node *child; 169 struct pruss *pruss; 170 struct resource res; 171 int ret, i, index; 172 const struct pruss_private_data *data; 173 const char *mem_names[PRUSS_MEM_MAX] = { "dram0", "dram1", "shrdram2" }; 174 175 data = of_device_get_match_data(&pdev->dev); 176 177 ret = dma_set_coherent_mask(dev, DMA_BIT_MASK(32)); 178 if (ret) { 179 dev_err(dev, "failed to set the DMA coherent mask"); 180 return ret; 181 } 182 183 pruss = devm_kzalloc(dev, sizeof(*pruss), GFP_KERNEL); 184 if (!pruss) 185 return -ENOMEM; 186 187 pruss->dev = dev; 188 189 child = of_get_child_by_name(np, "memories"); 190 if (!child) { 191 dev_err(dev, "%pOF is missing its 'memories' node\n", child); 192 return -ENODEV; 193 } 194 195 for (i = 0; i < PRUSS_MEM_MAX; i++) { 196 /* 197 * On AM437x one of two PRUSS units don't contain Shared RAM, 198 * skip it 199 */ 200 if (data && data->has_no_sharedram && i == PRUSS_MEM_SHRD_RAM2) 201 continue; 202 203 index = of_property_match_string(child, "reg-names", 204 mem_names[i]); 205 if (index < 0) { 206 of_node_put(child); 207 return index; 208 } 209 210 if (of_address_to_resource(child, index, &res)) { 211 of_node_put(child); 212 return -EINVAL; 213 } 214 215 pruss->mem_regions[i].va = devm_ioremap(dev, res.start, 216 resource_size(&res)); 217 if (!pruss->mem_regions[i].va) { 218 dev_err(dev, "failed to parse and map memory resource %d %s\n", 219 i, mem_names[i]); 220 of_node_put(child); 221 return -ENOMEM; 222 } 223 pruss->mem_regions[i].pa = res.start; 224 pruss->mem_regions[i].size = resource_size(&res); 225 226 dev_dbg(dev, "memory %8s: pa %pa size 0x%zx va %pK\n", 227 mem_names[i], &pruss->mem_regions[i].pa, 228 pruss->mem_regions[i].size, pruss->mem_regions[i].va); 229 } 230 of_node_put(child); 231 232 platform_set_drvdata(pdev, pruss); 233 234 pm_runtime_enable(dev); 235 ret = pm_runtime_get_sync(dev); 236 if (ret < 0) { 237 dev_err(dev, "couldn't enable module\n"); 238 pm_runtime_put_noidle(dev); 239 goto rpm_disable; 240 } 241 242 child = of_get_child_by_name(np, "cfg"); 243 if (!child) { 244 dev_err(dev, "%pOF is missing its 'cfg' node\n", child); 245 ret = -ENODEV; 246 goto rpm_put; 247 } 248 249 if (of_address_to_resource(child, 0, &res)) { 250 ret = -ENOMEM; 251 goto node_put; 252 } 253 254 pruss->cfg_base = devm_ioremap(dev, res.start, resource_size(&res)); 255 if (!pruss->cfg_base) { 256 ret = -ENOMEM; 257 goto node_put; 258 } 259 260 regmap_conf.name = kasprintf(GFP_KERNEL, "%pOFn@%llx", child, 261 (u64)res.start); 262 regmap_conf.max_register = resource_size(&res) - 4; 263 264 pruss->cfg_regmap = devm_regmap_init_mmio(dev, pruss->cfg_base, 265 ®map_conf); 266 kfree(regmap_conf.name); 267 if (IS_ERR(pruss->cfg_regmap)) { 268 dev_err(dev, "regmap_init_mmio failed for cfg, ret = %ld\n", 269 PTR_ERR(pruss->cfg_regmap)); 270 ret = PTR_ERR(pruss->cfg_regmap); 271 goto node_put; 272 } 273 274 ret = pruss_clk_init(pruss, child); 275 if (ret) { 276 dev_err(dev, "failed to setup coreclk-mux\n"); 277 goto node_put; 278 } 279 280 ret = devm_of_platform_populate(dev); 281 if (ret) { 282 dev_err(dev, "failed to register child devices\n"); 283 goto node_put; 284 } 285 286 of_node_put(child); 287 288 return 0; 289 290 node_put: 291 of_node_put(child); 292 rpm_put: 293 pm_runtime_put_sync(dev); 294 rpm_disable: 295 pm_runtime_disable(dev); 296 return ret; 297 } 298 299 static int pruss_remove(struct platform_device *pdev) 300 { 301 struct device *dev = &pdev->dev; 302 303 devm_of_platform_depopulate(dev); 304 305 pm_runtime_put_sync(dev); 306 pm_runtime_disable(dev); 307 308 return 0; 309 } 310 311 /* instance-specific driver private data */ 312 static const struct pruss_private_data am437x_pruss1_data = { 313 .has_no_sharedram = false, 314 }; 315 316 static const struct pruss_private_data am437x_pruss0_data = { 317 .has_no_sharedram = true, 318 }; 319 320 static const struct pruss_private_data am65x_j721e_pruss_data = { 321 .has_core_mux_clock = true, 322 }; 323 324 static const struct of_device_id pruss_of_match[] = { 325 { .compatible = "ti,am3356-pruss" }, 326 { .compatible = "ti,am4376-pruss0", .data = &am437x_pruss0_data, }, 327 { .compatible = "ti,am4376-pruss1", .data = &am437x_pruss1_data, }, 328 { .compatible = "ti,am5728-pruss" }, 329 { .compatible = "ti,k2g-pruss" }, 330 { .compatible = "ti,am654-icssg", .data = &am65x_j721e_pruss_data, }, 331 { .compatible = "ti,j721e-icssg", .data = &am65x_j721e_pruss_data, }, 332 {}, 333 }; 334 MODULE_DEVICE_TABLE(of, pruss_of_match); 335 336 static struct platform_driver pruss_driver = { 337 .driver = { 338 .name = "pruss", 339 .of_match_table = pruss_of_match, 340 }, 341 .probe = pruss_probe, 342 .remove = pruss_remove, 343 }; 344 module_platform_driver(pruss_driver); 345 346 MODULE_AUTHOR("Suman Anna <s-anna@ti.com>"); 347 MODULE_DESCRIPTION("PRU-ICSS Subsystem Driver"); 348 MODULE_LICENSE("GPL v2"); 349