blob: 5271f83bc0b00481ea7aafc58a416bdba681a3c3 [file] [log] [blame]
Fabien Dessenne6bed04f2019-05-31 15:11:34 +02001// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
2/*
3 * Copyright (C) 2019, STMicroelectronics - All Rights Reserved
4 */
Patrick Delaunayc886cd62020-11-06 19:01:34 +01005#define LOG_CATEGORY UCLASS_REMOTEPROC
6
Fabien Dessenne6bed04f2019-05-31 15:11:34 +02007#include <common.h>
8#include <dm.h>
9#include <errno.h>
10#include <fdtdec.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060011#include <log.h>
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020012#include <remoteproc.h>
13#include <reset.h>
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020014#include <asm/io.h>
Simon Glass336d4612020-02-03 07:36:16 -070015#include <dm/device_compat.h>
Simon Glass61b29b82020-02-03 07:36:15 -070016#include <linux/err.h>
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020017
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020018/**
19 * struct stm32_copro_privdata - power processor private data
20 * @reset_ctl: reset controller handle
Patrick Delaunay5a536df2020-10-15 15:01:12 +020021 * @hold_boot: hold boot controller handle
Fabien Dessenne33fd4192019-10-30 14:38:33 +010022 * @rsc_table_addr: resource table address
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020023 */
24struct stm32_copro_privdata {
25 struct reset_ctl reset_ctl;
Patrick Delaunay5a536df2020-10-15 15:01:12 +020026 struct reset_ctl hold_boot;
Fabien Dessenne33fd4192019-10-30 14:38:33 +010027 ulong rsc_table_addr;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020028};
29
30/**
31 * stm32_copro_probe() - Basic probe
32 * @dev: corresponding STM32 remote processor device
Heinrich Schuchardt185f8122022-01-19 18:05:50 +010033 * Return: 0 if all went ok, else corresponding -ve error
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020034 */
35static int stm32_copro_probe(struct udevice *dev)
36{
37 struct stm32_copro_privdata *priv;
Patrick Delaunay5a536df2020-10-15 15:01:12 +020038 int ret;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020039
40 priv = dev_get_priv(dev);
41
Patrick Delaunay5a536df2020-10-15 15:01:12 +020042 ret = reset_get_by_name(dev, "mcu_rst", &priv->reset_ctl);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020043 if (ret) {
44 dev_err(dev, "failed to get reset (%d)\n", ret);
45 return ret;
46 }
47
Patrick Delaunay5a536df2020-10-15 15:01:12 +020048 ret = reset_get_by_name(dev, "hold_boot", &priv->hold_boot);
49 if (ret) {
50 dev_err(dev, "failed to get hold boot (%d)\n", ret);
51 return ret;
52 }
53
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020054 dev_dbg(dev, "probed\n");
55
56 return 0;
57}
58
59/**
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020060 * stm32_copro_device_to_virt() - Convert device address to virtual address
61 * @dev: corresponding STM32 remote processor device
62 * @da: device address
Lokesh Vutlac08eb932019-09-04 16:01:27 +053063 * @size: Size of the memory region @da is pointing to
Heinrich Schuchardt185f8122022-01-19 18:05:50 +010064 * Return: converted virtual address
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020065 */
Lokesh Vutlac08eb932019-09-04 16:01:27 +053066static void *stm32_copro_device_to_virt(struct udevice *dev, ulong da,
67 ulong size)
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020068{
Lokesh Vutlac08eb932019-09-04 16:01:27 +053069 fdt32_t in_addr = cpu_to_be32(da), end_addr;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020070 u64 paddr;
71
72 paddr = dev_translate_dma_address(dev, &in_addr);
73 if (paddr == OF_BAD_ADDR) {
74 dev_err(dev, "Unable to convert address %ld\n", da);
75 return NULL;
76 }
77
Lokesh Vutlac08eb932019-09-04 16:01:27 +053078 end_addr = cpu_to_be32(da + size - 1);
79 if (dev_translate_dma_address(dev, &end_addr) == OF_BAD_ADDR) {
80 dev_err(dev, "Unable to convert address %ld\n", da + size - 1);
81 return NULL;
82 }
83
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020084 return phys_to_virt(paddr);
85}
86
87/**
88 * stm32_copro_load() - Loadup the STM32 remote processor
89 * @dev: corresponding STM32 remote processor device
90 * @addr: Address in memory where image is stored
91 * @size: Size in bytes of the image
Heinrich Schuchardt185f8122022-01-19 18:05:50 +010092 * Return: 0 if all went ok, else corresponding -ve error
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020093 */
94static int stm32_copro_load(struct udevice *dev, ulong addr, ulong size)
95{
96 struct stm32_copro_privdata *priv;
Fabien Dessenne33fd4192019-10-30 14:38:33 +010097 ulong rsc_table_size;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +020098 int ret;
99
100 priv = dev_get_priv(dev);
101
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200102 ret = reset_assert(&priv->hold_boot);
103 if (ret) {
104 dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200105 return ret;
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200106 }
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200107
108 ret = reset_assert(&priv->reset_ctl);
109 if (ret) {
110 dev_err(dev, "Unable to assert reset line (ret=%d)\n", ret);
111 return ret;
112 }
113
Fabien Dessenne33fd4192019-10-30 14:38:33 +0100114 if (rproc_elf32_load_rsc_table(dev, addr, size, &priv->rsc_table_addr,
115 &rsc_table_size)) {
116 priv->rsc_table_addr = 0;
117 dev_warn(dev, "No valid resource table for this firmware\n");
118 }
119
Lokesh Vutla14d963d2019-09-04 16:01:28 +0530120 return rproc_elf32_load_image(dev, addr, size);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200121}
122
123/**
124 * stm32_copro_start() - Start the STM32 remote processor
125 * @dev: corresponding STM32 remote processor device
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100126 * Return: 0 if all went ok, else corresponding -ve error
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200127 */
128static int stm32_copro_start(struct udevice *dev)
129{
Fabien Dessenne33fd4192019-10-30 14:38:33 +0100130 struct stm32_copro_privdata *priv;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200131 int ret;
132
Fabien Dessenne33fd4192019-10-30 14:38:33 +0100133 priv = dev_get_priv(dev);
134
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200135 ret = reset_deassert(&priv->hold_boot);
136 if (ret) {
137 dev_err(dev, "Unable to deassert hold boot (ret=%d)\n", ret);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200138 return ret;
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200139 }
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200140
141 /*
142 * Once copro running, reset hold boot flag to avoid copro
Patrick Delaunay9ed6f922020-10-15 15:01:13 +0200143 * rebooting autonomously (error should never occur)
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200144 */
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200145 ret = reset_assert(&priv->hold_boot);
146 if (ret)
147 dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
148
Patrick Delaunay9ed6f922020-10-15 15:01:13 +0200149 /* indicates that copro is running */
150 writel(TAMP_COPRO_STATE_CRUN, TAMP_COPRO_STATE);
151 /* Store rsc_address in bkp register */
152 writel(priv->rsc_table_addr, TAMP_COPRO_RSC_TBL_ADDRESS);
Fabien Dessenne33fd4192019-10-30 14:38:33 +0100153
Patrick Delaunay9ed6f922020-10-15 15:01:13 +0200154 return 0;
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200155}
156
157/**
158 * stm32_copro_reset() - Reset the STM32 remote processor
159 * @dev: corresponding STM32 remote processor device
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100160 * Return: 0 if all went ok, else corresponding -ve error
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200161 */
162static int stm32_copro_reset(struct udevice *dev)
163{
164 struct stm32_copro_privdata *priv;
165 int ret;
166
167 priv = dev_get_priv(dev);
168
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200169 ret = reset_assert(&priv->hold_boot);
170 if (ret) {
171 dev_err(dev, "Unable to assert hold boot (ret=%d)\n", ret);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200172 return ret;
Patrick Delaunay5a536df2020-10-15 15:01:12 +0200173 }
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200174
175 ret = reset_assert(&priv->reset_ctl);
176 if (ret) {
177 dev_err(dev, "Unable to assert reset line (ret=%d)\n", ret);
178 return ret;
179 }
180
Fabien Dessenne4a4deb82019-10-30 14:38:31 +0100181 writel(TAMP_COPRO_STATE_OFF, TAMP_COPRO_STATE);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200182
183 return 0;
184}
185
186/**
187 * stm32_copro_stop() - Stop the STM32 remote processor
188 * @dev: corresponding STM32 remote processor device
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100189 * Return: 0 if all went ok, else corresponding -ve error
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200190 */
191static int stm32_copro_stop(struct udevice *dev)
192{
193 return stm32_copro_reset(dev);
194}
195
196/**
197 * stm32_copro_is_running() - Is the STM32 remote processor running
198 * @dev: corresponding STM32 remote processor device
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100199 * Return: 0 if the remote processor is running, 1 otherwise
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200200 */
201static int stm32_copro_is_running(struct udevice *dev)
202{
Fabien Dessenne4a4deb82019-10-30 14:38:31 +0100203 return (readl(TAMP_COPRO_STATE) == TAMP_COPRO_STATE_OFF);
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200204}
205
206static const struct dm_rproc_ops stm32_copro_ops = {
207 .load = stm32_copro_load,
208 .start = stm32_copro_start,
209 .stop = stm32_copro_stop,
210 .reset = stm32_copro_reset,
211 .is_running = stm32_copro_is_running,
212 .device_to_virt = stm32_copro_device_to_virt,
213};
214
215static const struct udevice_id stm32_copro_ids[] = {
Patrick Delaunay5d2901a2019-08-02 15:07:18 +0200216 {.compatible = "st,stm32mp1-m4"},
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200217 {}
218};
219
220U_BOOT_DRIVER(stm32_copro) = {
221 .name = "stm32_m4_proc",
222 .of_match = stm32_copro_ids,
223 .id = UCLASS_REMOTEPROC,
224 .ops = &stm32_copro_ops,
225 .probe = stm32_copro_probe,
Simon Glass41575d82020-12-03 16:55:17 -0700226 .priv_auto = sizeof(struct stm32_copro_privdata),
Fabien Dessenne6bed04f2019-05-31 15:11:34 +0200227};