]>
Commit | Line | Data |
---|---|---|
6494d708 SG |
1 | /* |
2 | * Device manager | |
3 | * | |
4 | * Copyright (c) 2013 Google, Inc | |
5 | * | |
6 | * (C) Copyright 2012 | |
7 | * Pavel Herrmann <[email protected]> | |
8 | * | |
9 | * SPDX-License-Identifier: GPL-2.0+ | |
10 | */ | |
11 | ||
12 | #include <common.h> | |
5a66a8ff | 13 | #include <fdtdec.h> |
6494d708 SG |
14 | #include <malloc.h> |
15 | #include <dm/device.h> | |
16 | #include <dm/device-internal.h> | |
17 | #include <dm/lists.h> | |
18 | #include <dm/platdata.h> | |
19 | #include <dm/uclass.h> | |
20 | #include <dm/uclass-internal.h> | |
21 | #include <dm/util.h> | |
22 | #include <linux/err.h> | |
23 | #include <linux/list.h> | |
24 | ||
5a66a8ff SG |
25 | DECLARE_GLOBAL_DATA_PTR; |
26 | ||
54c5d08a HS |
27 | int device_bind(struct udevice *parent, struct driver *drv, const char *name, |
28 | void *platdata, int of_offset, struct udevice **devp) | |
6494d708 | 29 | { |
54c5d08a | 30 | struct udevice *dev; |
6494d708 SG |
31 | struct uclass *uc; |
32 | int ret = 0; | |
33 | ||
34 | *devp = NULL; | |
35 | if (!name) | |
36 | return -EINVAL; | |
37 | ||
38 | ret = uclass_get(drv->id, &uc); | |
39 | if (ret) | |
40 | return ret; | |
41 | ||
54c5d08a | 42 | dev = calloc(1, sizeof(struct udevice)); |
6494d708 SG |
43 | if (!dev) |
44 | return -ENOMEM; | |
45 | ||
46 | INIT_LIST_HEAD(&dev->sibling_node); | |
47 | INIT_LIST_HEAD(&dev->child_head); | |
48 | INIT_LIST_HEAD(&dev->uclass_node); | |
49 | dev->platdata = platdata; | |
50 | dev->name = name; | |
51 | dev->of_offset = of_offset; | |
52 | dev->parent = parent; | |
53 | dev->driver = drv; | |
54 | dev->uclass = uc; | |
5a66a8ff | 55 | |
5a66a8ff | 56 | dev->seq = -1; |
9cc36a2b | 57 | dev->req_seq = -1; |
91cbd792 | 58 | #ifdef CONFIG_OF_CONTROL |
9cc36a2b SG |
59 | /* |
60 | * Some devices, such as a SPI bus, I2C bus and serial ports are | |
61 | * numbered using aliases. | |
62 | * | |
63 | * This is just a 'requested' sequence, and will be | |
64 | * resolved (and ->seq updated) when the device is probed. | |
65 | */ | |
66 | if (uc->uc_drv->flags & DM_UC_FLAG_SEQ_ALIAS) { | |
67 | if (uc->uc_drv->name && of_offset != -1) { | |
68 | fdtdec_get_alias_seq(gd->fdt_blob, uc->uc_drv->name, | |
69 | of_offset, &dev->req_seq); | |
70 | } | |
5a66a8ff | 71 | } |
91cbd792 | 72 | #endif |
f8a85449 | 73 | if (!dev->platdata && drv->platdata_auto_alloc_size) { |
6494d708 | 74 | dev->flags |= DM_FLAG_ALLOC_PDATA; |
f8a85449 SG |
75 | dev->platdata = calloc(1, drv->platdata_auto_alloc_size); |
76 | if (!dev->platdata) { | |
77 | ret = -ENOMEM; | |
78 | goto fail_alloc1; | |
79 | } | |
80 | } | |
cdc133bd SG |
81 | if (parent) { |
82 | int size = parent->driver->per_child_platdata_auto_alloc_size; | |
83 | ||
ba8da9dc SG |
84 | if (!size) { |
85 | size = parent->uclass->uc_drv-> | |
86 | per_child_platdata_auto_alloc_size; | |
87 | } | |
cdc133bd SG |
88 | if (size) { |
89 | dev->flags |= DM_FLAG_ALLOC_PARENT_PDATA; | |
90 | dev->parent_platdata = calloc(1, size); | |
91 | if (!dev->parent_platdata) { | |
92 | ret = -ENOMEM; | |
93 | goto fail_alloc2; | |
94 | } | |
95 | } | |
96 | } | |
6494d708 SG |
97 | |
98 | /* put dev into parent's successor list */ | |
99 | if (parent) | |
100 | list_add_tail(&dev->sibling_node, &parent->child_head); | |
101 | ||
102 | ret = uclass_bind_device(dev); | |
103 | if (ret) | |
72ebfe86 | 104 | goto fail_uclass_bind; |
6494d708 SG |
105 | |
106 | /* if we fail to bind we remove device from successors and free it */ | |
107 | if (drv->bind) { | |
108 | ret = drv->bind(dev); | |
72ebfe86 | 109 | if (ret) |
6494d708 | 110 | goto fail_bind; |
6494d708 | 111 | } |
0118ce79 SG |
112 | if (parent && parent->driver->child_post_bind) { |
113 | ret = parent->driver->child_post_bind(dev); | |
114 | if (ret) | |
115 | goto fail_child_post_bind; | |
116 | } | |
117 | ||
6494d708 SG |
118 | if (parent) |
119 | dm_dbg("Bound device %s to %s\n", dev->name, parent->name); | |
120 | *devp = dev; | |
121 | ||
122 | return 0; | |
123 | ||
0118ce79 SG |
124 | fail_child_post_bind: |
125 | if (drv->unbind && drv->unbind(dev)) { | |
126 | dm_warn("unbind() method failed on dev '%s' on error path\n", | |
127 | dev->name); | |
128 | } | |
129 | ||
6494d708 | 130 | fail_bind: |
72ebfe86 SG |
131 | if (uclass_unbind_device(dev)) { |
132 | dm_warn("Failed to unbind dev '%s' on error path\n", | |
133 | dev->name); | |
134 | } | |
135 | fail_uclass_bind: | |
cdc133bd SG |
136 | list_del(&dev->sibling_node); |
137 | if (dev->flags & DM_FLAG_ALLOC_PARENT_PDATA) { | |
138 | free(dev->parent_platdata); | |
139 | dev->parent_platdata = NULL; | |
140 | } | |
141 | fail_alloc2: | |
f8a85449 SG |
142 | if (dev->flags & DM_FLAG_ALLOC_PDATA) { |
143 | free(dev->platdata); | |
144 | dev->platdata = NULL; | |
145 | } | |
146 | fail_alloc1: | |
6494d708 | 147 | free(dev); |
72ebfe86 | 148 | |
6494d708 SG |
149 | return ret; |
150 | } | |
151 | ||
00606d7e SG |
152 | int device_bind_by_name(struct udevice *parent, bool pre_reloc_only, |
153 | const struct driver_info *info, struct udevice **devp) | |
6494d708 SG |
154 | { |
155 | struct driver *drv; | |
156 | ||
157 | drv = lists_driver_lookup_name(info->name); | |
158 | if (!drv) | |
159 | return -ENOENT; | |
00606d7e SG |
160 | if (pre_reloc_only && !(drv->flags & DM_FLAG_PRE_RELOC)) |
161 | return -EPERM; | |
6494d708 SG |
162 | |
163 | return device_bind(parent, drv, info->name, (void *)info->platdata, | |
164 | -1, devp); | |
165 | } | |
166 | ||
accd4b19 | 167 | int device_probe_child(struct udevice *dev, void *parent_priv) |
6494d708 SG |
168 | { |
169 | struct driver *drv; | |
170 | int size = 0; | |
171 | int ret; | |
5a66a8ff | 172 | int seq; |
6494d708 SG |
173 | |
174 | if (!dev) | |
175 | return -EINVAL; | |
176 | ||
177 | if (dev->flags & DM_FLAG_ACTIVATED) | |
178 | return 0; | |
179 | ||
180 | drv = dev->driver; | |
181 | assert(drv); | |
182 | ||
f8a85449 | 183 | /* Allocate private data if requested */ |
6494d708 SG |
184 | if (drv->priv_auto_alloc_size) { |
185 | dev->priv = calloc(1, drv->priv_auto_alloc_size); | |
186 | if (!dev->priv) { | |
187 | ret = -ENOMEM; | |
188 | goto fail; | |
189 | } | |
190 | } | |
191 | /* Allocate private data if requested */ | |
6494d708 SG |
192 | size = dev->uclass->uc_drv->per_device_auto_alloc_size; |
193 | if (size) { | |
194 | dev->uclass_priv = calloc(1, size); | |
195 | if (!dev->uclass_priv) { | |
196 | ret = -ENOMEM; | |
197 | goto fail; | |
198 | } | |
199 | } | |
200 | ||
201 | /* Ensure all parents are probed */ | |
202 | if (dev->parent) { | |
e59f458d | 203 | size = dev->parent->driver->per_child_auto_alloc_size; |
dac8db2c SG |
204 | if (!size) { |
205 | size = dev->parent->uclass->uc_drv-> | |
206 | per_child_auto_alloc_size; | |
207 | } | |
e59f458d SG |
208 | if (size) { |
209 | dev->parent_priv = calloc(1, size); | |
210 | if (!dev->parent_priv) { | |
211 | ret = -ENOMEM; | |
212 | goto fail; | |
213 | } | |
accd4b19 SG |
214 | if (parent_priv) |
215 | memcpy(dev->parent_priv, parent_priv, size); | |
e59f458d SG |
216 | } |
217 | ||
6494d708 SG |
218 | ret = device_probe(dev->parent); |
219 | if (ret) | |
220 | goto fail; | |
221 | } | |
222 | ||
5a66a8ff SG |
223 | seq = uclass_resolve_seq(dev); |
224 | if (seq < 0) { | |
225 | ret = seq; | |
226 | goto fail; | |
227 | } | |
228 | dev->seq = seq; | |
229 | ||
83c7e434 SG |
230 | ret = uclass_pre_probe_child(dev); |
231 | if (ret) | |
232 | goto fail; | |
233 | ||
a327dee0 SG |
234 | if (dev->parent && dev->parent->driver->child_pre_probe) { |
235 | ret = dev->parent->driver->child_pre_probe(dev); | |
236 | if (ret) | |
237 | goto fail; | |
238 | } | |
239 | ||
6494d708 SG |
240 | if (drv->ofdata_to_platdata && dev->of_offset >= 0) { |
241 | ret = drv->ofdata_to_platdata(dev); | |
242 | if (ret) | |
243 | goto fail; | |
244 | } | |
245 | ||
246 | if (drv->probe) { | |
247 | ret = drv->probe(dev); | |
248 | if (ret) | |
249 | goto fail; | |
250 | } | |
251 | ||
252 | dev->flags |= DM_FLAG_ACTIVATED; | |
253 | ||
254 | ret = uclass_post_probe_device(dev); | |
255 | if (ret) { | |
256 | dev->flags &= ~DM_FLAG_ACTIVATED; | |
257 | goto fail_uclass; | |
258 | } | |
259 | ||
260 | return 0; | |
261 | fail_uclass: | |
262 | if (device_remove(dev)) { | |
263 | dm_warn("%s: Device '%s' failed to remove on error path\n", | |
264 | __func__, dev->name); | |
265 | } | |
266 | fail: | |
5a66a8ff | 267 | dev->seq = -1; |
6494d708 SG |
268 | device_free(dev); |
269 | ||
270 | return ret; | |
271 | } | |
272 | ||
accd4b19 SG |
273 | int device_probe(struct udevice *dev) |
274 | { | |
275 | return device_probe_child(dev, NULL); | |
276 | } | |
277 | ||
54c5d08a | 278 | void *dev_get_platdata(struct udevice *dev) |
6494d708 SG |
279 | { |
280 | if (!dev) { | |
964d153c | 281 | dm_warn("%s: null device\n", __func__); |
6494d708 SG |
282 | return NULL; |
283 | } | |
284 | ||
285 | return dev->platdata; | |
286 | } | |
287 | ||
cdc133bd SG |
288 | void *dev_get_parent_platdata(struct udevice *dev) |
289 | { | |
290 | if (!dev) { | |
291 | dm_warn("%s: null device", __func__); | |
292 | return NULL; | |
293 | } | |
294 | ||
295 | return dev->parent_platdata; | |
296 | } | |
297 | ||
54c5d08a | 298 | void *dev_get_priv(struct udevice *dev) |
6494d708 SG |
299 | { |
300 | if (!dev) { | |
964d153c | 301 | dm_warn("%s: null device\n", __func__); |
6494d708 SG |
302 | return NULL; |
303 | } | |
304 | ||
305 | return dev->priv; | |
306 | } | |
997c87bb | 307 | |
e564f054 SG |
308 | void *dev_get_uclass_priv(struct udevice *dev) |
309 | { | |
310 | if (!dev) { | |
311 | dm_warn("%s: null device\n", __func__); | |
312 | return NULL; | |
313 | } | |
314 | ||
315 | return dev->uclass_priv; | |
316 | } | |
317 | ||
e59f458d SG |
318 | void *dev_get_parentdata(struct udevice *dev) |
319 | { | |
320 | if (!dev) { | |
964d153c | 321 | dm_warn("%s: null device\n", __func__); |
e59f458d SG |
322 | return NULL; |
323 | } | |
324 | ||
325 | return dev->parent_priv; | |
326 | } | |
327 | ||
997c87bb SG |
328 | static int device_get_device_tail(struct udevice *dev, int ret, |
329 | struct udevice **devp) | |
330 | { | |
331 | if (ret) | |
332 | return ret; | |
333 | ||
334 | ret = device_probe(dev); | |
335 | if (ret) | |
336 | return ret; | |
337 | ||
338 | *devp = dev; | |
339 | ||
340 | return 0; | |
341 | } | |
342 | ||
343 | int device_get_child(struct udevice *parent, int index, struct udevice **devp) | |
344 | { | |
345 | struct udevice *dev; | |
346 | ||
347 | list_for_each_entry(dev, &parent->child_head, sibling_node) { | |
348 | if (!index--) | |
349 | return device_get_device_tail(dev, 0, devp); | |
350 | } | |
351 | ||
352 | return -ENODEV; | |
353 | } | |
354 | ||
355 | int device_find_child_by_seq(struct udevice *parent, int seq_or_req_seq, | |
356 | bool find_req_seq, struct udevice **devp) | |
357 | { | |
358 | struct udevice *dev; | |
359 | ||
360 | *devp = NULL; | |
361 | if (seq_or_req_seq == -1) | |
362 | return -ENODEV; | |
363 | ||
364 | list_for_each_entry(dev, &parent->child_head, sibling_node) { | |
365 | if ((find_req_seq ? dev->req_seq : dev->seq) == | |
366 | seq_or_req_seq) { | |
367 | *devp = dev; | |
368 | return 0; | |
369 | } | |
370 | } | |
371 | ||
372 | return -ENODEV; | |
373 | } | |
374 | ||
375 | int device_get_child_by_seq(struct udevice *parent, int seq, | |
376 | struct udevice **devp) | |
377 | { | |
378 | struct udevice *dev; | |
379 | int ret; | |
380 | ||
381 | *devp = NULL; | |
382 | ret = device_find_child_by_seq(parent, seq, false, &dev); | |
383 | if (ret == -ENODEV) { | |
384 | /* | |
385 | * We didn't find it in probed devices. See if there is one | |
386 | * that will request this seq if probed. | |
387 | */ | |
388 | ret = device_find_child_by_seq(parent, seq, true, &dev); | |
389 | } | |
390 | return device_get_device_tail(dev, ret, devp); | |
391 | } | |
392 | ||
393 | int device_find_child_by_of_offset(struct udevice *parent, int of_offset, | |
394 | struct udevice **devp) | |
395 | { | |
396 | struct udevice *dev; | |
397 | ||
398 | *devp = NULL; | |
399 | ||
400 | list_for_each_entry(dev, &parent->child_head, sibling_node) { | |
401 | if (dev->of_offset == of_offset) { | |
402 | *devp = dev; | |
403 | return 0; | |
404 | } | |
405 | } | |
406 | ||
407 | return -ENODEV; | |
408 | } | |
409 | ||
410 | int device_get_child_by_of_offset(struct udevice *parent, int seq, | |
411 | struct udevice **devp) | |
412 | { | |
413 | struct udevice *dev; | |
414 | int ret; | |
415 | ||
416 | *devp = NULL; | |
417 | ret = device_find_child_by_of_offset(parent, seq, &dev); | |
418 | return device_get_device_tail(dev, ret, devp); | |
419 | } | |
a8981d4f SG |
420 | |
421 | int device_find_first_child(struct udevice *parent, struct udevice **devp) | |
422 | { | |
423 | if (list_empty(&parent->child_head)) { | |
424 | *devp = NULL; | |
425 | } else { | |
426 | *devp = list_first_entry(&parent->child_head, struct udevice, | |
427 | sibling_node); | |
428 | } | |
429 | ||
430 | return 0; | |
431 | } | |
432 | ||
433 | int device_find_next_child(struct udevice **devp) | |
434 | { | |
435 | struct udevice *dev = *devp; | |
436 | struct udevice *parent = dev->parent; | |
437 | ||
438 | if (list_is_last(&dev->sibling_node, &parent->child_head)) { | |
439 | *devp = NULL; | |
440 | } else { | |
441 | *devp = list_entry(dev->sibling_node.next, struct udevice, | |
442 | sibling_node); | |
443 | } | |
444 | ||
445 | return 0; | |
446 | } | |
2ef249b4 | 447 | |
479728cb SG |
448 | struct udevice *dev_get_parent(struct udevice *child) |
449 | { | |
450 | return child->parent; | |
451 | } | |
452 | ||
2ef249b4 SG |
453 | ulong dev_get_of_data(struct udevice *dev) |
454 | { | |
455 | return dev->of_id->data; | |
456 | } | |
b3670531 SG |
457 | |
458 | enum uclass_id device_get_uclass_id(struct udevice *dev) | |
459 | { | |
460 | return dev->uclass->uc_drv->id; | |
461 | } | |
c9cac3f8 PF |
462 | |
463 | #ifdef CONFIG_OF_CONTROL | |
464 | fdt_addr_t dev_get_addr(struct udevice *dev) | |
465 | { | |
466 | return fdtdec_get_addr(gd->fdt_blob, dev->of_offset, "reg"); | |
467 | } | |
468 | #else | |
469 | fdt_addr_t dev_get_addr(struct udevice *dev) | |
470 | { | |
471 | return FDT_ADDR_T_NONE; | |
472 | } | |
473 | #endif |