]> Git Repo - J-u-boot.git/blame - drivers/core/device.c
dm: core: Add dev_get_uclass_priv() to access uclass private data
[J-u-boot.git] / drivers / core / device.c
CommitLineData
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
25DECLARE_GLOBAL_DATA_PTR;
26
54c5d08a
HS
27int 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
124fail_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 130fail_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 }
135fail_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 }
141fail_alloc2:
f8a85449
SG
142 if (dev->flags & DM_FLAG_ALLOC_PDATA) {
143 free(dev->platdata);
144 dev->platdata = NULL;
145 }
146fail_alloc1:
6494d708 147 free(dev);
72ebfe86 148
6494d708
SG
149 return ret;
150}
151
00606d7e
SG
152int 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 167int 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;
261fail_uclass:
262 if (device_remove(dev)) {
263 dm_warn("%s: Device '%s' failed to remove on error path\n",
264 __func__, dev->name);
265 }
266fail:
5a66a8ff 267 dev->seq = -1;
6494d708
SG
268 device_free(dev);
269
270 return ret;
271}
272
accd4b19
SG
273int device_probe(struct udevice *dev)
274{
275 return device_probe_child(dev, NULL);
276}
277
54c5d08a 278void *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
288void *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 298void *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
308void *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
318void *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
328static 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
343int 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
355int 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
375int 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
393int 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
410int 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
421int 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
433int 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
448struct udevice *dev_get_parent(struct udevice *child)
449{
450 return child->parent;
451}
452
2ef249b4
SG
453ulong dev_get_of_data(struct udevice *dev)
454{
455 return dev->of_id->data;
456}
b3670531
SG
457
458enum 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
464fdt_addr_t dev_get_addr(struct udevice *dev)
465{
466 return fdtdec_get_addr(gd->fdt_blob, dev->of_offset, "reg");
467}
468#else
469fdt_addr_t dev_get_addr(struct udevice *dev)
470{
471 return FDT_ADDR_T_NONE;
472}
473#endif
This page took 0.148657 seconds and 4 git commands to generate.