• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2013 Google, Inc
4  *
5  * (C) Copyright 2012
6  * Pavel Herrmann <morpheus.ibis@gmail.com>
7  */
8 
9 #include <common.h>
10 #include <errno.h>
11 #include <fdtdec.h>
12 #include <malloc.h>
13 #include <linux/libfdt.h>
14 #include <dm/device.h>
15 #include <dm/device-internal.h>
16 #include <dm/lists.h>
17 #include <dm/of.h>
18 #include <dm/of_access.h>
19 #include <dm/platdata.h>
20 #include <dm/read.h>
21 #include <dm/root.h>
22 #include <dm/uclass.h>
23 #include <dm/util.h>
24 #include <linux/list.h>
25 
26 DECLARE_GLOBAL_DATA_PTR;
27 
28 static const struct driver_info root_info = {
29 	.name		= "root_driver",
30 };
31 
dm_root(void)32 struct udevice *dm_root(void)
33 {
34 	if (!gd->dm_root) {
35 		dm_warn("Virtual root driver does not exist!\n");
36 		return NULL;
37 	}
38 
39 	return gd->dm_root;
40 }
41 
dm_fixup_for_gd_move(struct global_data * new_gd)42 void dm_fixup_for_gd_move(struct global_data *new_gd)
43 {
44 	/* The sentinel node has moved, so update things that point to it */
45 	if (gd->dm_root) {
46 		new_gd->uclass_root.next->prev = &new_gd->uclass_root;
47 		new_gd->uclass_root.prev->next = &new_gd->uclass_root;
48 	}
49 }
50 
51 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
fix_drivers(void)52 void fix_drivers(void)
53 {
54 	struct driver *drv =
55 		ll_entry_start(struct driver, driver);
56 	const int n_ents = ll_entry_count(struct driver, driver);
57 	struct driver *entry;
58 
59 	for (entry = drv; entry != drv + n_ents; entry++) {
60 		if (entry->of_match)
61 			entry->of_match = (const struct udevice_id *)
62 				((u32)entry->of_match + gd->reloc_off);
63 		if (entry->bind)
64 			entry->bind += gd->reloc_off;
65 		if (entry->probe)
66 			entry->probe += gd->reloc_off;
67 		if (entry->remove)
68 			entry->remove += gd->reloc_off;
69 		if (entry->unbind)
70 			entry->unbind += gd->reloc_off;
71 		if (entry->ofdata_to_platdata)
72 			entry->ofdata_to_platdata += gd->reloc_off;
73 		if (entry->child_post_bind)
74 			entry->child_post_bind += gd->reloc_off;
75 		if (entry->child_pre_probe)
76 			entry->child_pre_probe += gd->reloc_off;
77 		if (entry->child_post_remove)
78 			entry->child_post_remove += gd->reloc_off;
79 		/* OPS are fixed in every uclass post_probe function */
80 		if (entry->ops)
81 			entry->ops += gd->reloc_off;
82 	}
83 }
84 
fix_uclass(void)85 void fix_uclass(void)
86 {
87 	struct uclass_driver *uclass =
88 		ll_entry_start(struct uclass_driver, uclass);
89 	const int n_ents = ll_entry_count(struct uclass_driver, uclass);
90 	struct uclass_driver *entry;
91 
92 	for (entry = uclass; entry != uclass + n_ents; entry++) {
93 		if (entry->post_bind)
94 			entry->post_bind += gd->reloc_off;
95 		if (entry->pre_unbind)
96 			entry->pre_unbind += gd->reloc_off;
97 		if (entry->pre_probe)
98 			entry->pre_probe += gd->reloc_off;
99 		if (entry->post_probe)
100 			entry->post_probe += gd->reloc_off;
101 		if (entry->pre_remove)
102 			entry->pre_remove += gd->reloc_off;
103 		if (entry->child_post_bind)
104 			entry->child_post_bind += gd->reloc_off;
105 		if (entry->child_pre_probe)
106 			entry->child_pre_probe += gd->reloc_off;
107 		if (entry->init)
108 			entry->init += gd->reloc_off;
109 		if (entry->destroy)
110 			entry->destroy += gd->reloc_off;
111 		/* FIXME maybe also need to fix these ops */
112 		if (entry->ops)
113 			entry->ops += gd->reloc_off;
114 	}
115 }
116 
fix_devices(void)117 void fix_devices(void)
118 {
119 	struct driver_info *dev =
120 		ll_entry_start(struct driver_info, driver_info);
121 	const int n_ents = ll_entry_count(struct driver_info, driver_info);
122 	struct driver_info *entry;
123 
124 	for (entry = dev; entry != dev + n_ents; entry++) {
125 		if (entry->platdata)
126 			entry->platdata += gd->reloc_off;
127 	}
128 }
129 
130 #endif
131 
dm_init(bool of_live)132 int dm_init(bool of_live)
133 {
134 	int ret;
135 
136 	if (gd->dm_root) {
137 		dm_warn("Virtual root driver already exists!\n");
138 		return -EINVAL;
139 	}
140 	INIT_LIST_HEAD(&DM_UCLASS_ROOT_NON_CONST);
141 
142 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
143 	fix_drivers();
144 	fix_uclass();
145 	fix_devices();
146 #endif
147 
148 	ret = device_bind_by_name(NULL, false, &root_info, &DM_ROOT_NON_CONST);
149 	if (ret)
150 		return ret;
151 #if CONFIG_IS_ENABLED(OF_CONTROL)
152 # if CONFIG_IS_ENABLED(OF_LIVE)
153 	if (of_live)
154 		DM_ROOT_NON_CONST->node = np_to_ofnode(gd->of_root);
155 	else
156 #endif
157 		DM_ROOT_NON_CONST->node = offset_to_ofnode(0);
158 #endif
159 	ret = device_probe(DM_ROOT_NON_CONST);
160 	if (ret)
161 		return ret;
162 
163 	return 0;
164 }
165 
dm_uninit(void)166 int dm_uninit(void)
167 {
168 	device_remove(dm_root(), DM_REMOVE_NORMAL);
169 	device_unbind(dm_root());
170 	gd->dm_root = NULL;
171 
172 	return 0;
173 }
174 
175 #if CONFIG_IS_ENABLED(DM_DEVICE_REMOVE)
dm_remove_devices_flags(uint flags)176 int dm_remove_devices_flags(uint flags)
177 {
178 	device_remove(dm_root(), flags);
179 
180 	return 0;
181 }
182 #endif
183 
dm_scan_platdata(bool pre_reloc_only)184 int dm_scan_platdata(bool pre_reloc_only)
185 {
186 	int ret;
187 
188 	ret = lists_bind_drivers(DM_ROOT_NON_CONST, pre_reloc_only);
189 	if (ret == -ENOENT) {
190 		dm_warn("Some drivers were not found\n");
191 		ret = 0;
192 	}
193 
194 	return ret;
195 }
196 
197 #if CONFIG_IS_ENABLED(OF_LIVE)
dm_scan_fdt_live(struct udevice * parent,const struct device_node * node_parent,bool pre_reloc_only)198 static int dm_scan_fdt_live(struct udevice *parent,
199 			    const struct device_node *node_parent,
200 			    bool pre_reloc_only)
201 {
202 	struct device_node *np;
203 	int ret = 0, err;
204 
205 	for (np = node_parent->child; np; np = np->sibling) {
206 		/* "chosen" node isn't a device itself but may contain some: */
207 		if (!strcmp(np->name, "chosen")) {
208 			pr_debug("parsing subnodes of \"chosen\"\n");
209 
210 			err = dm_scan_fdt_live(parent, np, pre_reloc_only);
211 			if (err && !ret)
212 				ret = err;
213 			continue;
214 		}
215 
216 		if (!of_device_is_available(np)) {
217 			pr_debug("   - ignoring disabled device\n");
218 			continue;
219 		}
220 		err = lists_bind_fdt(parent, np_to_ofnode(np), NULL,
221 				     pre_reloc_only);
222 		if (err && !ret) {
223 			ret = err;
224 			debug("%s: ret=%d\n", np->name, ret);
225 		}
226 	}
227 
228 	if (ret)
229 		dm_warn("Some drivers failed to bind\n");
230 
231 	return ret;
232 }
233 #endif /* CONFIG_IS_ENABLED(OF_LIVE) */
234 
235 #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
236 /**
237  * dm_scan_fdt_node() - Scan the device tree and bind drivers for a node
238  *
239  * This scans the subnodes of a device tree node and and creates a driver
240  * for each one.
241  *
242  * @parent: Parent device for the devices that will be created
243  * @blob: Pointer to device tree blob
244  * @offset: Offset of node to scan
245  * @pre_reloc_only: If true, bind only drivers with the DM_FLAG_PRE_RELOC
246  * flag. If false bind all drivers.
247  * @return 0 if OK, -ve on error
248  */
dm_scan_fdt_node(struct udevice * parent,const void * blob,int offset,bool pre_reloc_only)249 static int dm_scan_fdt_node(struct udevice *parent, const void *blob,
250 			    int offset, bool pre_reloc_only)
251 {
252 	int ret = 0, err;
253 
254 	for (offset = fdt_first_subnode(blob, offset);
255 	     offset > 0;
256 	     offset = fdt_next_subnode(blob, offset)) {
257 		const char *node_name = fdt_get_name(blob, offset, NULL);
258 
259 		/*
260 		 * The "chosen" and "firmware" nodes aren't devices
261 		 * themselves but may contain some:
262 		 */
263 		if (!strcmp(node_name, "chosen") ||
264 		    !strcmp(node_name, "firmware")) {
265 			pr_debug("parsing subnodes of \"%s\"\n", node_name);
266 
267 			err = dm_scan_fdt_node(parent, blob, offset,
268 					       pre_reloc_only);
269 			if (err && !ret)
270 				ret = err;
271 			continue;
272 		}
273 
274 		if (!fdtdec_get_is_enabled(blob, offset)) {
275 			pr_debug("   - ignoring disabled device\n");
276 			continue;
277 		}
278 		err = lists_bind_fdt(parent, offset_to_ofnode(offset), NULL,
279 				     pre_reloc_only);
280 		if (err && !ret) {
281 			ret = err;
282 			debug("%s: ret=%d\n", node_name, ret);
283 		}
284 	}
285 
286 	if (ret)
287 		dm_warn("Some drivers failed to bind\n");
288 
289 	return ret;
290 }
291 
dm_scan_fdt_dev(struct udevice * dev)292 int dm_scan_fdt_dev(struct udevice *dev)
293 {
294 	if (!dev_of_valid(dev))
295 		return 0;
296 
297 #if CONFIG_IS_ENABLED(OF_LIVE)
298 	if (of_live_active())
299 		return dm_scan_fdt_live(dev, dev_np(dev),
300 				gd->flags & GD_FLG_RELOC ? false : true);
301 	else
302 #endif
303 	return dm_scan_fdt_node(dev, gd->fdt_blob, dev_of_offset(dev),
304 				gd->flags & GD_FLG_RELOC ? false : true);
305 }
306 
dm_scan_fdt(const void * blob,bool pre_reloc_only)307 int dm_scan_fdt(const void *blob, bool pre_reloc_only)
308 {
309 #if CONFIG_IS_ENABLED(OF_LIVE)
310 	if (of_live_active())
311 		return dm_scan_fdt_live(gd->dm_root, gd->of_root,
312 					pre_reloc_only);
313 	else
314 #endif
315 	return dm_scan_fdt_node(gd->dm_root, blob, 0, pre_reloc_only);
316 }
317 
dm_scan_fdt_ofnode_path(const char * path,bool pre_reloc_only)318 static int dm_scan_fdt_ofnode_path(const char *path, bool pre_reloc_only)
319 {
320 	ofnode node;
321 
322 	node = ofnode_path(path);
323 	if (!ofnode_valid(node))
324 		return 0;
325 
326 #if CONFIG_IS_ENABLED(OF_LIVE)
327 	if (of_live_active())
328 		return dm_scan_fdt_live(gd->dm_root, node.np, pre_reloc_only);
329 #endif
330 	return dm_scan_fdt_node(gd->dm_root, gd->fdt_blob, node.of_offset,
331 				pre_reloc_only);
332 }
333 
dm_extended_scan_fdt(const void * blob,bool pre_reloc_only)334 int dm_extended_scan_fdt(const void *blob, bool pre_reloc_only)
335 {
336 	int ret;
337 
338 	ret = dm_scan_fdt(blob, pre_reloc_only);
339 	if (ret) {
340 		debug("dm_scan_fdt() failed: %d\n", ret);
341 		return ret;
342 	}
343 
344 	ret = dm_scan_fdt_ofnode_path("/clocks", pre_reloc_only);
345 	if (ret) {
346 		debug("scan for /clocks failed: %d\n", ret);
347 		return ret;
348 	}
349 
350 	ret = dm_scan_fdt_ofnode_path("/firmware", pre_reloc_only);
351 	if (ret)
352 		debug("scan for /firmware failed: %d\n", ret);
353 
354 	return ret;
355 }
356 #endif
357 
dm_scan_other(bool pre_reloc_only)358 __weak int dm_scan_other(bool pre_reloc_only)
359 {
360 	return 0;
361 }
362 
dm_init_and_scan(bool pre_reloc_only)363 int dm_init_and_scan(bool pre_reloc_only)
364 {
365 	int ret;
366 
367 	ret = dm_init(IS_ENABLED(CONFIG_OF_LIVE));
368 	if (ret) {
369 		debug("dm_init() failed: %d\n", ret);
370 		return ret;
371 	}
372 	ret = dm_scan_platdata(pre_reloc_only);
373 	if (ret) {
374 		debug("dm_scan_platdata() failed: %d\n", ret);
375 		return ret;
376 	}
377 
378 	if (CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)) {
379 		ret = dm_extended_scan_fdt(gd->fdt_blob, pre_reloc_only);
380 		if (ret) {
381 			debug("dm_extended_scan_dt() failed: %d\n", ret);
382 			return ret;
383 		}
384 	}
385 
386 	ret = dm_scan_other(pre_reloc_only);
387 	if (ret)
388 		return ret;
389 
390 	return 0;
391 }
392 
393 /* This is the root driver - all drivers are children of this */
394 U_BOOT_DRIVER(root_driver) = {
395 	.name	= "root_driver",
396 	.id	= UCLASS_ROOT,
397 };
398 
399 /* This is the root uclass */
400 UCLASS_DRIVER(root) = {
401 	.name	= "root",
402 	.id	= UCLASS_ROOT,
403 };
404