drivers/remoteproc/rcar_rproc.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (C) IoT.bzh 2021
   4  */
   5
   6 #include <linux/limits.h>
   7 #include <linux/module.h>
   8 #include <linux/of.h>
   9 #include <linux/of_reserved_mem.h>
  10 #include <linux/platform_device.h>
  11 #include <linux/pm_runtime.h>
  12 #include <linux/remoteproc.h>
  13 #include <linux/reset.h>
  14 #include <linux/soc/renesas/rcar-rst.h>
  15
  16 #include "remoteproc_internal.h"
  17
  18 struct rcar_rproc {
  19         struct reset_control *rst;
  20 };
  21
  22 static int rcar_rproc_mem_alloc(struct rproc *rproc,
  23                                  struct rproc_mem_entry *mem)
  24 {
  25         struct device *dev = &rproc->dev;
  26         void *va;
  27
  28         dev_dbg(dev, "map memory: %pa+%zx\n", &mem->dma, mem->len);
  29         va = ioremap_wc(mem->dma, mem->len);
  30         if (!va) {
  31                 dev_err(dev, "Unable to map memory region: %pa+%zx\n",
  32                         &mem->dma, mem->len);
  33                 return -ENOMEM;
  34         }
  35
  36         /* Update memory entry va */
  37         mem->va = va;
  38
  39         return 0;
  40 }
  41
  42 static int rcar_rproc_mem_release(struct rproc *rproc,
  43                                    struct rproc_mem_entry *mem)
  44 {
  45         dev_dbg(&rproc->dev, "unmap memory: %pa\n", &mem->dma);
  46         iounmap(mem->va);
  47
  48         return 0;
  49 }
  50
  51 static int rcar_rproc_prepare(struct rproc *rproc)
  52 {
  53         struct device *dev = rproc->dev.parent;
  54         struct device_node *np = dev->of_node;
  55         struct of_phandle_iterator it;
  56         struct rproc_mem_entry *mem;
  57         struct reserved_mem *rmem;
  58         u32 da;
  59
  60         /* Register associated reserved memory regions */
  61         of_phandle_iterator_init(&it, np, "memory-region", NULL, 0);
  62         while (of_phandle_iterator_next(&it) == 0) {
  63
  64                 rmem = of_reserved_mem_lookup(it.node);
  65                 if (!rmem) {
  66                         of_node_put(it.node);
  67                         dev_err(&rproc->dev,
  68                                 "unable to acquire memory-region\n");
  69                         return -EINVAL;
  70                 }
  71
  72                 if (rmem->base > U32_MAX) {
  73                         of_node_put(it.node);
  74                         return -EINVAL;
  75                 }
  76
  77                 /* No need to translate pa to da, R-Car use same map */
  78                 da = rmem->base;
  79                 mem = rproc_mem_entry_init(dev, NULL,
  80                                            rmem->base,
  81                                            rmem->size, da,
  82                                            rcar_rproc_mem_alloc,
  83                                            rcar_rproc_mem_release,
  84                                            it.node->name);
  85
  86                 if (!mem) {
  87                         of_node_put(it.node);
  88                         return -ENOMEM;
  89                 }
  90
  91                 rproc_add_carveout(rproc, mem);
  92         }
  93
  94         return 0;
  95 }
  96
  97 static int rcar_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
  98 {
  99         int ret;
 100
 101         ret = rproc_elf_load_rsc_table(rproc, fw);
 102         if (ret)
 103                 dev_info(&rproc->dev, "No resource table in elf\n");
 104
 105         return 0;
 106 }
 107
 108 static int rcar_rproc_start(struct rproc *rproc)
 109 {
 110         struct rcar_rproc *priv = rproc->priv;
 111         int err;
 112
 113         if (!rproc->bootaddr)
 114                 return -EINVAL;
 115
 116         err = rcar_rst_set_rproc_boot_addr(rproc->bootaddr);
 117         if (err) {
 118                 dev_err(&rproc->dev, "failed to set rproc boot addr\n");
 119                 return err;
 120         }
 121
 122         err = reset_control_deassert(priv->rst);
 123         if (err)
 124                 dev_err(&rproc->dev, "failed to deassert reset\n");
 125
 126         return err;
 127 }
 128
 129 static int rcar_rproc_stop(struct rproc *rproc)
 130 {
 131         struct rcar_rproc *priv = rproc->priv;
 132         int err;
 133
 134         err = reset_control_assert(priv->rst);
 135         if (err)
 136                 dev_err(&rproc->dev, "failed to assert reset\n");
 137
 138         return err;
 139 }
 140
 141 static struct rproc_ops rcar_rproc_ops = {
 142         .prepare        = rcar_rproc_prepare,
 143         .start          = rcar_rproc_start,
 144         .stop           = rcar_rproc_stop,
 145         .load           = rproc_elf_load_segments,
 146         .parse_fw       = rcar_rproc_parse_fw,
 147         .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table,
 148         .sanity_check   = rproc_elf_sanity_check,
 149         .get_boot_addr  = rproc_elf_get_boot_addr,
 150
 151 };
 152
 153 static int rcar_rproc_probe(struct platform_device *pdev)
 154 {
 155         struct device *dev = &pdev->dev;
 156         struct device_node *np = dev->of_node;
 157         struct rcar_rproc *priv;
 158         struct rproc *rproc;
 159         int ret;
 160
 161         rproc = devm_rproc_alloc(dev, np->name, &rcar_rproc_ops,
 162                                 NULL, sizeof(*priv));
 163         if (!rproc)
 164                 return -ENOMEM;
 165
 166         priv = rproc->priv;
 167
 168         priv->rst = devm_reset_control_get_exclusive(dev, NULL);
 169         if (IS_ERR(priv->rst)) {
 170                 ret = PTR_ERR(priv->rst);
 171                 dev_err_probe(dev, ret, "fail to acquire rproc reset\n");
 172                 return ret;
 173         }
 174
 175         pm_runtime_enable(dev);
 176         ret = pm_runtime_resume_and_get(dev);
 177         if (ret) {
 178                 dev_err(dev, "failed to power up\n");
 179                 return ret;
 180         }
 181
 182         dev_set_drvdata(dev, rproc);
 183
 184         /* Manually start the rproc */
 185         rproc->auto_boot = false;
 186
 187         ret = devm_rproc_add(dev, rproc);
 188         if (ret) {
 189                 dev_err(dev, "rproc_add failed\n");
 190                 goto pm_disable;
 191         }
 192
 193         return 0;
 194
 195 pm_disable:
 196         pm_runtime_disable(dev);
 197
 198         return ret;
 199 }
 200
 201 static void rcar_rproc_remove(struct platform_device *pdev)
 202 {
 203         struct device *dev = &pdev->dev;
 204
 205         pm_runtime_disable(dev);
 206 }
 207
 208 static const struct of_device_id rcar_rproc_of_match[] = {
 209         { .compatible = "renesas,rcar-cr7" },
 210         {},
 211 };
 212
 213 MODULE_DEVICE_TABLE(of, rcar_rproc_of_match);
 214
 215 static struct platform_driver rcar_rproc_driver = {
 216         .probe = rcar_rproc_probe,
 217         .remove_new = rcar_rproc_remove,
 218         .driver = {
 219                 .name = "rcar-rproc",
 220                 .of_match_table = rcar_rproc_of_match,
 221         },
 222 };
 223
 224 module_platform_driver(rcar_rproc_driver);
 225
 226 MODULE_LICENSE("GPL v2");
 227 MODULE_DESCRIPTION("Renesas R-Car Gen3 remote processor control driver");
 228 MODULE_AUTHOR("Julien Massot <julien.massot@iot.bzh>");