Trivial white space fixes so that the next patches are easier to read.
[coreboot.git] / src / devices / device.c
1 /*
2  * This file is part of the coreboot project.
3  *
4  * It was originally based on the Linux kernel (arch/i386/kernel/pci-pc.c).
5  *
6  * Modifications are:
7  * Copyright (C) 2003 Eric Biederman <ebiederm@xmission.com>
8  * Copyright (C) 2003-2004 Linux Networx
9  * (Written by Eric Biederman <ebiederman@lnxi.com> for Linux Networx)
10  * Copyright (C) 2003 Ronald G. Minnich <rminnich@gmail.com>
11  * Copyright (C) 2004-2005 Li-Ta Lo <ollie@lanl.gov>
12  * Copyright (C) 2005-2006 Tyan
13  * (Written by Yinghai Lu <yhlu@tyan.com> for Tyan)
14  * Copyright (C) 2005-2006 Stefan Reinauer <stepan@openbios.org>
15  */
16
17 /*
18  *      (c) 1999--2000 Martin Mares <mj@suse.cz>
19  */
20 /* lots of mods by ron minnich (rminnich@lanl.gov), with
21  * the final architecture guidance from Tom Merritt (tjm@codegen.com)
22  * In particular, we changed from the one-pass original version to
23  * Tom's recommended multiple-pass version. I wasn't sure about doing
24  * it with multiple passes, until I actually started doing it and saw
25  * the wisdom of Tom's recommendations ...
26  *
27  * Lots of cleanups by Eric Biederman to handle bridges, and to
28  * handle resource allocation for non-pci devices.
29  */
30
31 #include <console/console.h>
32 #include <bitops.h>
33 #include <arch/io.h>
34 #include <device/device.h>
35 #include <device/pci.h>
36 #include <device/pci_ids.h>
37 #include <stdlib.h>
38 #include <string.h>
39 #include <smp/spinlock.h>
40
41 /** Linked list of ALL devices */
42 struct device *all_devices = &dev_root;
43 /** Pointer to the last device */
44 extern struct device **last_dev_p;
45
46 /** The upper limit of MEM resource of the devices.
47  * Reserve 20M for the system */
48 #define DEVICE_MEM_HIGH 0xFEBFFFFFUL
49 /** The lower limit of IO resource of the devices.
50  * Reserve 4k for ISA/Legacy devices */
51 #define DEVICE_IO_START 0x1000
52
53 /**
54  * @brief Allocate a new device structure.
55  *
56  * Allocte a new device structure and attached it to the device tree as a
57  * child of the parent bus.
58  *
59  * @param parent parent bus the newly created device attached to.
60  * @param path path to the device to be created.
61  *
62  * @return pointer to the newly created device structure.
63  *
64  * @see device_path
65  */
66 static spinlock_t dev_lock = SPIN_LOCK_UNLOCKED;
67 device_t alloc_dev(struct bus *parent, struct device_path *path)
68 {
69         device_t dev, child;
70         int link;
71
72         spin_lock(&dev_lock);
73
74         /* Find the last child of our parent */
75         for(child = parent->children; child && child->sibling; ) {
76                 child = child->sibling;
77         }
78
79         dev = malloc(sizeof(*dev));
80         if (dev == 0) {
81                 die("DEV: out of memory.\n");
82         }
83         memset(dev, 0, sizeof(*dev));
84         memcpy(&dev->path, path, sizeof(*path));
85
86         /* Initialize the back pointers in the link fields */
87         for(link = 0; link < MAX_LINKS; link++) {
88                 dev->link[link].dev  = dev;
89                 dev->link[link].link = link;
90         }
91
92         /* By default devices are enabled */
93         dev->enabled = 1;
94
95         /* Add the new device to the list of children of the bus. */
96         dev->bus = parent;
97         if (child) {
98                 child->sibling = dev;
99         } else {
100                 parent->children = dev;
101         }
102
103         /* Append a new device to the global device list.
104          * The list is used to find devices once everything is set up.
105          */
106         *last_dev_p = dev;
107         last_dev_p = &dev->next;
108
109         spin_unlock(&dev_lock);
110         return dev;
111 }
112
113 /**
114  * @brief round a number up to an alignment.
115  * @param val the starting value
116  * @param roundup Alignment as a power of two
117  * @returns rounded up number
118  */
119 static resource_t round(resource_t val, unsigned long pow)
120 {
121         resource_t mask;
122         mask = (1ULL << pow) - 1ULL;
123         val += mask;
124         val &= ~mask;
125         return val;
126 }
127
128 /** Read the resources on all devices of a given bus.
129  * @param bus bus to read the resources on.
130  */
131 static void read_resources(struct bus *bus)
132 {
133         struct device *curdev;
134
135         printk_spew("%s read_resources bus %d link: %d\n",
136                 dev_path(bus->dev), bus->secondary, bus->link);
137
138         /* Walk through all of the devices and find which resources they need. */
139         for(curdev = bus->children; curdev; curdev = curdev->sibling) {
140                 unsigned links;
141                 int i;
142                 if (curdev->have_resources) {
143                         continue;
144                 }
145                 if (!curdev->enabled) {
146                         continue;
147                 }
148                 if (!curdev->ops || !curdev->ops->read_resources) {
149                         printk_err("%s missing read_resources\n",
150                                 dev_path(curdev));
151                         continue;
152                 }
153                 curdev->ops->read_resources(curdev);
154                 curdev->have_resources = 1;
155                 /* Read in subtractive resources behind the current device */
156                 links = 0;
157                 for(i = 0; i < curdev->resources; i++) {
158                         struct resource *resource;
159                         unsigned link;
160                         resource = &curdev->resource[i];
161                         if (!(resource->flags & IORESOURCE_SUBTRACTIVE))
162                                 continue;
163                         link = IOINDEX_SUBTRACTIVE_LINK(resource->index);
164                         if (link > MAX_LINKS) {
165                                 printk_err("%s subtractive index on link: %d\n",
166                                         dev_path(curdev), link);
167                                 continue;
168                         }
169                         if (!(links & (1 << link))) {
170                                 links |= (1 << link);
171                                 read_resources(&curdev->link[link]);
172                         }
173                 }
174         }
175         printk_spew("%s read_resources bus %d link: %d done\n",
176                 dev_path(bus->dev), bus->secondary, bus->link);
177 }
178
179 struct pick_largest_state {
180         struct resource *last;
181         struct device   *result_dev;
182         struct resource *result;
183         int seen_last;
184 };
185
186 static void pick_largest_resource(void *gp,
187         struct device *dev, struct resource *resource)
188 {
189         struct pick_largest_state *state = gp;
190         struct resource *last;
191         last = state->last;
192         /* Be certain to pick the successor to last */
193         if (resource == last) {
194                 state->seen_last = 1;
195                 return;
196         }
197         if (resource->flags & IORESOURCE_FIXED)
198                 return;         // Skip it.
199         if (last && ((last->align < resource->align) ||
200                      ((last->align == resource->align) &&
201                       (last->size < resource->size)) ||
202                      ((last->align == resource->align) &&
203                       (last->size == resource->size) && (!state->seen_last)))) {
204                 return;
205         }
206         if (!state->result ||
207             (state->result->align < resource->align) ||
208             ((state->result->align == resource->align) &&
209              (state->result->size < resource->size)))
210         {
211                 state->result_dev = dev;
212                 state->result = resource;
213         }
214 }
215
216 static struct device *largest_resource(struct bus *bus, struct resource **result_res,
217         unsigned long type_mask, unsigned long type)
218 {
219         struct pick_largest_state state;
220
221         state.last = *result_res;
222         state.result_dev = 0;
223         state.result = 0;
224         state.seen_last = 0;
225
226         search_bus_resources(bus, type_mask, type, pick_largest_resource,
227                              &state);
228
229         *result_res = state.result;
230         return state.result_dev;
231 }
232
233 /* Compute allocate resources is the guts of the resource allocator.
234  *
235  * The problem.
236  *  - Allocate resources locations for every device.
237  *  - Don't overlap, and follow the rules of bridges.
238  *  - Don't overlap with resources in fixed locations.
239  *  - Be efficient so we don't have ugly strategies.
240  *
241  * The strategy.
242  * - Devices that have fixed addresses are the minority so don't
243  *   worry about them too much.  Instead only use part of the address
244  *   space for devices with programmable addresses.  This easily handles
245  *   everything except bridges.
246  *
247  * - PCI devices are required to have thier sizes and their alignments
248  *   equal.  In this case an optimal solution to the packing problem
249  *   exists.  Allocate all devices from highest alignment to least
250  *   alignment or vice versa.  Use this.
251  *
252  * - So we can handle more than PCI run two allocation passes on
253  *   bridges.  The first to see how large the resources are behind
254  *   the bridge, and what their alignment requirements are.  The
255  *   second to assign a safe address to the devices behind the
256  *   bridge.  This allows me to treat a bridge as just a device with
257  *   a couple of resources, and not need to special case it in the
258  *   allocator.  Also this allows handling of other types of bridges.
259  *
260  */
261
262 void compute_allocate_resource(
263         struct bus *bus,
264         struct resource *bridge,
265         unsigned long type_mask,
266         unsigned long type)
267 {
268         struct device *dev;
269         struct resource *resource;
270         resource_t base;
271         unsigned long align, min_align;
272         min_align = 0;
273         base = bridge->base;
274
275         printk_spew("%s compute_allocate_resource %s: base: %08Lx size: %08Lx align: %d gran: %d\n",
276                 dev_path(bus->dev),
277                 (bridge->flags & IORESOURCE_IO)? "io":
278                 (bridge->flags & IORESOURCE_PREFETCH)? "prefmem" : "mem",
279                 base, bridge->size, bridge->align, bridge->gran);
280
281         /* We want different minimum alignments for different kinds of
282          * resources.  These minimums are not device type specific
283          * but resource type specific.
284          */
285         if (bridge->flags & IORESOURCE_IO) {
286                 min_align = log2(DEVICE_IO_ALIGN);
287         }
288         if (bridge->flags & IORESOURCE_MEM) {
289                 min_align = log2(DEVICE_MEM_ALIGN);
290         }
291
292         /* Make certain I have read in all of the resources */
293         read_resources(bus);
294
295         /* Remember I haven't found anything yet. */
296         resource = 0;
297
298         /* Walk through all the devices on the current bus and
299          * compute the addresses.
300          */
301         while((dev = largest_resource(bus, &resource, type_mask, type))) {
302                 resource_t size;
303                 /* Do NOT I repeat do not ignore resources which have zero size.
304                  * If they need to be ignored dev->read_resources should not even
305                  * return them.   Some resources must be set even when they have
306                  * no size.  PCI bridge resources are a good example of this.
307                  */
308                 /* Make certain we are dealing with a good minimum size */
309                 size = resource->size;
310                 align = resource->align;
311                 if (align < min_align) {
312                         align = min_align;
313                 }
314
315                 /* Propagate the resource alignment to the bridge register  */
316                 if (align > bridge->align) {
317                         bridge->align = align;
318                 }
319
320                 if (resource->flags & IORESOURCE_FIXED) {
321                         continue;
322                 }
323
324                 /* Propogate the resource limit to the bridge register */
325                 if (bridge->limit > resource->limit) {
326                         bridge->limit = resource->limit;
327                 }
328 #warning This heuristic should be replaced by real devices with fixed resources.
329                 /* Artificially deny limits between DEVICE_MEM_HIGH and 0xffffffff */
330                 if ((bridge->limit > DEVICE_MEM_HIGH) && (bridge->limit <= 0xffffffff)) {
331                         bridge->limit = DEVICE_MEM_HIGH;
332                 }
333
334                 if (resource->flags & IORESOURCE_IO) {
335                         /* Don't allow potential aliases over the
336                          * legacy pci expansion card addresses.
337                          * The legacy pci decodes only 10 bits,
338                          * uses 100h - 3ffh. Therefor, only 0 - ff
339                          * can be used out of each 400h block of io
340                          * space.
341                          */
342                         if ((base & 0x300) != 0) {
343                                 base = (base & ~0x3ff) + 0x400;
344                         }
345                         /* Don't allow allocations in the VGA IO range.
346                          * PCI has special cases for that.
347                          */
348                         else if ((base >= 0x3b0) && (base <= 0x3df)) {
349                                 base = 0x3e0;
350                         }
351                 }
352                 if (((round(base, align) + size) -1) <= resource->limit) {
353                         /* base must be aligned to size */
354                         base = round(base, align);
355                         resource->base = base;
356                         resource->flags |= IORESOURCE_ASSIGNED;
357                         resource->flags &= ~IORESOURCE_STORED;
358                         base += size;
359
360                         printk_spew("%s %02lx *  [0x%08Lx - 0x%08Lx] %s\n",
361                                 dev_path(dev),
362                                 resource->index,
363                                 resource->base,
364                                 resource->base + resource->size - 1,
365                                 (resource->flags & IORESOURCE_IO)? "io":
366                                 (resource->flags & IORESOURCE_PREFETCH)? "prefmem": "mem");
367                 }
368 #if CONFIG_PCIE_CONFIGSPACE_HOLE
369 #warning Handle PCIe hole differently...
370                 if (base >= 0xf0000000 && base < 0xf4000000) {
371                         base = 0xf4000000;
372                 }
373 #endif
374         }
375         /* A pci bridge resource does not need to be a power
376          * of two size, but it does have a minimum granularity.
377          * Round the size up to that minimum granularity so we
378          * know not to place something else at an address postitively
379          * decoded by the bridge.
380          */
381         bridge->size = round(base, bridge->gran) - bridge->base;
382
383         printk_spew("%s compute_allocate_resource %s: base: %08Lx size: %08Lx align: %d gran: %d done\n",
384                     dev_path(bus->dev),
385                     (bridge->flags & IORESOURCE_IO)? "io":
386                      (bridge->flags & IORESOURCE_PREFETCH)? "prefmem" : "mem",
387                     base, bridge->size, bridge->align, bridge->gran);
388 }
389
390 #if CONFIG_CONSOLE_VGA == 1
391 device_t vga_pri = 0;
392 static void allocate_vga_resource(void)
393 {
394 #warning "FIXME modify allocate_vga_resource so it is less pci centric!"
395 #warning "This function knows to much about PCI stuff, it should be just a ietrator/visitor."
396
397         /* FIXME handle the VGA pallette snooping */
398         struct device *dev, *vga, *vga_onboard, *vga_first, *vga_last;
399         struct bus *bus;
400         bus = 0;
401         vga = 0;
402         vga_onboard = 0;
403         vga_first = 0;
404         vga_last = 0;
405         for(dev = all_devices; dev; dev = dev->next) {
406                 if (!dev->enabled) continue;
407                 if (((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY) &&
408                         ((dev->class >> 8) != PCI_CLASS_DISPLAY_OTHER))
409                 {
410                         if (!vga_first) {
411                                 if (dev->on_mainboard) {
412                                         vga_onboard = dev;
413                                 } else {
414                                         vga_first = dev;
415                                 }
416                         } else {
417                                 if (dev->on_mainboard) {
418                                         vga_onboard = dev;
419                                 } else {
420                                         vga_last = dev;
421                                 }
422                         }
423
424                         /* It isn't safe to enable other VGA cards */
425                         dev->command &= ~(PCI_COMMAND_MEMORY | PCI_COMMAND_IO);
426                 }
427         }
428
429         vga = vga_last;
430
431         if(!vga) {
432                 vga = vga_first;
433         }
434
435 #if CONFIG_CONSOLE_VGA_ONBOARD_AT_FIRST == 1
436         if (vga_onboard) // will use on board vga as pri
437 #else
438         if (!vga) // will use last add on adapter as pri
439 #endif
440         {
441                 vga = vga_onboard;
442         }
443
444
445         if (vga) {
446                 /* vga is first add on card or the only onboard vga */
447                 printk_debug("Allocating VGA resource %s\n", dev_path(vga));
448                 /* All legacy VGA cards have MEM & I/O space registers */
449                 vga->command |= (PCI_COMMAND_MEMORY | PCI_COMMAND_IO);
450                 vga_pri = vga;
451                 bus = vga->bus;
452         }
453         /* Now walk up the bridges setting the VGA enable */
454         while(bus) {
455                 printk_debug("Setting PCI_BRIDGE_CTL_VGA for bridge %s\n",
456                              dev_path(bus->dev));
457                 bus->bridge_ctrl |= PCI_BRIDGE_CTL_VGA;
458                 bus = (bus == bus->dev->bus)? 0 : bus->dev->bus;
459         }
460 }
461
462 #endif
463
464
465 /**
466  * @brief  Assign the computed resources to the devices on the bus.
467  *
468  * @param bus Pointer to the structure for this bus
469  *
470  * Use the device specific set_resources method to store the computed
471  * resources to hardware. For bridge devices, the set_resources() method
472  * has to recurse into every down stream buses.
473  *
474  * Mutual recursion:
475  *      assign_resources() -> device_operation::set_resources()
476  *      device_operation::set_resources() -> assign_resources()
477  */
478 void assign_resources(struct bus *bus)
479 {
480         struct device *curdev;
481
482         printk_spew("%s assign_resources, bus %d link: %d\n",
483                 dev_path(bus->dev), bus->secondary, bus->link);
484
485         for(curdev = bus->children; curdev; curdev = curdev->sibling) {
486                 if (!curdev->enabled || !curdev->resources) {
487                         continue;
488                 }
489                 if (!curdev->ops || !curdev->ops->set_resources) {
490                         printk_err("%s missing set_resources\n",
491                                 dev_path(curdev));
492                         continue;
493                 }
494                 curdev->ops->set_resources(curdev);
495         }
496         printk_spew("%s assign_resources, bus %d link: %d\n",
497                 dev_path(bus->dev), bus->secondary, bus->link);
498 }
499
500 /**
501  * @brief Enable the resources for a specific device
502  *
503  * @param dev the device whose resources are to be enabled
504  *
505  * Enable resources of the device by calling the device specific
506  * enable_resources() method.
507  *
508  * The parent's resources should be enabled first to avoid having enabling
509  * order problem. This is done by calling the parent's enable_resources()
510  * method and let that method to call it's children's enable_resoruces()
511  * method via the (global) enable_childrens_resources().
512  *
513  * Indirect mutual recursion:
514  *      enable_resources() -> device_operations::enable_resource()
515  *      device_operations::enable_resource() -> enable_children_resources()
516  *      enable_children_resources() -> enable_resources()
517  */
518 void enable_resources(struct device *dev)
519 {
520         if (!dev->enabled) {
521                 return;
522         }
523         if (!dev->ops || !dev->ops->enable_resources) {
524                 printk_err("%s missing enable_resources\n", dev_path(dev));
525                 return;
526         }
527         dev->ops->enable_resources(dev);
528 }
529
530 /**
531  * @brief Reset all of the devices a bus
532  *
533  * Reset all of the devices on a bus and clear the bus's reset_needed flag.
534  *
535  * @param bus pointer to the bus structure
536  *
537  * @return 1 if the bus was successfully reset, 0 otherwise.
538  *
539  */
540 int reset_bus(struct bus *bus)
541 {
542         if (bus && bus->dev && bus->dev->ops && bus->dev->ops->reset_bus)
543         {
544                 bus->dev->ops->reset_bus(bus);
545                 bus->reset_needed = 0;
546                 return 1;
547         }
548         return 0;
549 }
550
551 /**
552  * @brief Scan for devices on a bus.
553  *
554  * If there are bridges on the bus, recursively scan the buses behind the bridges.
555  * If the setting up and tuning of the bus causes a reset to be required,
556  * reset the bus and scan it again.
557  *
558  * @param bus pointer to the bus device
559  * @param max current bus number
560  *
561  * @return The maximum bus number found, after scanning all subordinate busses
562  */
563 unsigned int scan_bus(device_t bus, unsigned int max)
564 {
565         unsigned int new_max;
566         int do_scan_bus;
567         if (    !bus ||
568                 !bus->enabled ||
569                 !bus->ops ||
570                 !bus->ops->scan_bus)
571         {
572                 return max;
573         }
574         do_scan_bus = 1;
575         while(do_scan_bus) {
576                 int link;
577                 new_max = bus->ops->scan_bus(bus, max);
578                 do_scan_bus = 0;
579                 for(link = 0; link < bus->links; link++) {
580                         if (bus->link[link].reset_needed) {
581                                 if (reset_bus(&bus->link[link])) {
582                                         do_scan_bus = 1;
583                                 } else {
584                                         bus->bus->reset_needed = 1;
585                                 }
586                         }
587                 }
588         }
589         return new_max;
590 }
591
592
593 /**
594  * @brief Determine the existence of devices and extend the device tree.
595  *
596  * Most of the devices in the system are listed in the mainboard Config.lb
597  * file. The device structures for these devices are generated at compile
598  * time by the config tool and are organized into the device tree. This
599  * function determines if the devices created at compile time actually exist
600  * in the physical system.
601  *
602  * For devices in the physical system but not listed in the Config.lb file,
603  * the device structures have to be created at run time and attached to the
604  * device tree.
605  *
606  * This function starts from the root device 'dev_root', scan the buses in
607  * the system recursively, modify the device tree according to the result of
608  * the probe.
609  *
610  * This function has no idea how to scan and probe buses and devices at all.
611  * It depends on the bus/device specific scan_bus() method to do it. The
612  * scan_bus() method also has to create the device structure and attach
613  * it to the device tree.
614  */
615 void dev_enumerate(void)
616 {
617         struct device *root;
618         unsigned subordinate;
619         printk_info("Enumerating buses...\n");
620         root = &dev_root;
621         if (root->chip_ops && root->chip_ops->enable_dev) {
622                 root->chip_ops->enable_dev(root);
623         }
624         if (!root->ops || !root->ops->scan_bus) {
625                 printk_err("dev_root missing scan_bus operation");
626                 return;
627         }
628         subordinate = scan_bus(root, 0);
629         printk_info("done\n");
630 }
631
632 /**
633  * @brief Configure devices on the devices tree.
634  *
635  * Starting at the root of the device tree, travel it recursively in two
636  * passes. In the first pass, we compute and allocate resources (ranges)
637  * requried by each device. In the second pass, the resources ranges are
638  * relocated to their final position and stored to the hardware.
639  *
640  * I/O resources start at DEVICE_IO_START and grow upward. MEM resources start
641  * at DEVICE_MEM_HIGH and grow downward.
642  *
643  * Since the assignment is hierarchical we set the values into the dev_root
644  * struct.
645  */
646 void dev_configure(void)
647 {
648         struct resource *io, *mem;
649         struct device *root;
650
651         printk_info("Allocating resources...\n");
652
653         root = &dev_root;
654         if (!root->ops || !root->ops->read_resources) {
655                 printk_err("dev_root missing read_resources\n");
656                 return;
657         }
658         if (!root->ops || !root->ops->set_resources) {
659                 printk_err("dev_root missing set_resources\n");
660                 return;
661         }
662
663         printk_info("Reading resources...\n");
664         root->ops->read_resources(root);
665         printk_info("Done reading resources.\n");
666
667         /* Get the resources */
668         io  = &root->resource[0];
669         mem = &root->resource[1];
670         /* Make certain the io devices are allocated somewhere safe. */
671         io->base = DEVICE_IO_START;
672         io->flags |= IORESOURCE_ASSIGNED;
673         io->flags &= ~IORESOURCE_STORED;
674         /* Now reallocate the pci resources memory with the
675          * highest addresses I can manage.
676          */
677         mem->base = resource_max(&root->resource[1]);
678         mem->flags |= IORESOURCE_ASSIGNED;
679         mem->flags &= ~IORESOURCE_STORED;
680
681 #if CONFIG_CONSOLE_VGA == 1
682         /* Allocate the VGA I/O resource.. */
683         allocate_vga_resource();
684 #endif
685
686         /* Store the computed resource allocations into device registers ... */
687         printk_info("Setting resources...\n");
688         root->ops->set_resources(root);
689         printk_info("Done setting resources.\n");
690 #if 0
691         mem->flags |= IORESOURCE_STORED;
692         report_resource_stored(root, mem, "");
693 #endif
694
695         printk_info("Done allocating resources.\n");
696 }
697
698 /**
699  * @brief Enable devices on the device tree.
700  *
701  * Starting at the root, walk the tree and enable all devices/bridges by
702  * calling the device's enable_resources() method.
703  */
704 void dev_enable(void)
705 {
706         printk_info("Enabling resources...\n");
707
708         /* now enable everything. */
709         enable_resources(&dev_root);
710
711         printk_info("done.\n");
712 }
713
714 /**
715  * @brief Initialize all devices in the global device list.
716  *
717  * Starting at the first device on the global device link list,
718  * walk the list and call the device's init() method to do deivce
719  * specific setup.
720  */
721 void dev_initialize(void)
722 {
723         struct device *dev;
724
725         printk_info("Initializing devices...\n");
726         for(dev = all_devices; dev; dev = dev->next) {
727                 if (dev->enabled && !dev->initialized &&
728                         dev->ops && dev->ops->init)
729                 {
730                         if (dev->path.type == DEVICE_PATH_I2C) {
731                                 printk_debug("smbus: %s[%d]->",
732                                         dev_path(dev->bus->dev), dev->bus->link);
733                         }
734                         printk_debug("%s init\n", dev_path(dev));
735                         dev->initialized = 1;
736                         dev->ops->init(dev);
737                 }
738         }
739         printk_info("Devices initialized\n");
740 }
741