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
 18struct rcar_rproc {
 19	struct reset_control *rst;
 20};
 21
 22static 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
 42static 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
 51static 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 rproc_mem_entry *mem;
 56	int i = 0;
 57	u32 da;
 58
 59	/* Register associated reserved memory regions */
 60	while (1) {
 61		struct resource res;
 62		int ret;
 63
 64		ret = of_reserved_mem_region_to_resource(np, i++, &res);
 65		if (ret)
 66			return 0;
 67
 68		if (res.start > U32_MAX)
 69			return -EINVAL;
 70
 71		/* No need to translate pa to da, R-Car use same map */
 72		da = res.start;
 73		mem = rproc_mem_entry_init(dev, NULL,
 74					   res.start,
 75					   resource_size(&res), da,
 76					   rcar_rproc_mem_alloc,
 77					   rcar_rproc_mem_release,
 78					   res.name);
 79
 80		if (!mem)
 81			return -ENOMEM;
 82
 83		rproc_add_carveout(rproc, mem);
 84	}
 85}
 86
 87static int rcar_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
 88{
 89	int ret;
 90
 91	ret = rproc_elf_load_rsc_table(rproc, fw);
 92	if (ret)
 93		dev_info(&rproc->dev, "No resource table in elf\n");
 94
 95	return 0;
 96}
 97
 98static int rcar_rproc_start(struct rproc *rproc)
 99{
100	struct rcar_rproc *priv = rproc->priv;
101	int err;
102
103	if (!rproc->bootaddr)
104		return -EINVAL;
105
106	err = rcar_rst_set_rproc_boot_addr(rproc->bootaddr);
107	if (err) {
108		dev_err(&rproc->dev, "failed to set rproc boot addr\n");
109		return err;
110	}
111
112	err = reset_control_deassert(priv->rst);
113	if (err)
114		dev_err(&rproc->dev, "failed to deassert reset\n");
115
116	return err;
117}
118
119static int rcar_rproc_stop(struct rproc *rproc)
120{
121	struct rcar_rproc *priv = rproc->priv;
122	int err;
123
124	err = reset_control_assert(priv->rst);
125	if (err)
126		dev_err(&rproc->dev, "failed to assert reset\n");
127
128	return err;
129}
130
131static struct rproc_ops rcar_rproc_ops = {
132	.prepare	= rcar_rproc_prepare,
133	.start		= rcar_rproc_start,
134	.stop		= rcar_rproc_stop,
135	.load		= rproc_elf_load_segments,
136	.parse_fw	= rcar_rproc_parse_fw,
137	.find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table,
138	.sanity_check	= rproc_elf_sanity_check,
139	.get_boot_addr	= rproc_elf_get_boot_addr,
140
141};
142
143static int rcar_rproc_probe(struct platform_device *pdev)
144{
145	struct device *dev = &pdev->dev;
146	struct device_node *np = dev->of_node;
147	struct rcar_rproc *priv;
148	struct rproc *rproc;
149	int ret;
150
151	rproc = devm_rproc_alloc(dev, np->name, &rcar_rproc_ops,
152				NULL, sizeof(*priv));
153	if (!rproc)
154		return -ENOMEM;
155
156	priv = rproc->priv;
157
158	priv->rst = devm_reset_control_get_exclusive(dev, NULL);
159	if (IS_ERR(priv->rst)) {
160		ret = PTR_ERR(priv->rst);
161		dev_err_probe(dev, ret, "fail to acquire rproc reset\n");
162		return ret;
163	}
164
165	pm_runtime_enable(dev);
166	ret = pm_runtime_resume_and_get(dev);
167	if (ret) {
168		dev_err(dev, "failed to power up\n");
169		return ret;
170	}
171
172	dev_set_drvdata(dev, rproc);
173
174	/* Manually start the rproc */
175	rproc->auto_boot = false;
176
177	ret = devm_rproc_add(dev, rproc);
178	if (ret) {
179		dev_err(dev, "rproc_add failed\n");
180		goto pm_disable;
181	}
182
183	return 0;
184
185pm_disable:
186	pm_runtime_disable(dev);
187
188	return ret;
189}
190
191static void rcar_rproc_remove(struct platform_device *pdev)
192{
193	struct device *dev = &pdev->dev;
194
195	pm_runtime_disable(dev);
196}
197
198static const struct of_device_id rcar_rproc_of_match[] = {
199	{ .compatible = "renesas,rcar-cr7" },
200	{},
201};
202
203MODULE_DEVICE_TABLE(of, rcar_rproc_of_match);
204
205static struct platform_driver rcar_rproc_driver = {
206	.probe = rcar_rproc_probe,
207	.remove = rcar_rproc_remove,
208	.driver = {
209		.name = "rcar-rproc",
210		.of_match_table = rcar_rproc_of_match,
211	},
212};
213
214module_platform_driver(rcar_rproc_driver);
215
216MODULE_LICENSE("GPL v2");
217MODULE_DESCRIPTION("Renesas R-Car Gen3 remote processor control driver");
218MODULE_AUTHOR("Julien Massot <julien.massot@iot.bzh>");