drop unused variable (trivial)
[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  * Copyright (C) 2009 Myles Watson <mylesgw@gmail.com>
16  */
17
18 /*
19  *      (c) 1999--2000 Martin Mares <mj@suse.cz>
20  */
21 /* lots of mods by ron minnich (rminnich@lanl.gov), with
22  * the final architecture guidance from Tom Merritt (tjm@codegen.com)
23  * In particular, we changed from the one-pass original version to
24  * Tom's recommended multiple-pass version. I wasn't sure about doing
25  * it with multiple passes, until I actually started doing it and saw
26  * the wisdom of Tom's recommendations ...
27  *
28  * Lots of cleanups by Eric Biederman to handle bridges, and to
29  * handle resource allocation for non-pci devices.
30  */
31
32 #include <console/console.h>
33 #include <bitops.h>
34 #include <arch/io.h>
35 #include <device/device.h>
36 #include <device/pci.h>
37 #include <device/pci_ids.h>
38 #include <stdlib.h>
39 #include <string.h>
40 #include <smp/spinlock.h>
41
42 /** Linked list of ALL devices */
43 struct device *all_devices = &dev_root;
44 /** Pointer to the last device */
45 extern struct device **last_dev_p;
46
47
48 /**
49  * @brief Allocate a new device structure.
50  *
51  * Allocte a new device structure and attached it to the device tree as a
52  * child of the parent bus.
53  *
54  * @param parent parent bus the newly created device attached to.
55  * @param path path to the device to be created.
56  *
57  * @return pointer to the newly created device structure.
58  *
59  * @see device_path
60  */
61 static spinlock_t dev_lock = SPIN_LOCK_UNLOCKED;
62 device_t alloc_dev(struct bus *parent, struct device_path *path)
63 {
64         device_t dev, child;
65         int link;
66
67         spin_lock(&dev_lock);
68
69         /* Find the last child of our parent. */
70         for (child = parent->children; child && child->sibling; /* */ ) {
71                 child = child->sibling;
72         }
73
74         dev = malloc(sizeof(*dev));
75         if (dev == 0)
76                 die("DEV: out of memory.\n");
77
78         memset(dev, 0, sizeof(*dev));
79         memcpy(&dev->path, path, sizeof(*path));
80
81         /* Initialize the back pointers in the link fields. */
82         for (link = 0; link < MAX_LINKS; link++) {
83                 dev->link[link].dev = dev;
84                 dev->link[link].link = link;
85         }
86
87         /* By default devices are enabled. */
88         dev->enabled = 1;
89
90         /* Add the new device to the list of children of the bus. */
91         dev->bus = parent;
92         if (child) {
93                 child->sibling = dev;
94         } else {
95                 parent->children = dev;
96         }
97
98         /* Append a new device to the global device list.
99          * The list is used to find devices once everything is set up.
100          */
101         *last_dev_p = dev;
102         last_dev_p = &dev->next;
103
104         spin_unlock(&dev_lock);
105         return dev;
106 }
107
108 /**
109  * @brief round a number up to an alignment.
110  * @param val the starting value
111  * @param roundup Alignment as a power of two
112  * @returns rounded up number
113  */
114 static resource_t round(resource_t val, unsigned long pow)
115 {
116         resource_t mask;
117         mask = (1ULL << pow) - 1ULL;
118         val += mask;
119         val &= ~mask;
120         return val;
121 }
122
123 /** Read the resources on all devices of a given bus.
124  * @param bus bus to read the resources on.
125  */
126 static void read_resources(struct bus *bus)
127 {
128         struct device *curdev;
129
130         printk_spew("%s %s bus %x link: %d\n", dev_path(bus->dev), __func__,
131                     bus->secondary, bus->link);
132
133         /* Walk through all devices and find which resources they need. */
134         for (curdev = bus->children; curdev; curdev = curdev->sibling) {
135                 int i;
136                 if (!curdev->enabled) {
137                         continue;
138                 }
139                 if (!curdev->ops || !curdev->ops->read_resources) {
140                         printk_err("%s missing read_resources\n",
141                                    dev_path(curdev));
142                         continue;
143                 }
144                 curdev->ops->read_resources(curdev);
145
146                 /* Read in the resources behind the current device's links. */
147                 for (i = 0; i < curdev->links; i++)
148                         read_resources(&curdev->link[i]);
149         }
150         printk_spew("%s read_resources bus %d link: %d done\n",
151                     dev_path(bus->dev), bus->secondary, bus->link);
152 }
153
154 struct pick_largest_state {
155         struct resource *last;
156         struct device *result_dev;
157         struct resource *result;
158         int seen_last;
159 };
160
161 static void pick_largest_resource(void *gp, struct device *dev,
162                                   struct resource *resource)
163 {
164         struct pick_largest_state *state = gp;
165         struct resource *last;
166
167         last = state->last;
168
169         /* Be certain to pick the successor to last. */
170         if (resource == last) {
171                 state->seen_last = 1;
172                 return;
173         }
174         if (resource->flags & IORESOURCE_FIXED)
175                 return;         // Skip it.
176         if (last && ((last->align < resource->align) ||
177                      ((last->align == resource->align) &&
178                       (last->size < resource->size)) ||
179                      ((last->align == resource->align) &&
180                       (last->size == resource->size) && (!state->seen_last)))) {
181                 return;
182         }
183         if (!state->result ||
184             (state->result->align < resource->align) ||
185             ((state->result->align == resource->align) &&
186              (state->result->size < resource->size))) {
187                 state->result_dev = dev;
188                 state->result = resource;
189         }
190 }
191
192 static struct device *largest_resource(struct bus *bus,
193                                        struct resource **result_res,
194                                        unsigned long type_mask,
195                                        unsigned long type)
196 {
197         struct pick_largest_state state;
198
199         state.last = *result_res;
200         state.result_dev = NULL;
201         state.result = NULL;
202         state.seen_last = 0;
203
204         search_bus_resources(bus, type_mask, type, pick_largest_resource,
205                              &state);
206
207         *result_res = state.result;
208         return state.result_dev;
209 }
210
211 /* Compute allocate resources is the guts of the resource allocator.
212  *
213  * The problem.
214  *  - Allocate resource locations for every device.
215  *  - Don't overlap, and follow the rules of bridges.
216  *  - Don't overlap with resources in fixed locations.
217  *  - Be efficient so we don't have ugly strategies.
218  *
219  * The strategy.
220  * - Devices that have fixed addresses are the minority so don't
221  *   worry about them too much. Instead only use part of the address
222  *   space for devices with programmable addresses. This easily handles
223  *   everything except bridges.
224  *
225  * - PCI devices are required to have their sizes and their alignments
226  *   equal. In this case an optimal solution to the packing problem
227  *   exists. Allocate all devices from highest alignment to least
228  *   alignment or vice versa. Use this.
229  *
230  * - So we can handle more than PCI run two allocation passes on bridges. The
231  *   first to see how large the resources are behind the bridge, and what
232  *   their alignment requirements are. The second to assign a safe address to
233  *   the devices behind the bridge. This allows us to treat a bridge as just
234  *   a device with a couple of resources, and not need to special case it in
235  *   the allocator. Also this allows handling of other types of bridges.
236  *
237  */
238 void compute_resources(struct bus *bus, struct resource *bridge,
239                        unsigned long type_mask, unsigned long type)
240 {
241         struct device *dev;
242         struct resource *resource;
243         resource_t base;
244         base = round(bridge->base, bridge->align);
245
246         printk_spew( "%s %s_%s: base: %llx size: %llx align: %d gran: %d limit: %llx\n",
247                dev_path(bus->dev), __func__,
248                (type & IORESOURCE_IO) ? "io" : (type & IORESOURCE_PREFETCH) ?
249                "prefmem" : "mem",
250                base, bridge->size, bridge->align, bridge->gran, bridge->limit);
251
252         /* For each child which is a bridge, compute_resource_needs. */
253         for (dev = bus->children; dev; dev = dev->sibling) {
254                 unsigned i;
255                 struct resource *child_bridge;
256
257                 if (!dev->links)
258                         continue;
259
260                 /* Find the resources with matching type flags. */
261                 for (i = 0; i < dev->resources; i++) {
262                         unsigned link;
263                         child_bridge = &dev->resource[i];
264
265                         if (!(child_bridge->flags & IORESOURCE_BRIDGE) ||
266                             (child_bridge->flags & type_mask) != type)
267                                 continue;
268
269                         /* Split prefetchable memory if combined.  Many domains
270                          * use the same address space for prefetchable memory
271                          * and non-prefetchable memory.  Bridges below them
272                          * need it separated.  Add the PREFETCH flag to the
273                          * type_mask and type.
274                          */
275                         link = IOINDEX_LINK(child_bridge->index);
276                         compute_resources(&dev->link[link], child_bridge,
277                                           type_mask | IORESOURCE_PREFETCH,
278                                           type | (child_bridge->flags &
279                                                   IORESOURCE_PREFETCH));
280                 }
281         }
282
283         /* Remember we haven't found anything yet. */
284         resource = NULL;
285
286         /* Walk through all the resources on the current bus and compute the
287          * amount of address space taken by them.  Take granularity and
288          * alignment into account.
289          */
290         while ((dev = largest_resource(bus, &resource, type_mask, type))) {
291
292                 /* Size 0 resources can be skipped. */
293                 if (!resource->size) {
294                         continue;
295                 }
296
297                 /* Propagate the resource alignment to the bridge resource. */
298                 if (resource->align > bridge->align) {
299                         bridge->align = resource->align;
300                 }
301
302                 /* Propagate the resource limit to the bridge register. */
303                 if (bridge->limit > resource->limit) {
304                         bridge->limit = resource->limit;
305                 }
306
307                 /* Warn if it looks like APICs aren't declared. */
308                 if ((resource->limit == 0xffffffff) &&
309                     (resource->flags & IORESOURCE_ASSIGNED)) {
310                         printk_err("Resource limit looks wrong! (no APIC?)\n");
311                         printk_err("%s %02lx limit %08Lx\n", dev_path(dev),
312                                    resource->index, resource->limit);
313                 }
314
315                 if (resource->flags & IORESOURCE_IO) {
316                         /* Don't allow potential aliases over the legacy PCI
317                          * expansion card addresses. The legacy PCI decodes
318                          * only 10 bits, uses 0x100 - 0x3ff. Therefore, only
319                          * 0x00 - 0xff can be used out of each 0x400 block of
320                          * I/O space.
321                          */
322                         if ((base & 0x300) != 0) {
323                                 base = (base & ~0x3ff) + 0x400;
324                         }
325                         /* Don't allow allocations in the VGA I/O range.
326                          * PCI has special cases for that.
327                          */
328                         else if ((base >= 0x3b0) && (base <= 0x3df)) {
329                                 base = 0x3e0;
330                         }
331                 }
332                 /* Base must be aligned. */
333                 base = round(base, resource->align);
334                 resource->base = base;
335                 base += resource->size;
336
337                 printk_spew("%s %02lx *  [0x%llx - 0x%llx] %s\n",
338                             dev_path(dev), resource->index,
339                             resource->base,
340                             resource->base + resource->size - 1,
341                             (resource->flags & IORESOURCE_IO) ? "io" :
342                             (resource->flags & IORESOURCE_PREFETCH) ?
343                              "prefmem" : "mem");
344         }
345         /* A pci bridge resource does not need to be a power
346          * of two size, but it does have a minimum granularity.
347          * Round the size up to that minimum granularity so we
348          * know not to place something else at an address postitively
349          * decoded by the bridge.
350          */
351         bridge->size = round(base, bridge->gran) -
352                        round(bridge->base, bridge->align);
353
354         printk_spew("%s %s_%s: base: %llx size: %llx align: %d gran: %d limit: %llx done\n",
355                     dev_path(bus->dev), __func__,
356                     (bridge->flags & IORESOURCE_IO) ? "io" :
357                      (bridge->flags & IORESOURCE_PREFETCH) ?  "prefmem" : "mem",
358                     base, bridge->size, bridge->align, bridge->gran, bridge->limit);
359 }
360
361 /**
362  * This function is the second part of the resource allocator.
363  *
364  * The problem.
365  *  - Allocate resource locations for every device.
366  *  - Don't overlap, and follow the rules of bridges.
367  *  - Don't overlap with resources in fixed locations.
368  *  - Be efficient so we don't have ugly strategies.
369  *
370  * The strategy.
371  * - Devices that have fixed addresses are the minority so don't
372  *   worry about them too much. Instead only use part of the address
373  *   space for devices with programmable addresses. This easily handles
374  *   everything except bridges.
375  *
376  * - PCI devices are required to have their sizes and their alignments
377  *   equal. In this case an optimal solution to the packing problem
378  *   exists. Allocate all devices from highest alignment to least
379  *   alignment or vice versa. Use this.
380  *
381  * - So we can handle more than PCI run two allocation passes on bridges. The
382  *   first to see how large the resources are behind the bridge, and what
383  *   their alignment requirements are. The second to assign a safe address to
384  *   the devices behind the bridge. This allows us to treat a bridge as just
385  *   a device with a couple of resources, and not need to special case it in
386  *   the allocator. Also this allows handling of other types of bridges.
387  *
388  * - This function assigns the resources a value.
389  *
390  * @param bus The bus we are traversing.
391  * @param bridge The bridge resource which must contain the bus' resources.
392  * @param type_mask This value gets anded with the resource type.
393  * @param type This value must match the result of the and.
394  */
395 void allocate_resources(struct bus *bus, struct resource *bridge,
396                         unsigned long type_mask, unsigned long type)
397 {
398         struct device *dev;
399         struct resource *resource;
400         resource_t base;
401         base = bridge->base;
402
403         printk_spew("%s %s_%s: base:%llx size:%llx align:%d gran:%d limit:%llx\n",
404                dev_path(bus->dev), __func__,
405                (type & IORESOURCE_IO) ? "io" : (type & IORESOURCE_PREFETCH) ?
406                "prefmem" : "mem",
407                base, bridge->size, bridge->align, bridge->gran, bridge->limit);
408
409         /* Remember we haven't found anything yet. */
410         resource = NULL;
411
412         /* Walk through all the resources on the current bus and allocate them
413          * address space.
414          */
415         while ((dev = largest_resource(bus, &resource, type_mask, type))) {
416
417                 /* Propagate the bridge limit to the resource register. */
418                 if (resource->limit > bridge->limit) {
419                         resource->limit = bridge->limit;
420                 }
421
422                 /* Size 0 resources can be skipped. */
423                 if (!resource->size) {
424                         /* Set the base to limit so it doesn't confuse tolm. */
425                         resource->base = resource->limit;
426                         resource->flags |= IORESOURCE_ASSIGNED;
427                         continue;
428                 }
429
430                 if (resource->flags & IORESOURCE_IO) {
431                         /* Don't allow potential aliases over the legacy PCI
432                          * expansion card addresses. The legacy PCI decodes
433                          * only 10 bits, uses 0x100 - 0x3ff. Therefore, only
434                          * 0x00 - 0xff can be used out of each 0x400 block of
435                          * I/O space.
436                          */
437                         if ((base & 0x300) != 0) {
438                                 base = (base & ~0x3ff) + 0x400;
439                         }
440                         /* Don't allow allocations in the VGA I/O range.
441                          * PCI has special cases for that.
442                          */
443                         else if ((base >= 0x3b0) && (base <= 0x3df)) {
444                                 base = 0x3e0;
445                         }
446                 }
447
448                 if ((round(base, resource->align) + resource->size - 1) <=
449                     resource->limit) {
450                         /* Base must be aligned. */
451                         base = round(base, resource->align);
452                         resource->base = base;
453                         resource->flags |= IORESOURCE_ASSIGNED;
454                         resource->flags &= ~IORESOURCE_STORED;
455                         base += resource->size;
456                 } else {
457                         printk_err("!! Resource didn't fit !!\n");
458                         printk_err("   aligned base %llx size %llx limit %llx\n",
459                                round(base, resource->align), resource->size,
460                                resource->limit);
461                         printk_err("   %llx needs to be <= %llx (limit)\n",
462                                (round(base, resource->align) +
463                                 resource->size) - 1, resource->limit);
464                         printk_err("   %s%s %02lx *  [0x%llx - 0x%llx] %s\n",
465                                (resource->
466                                 flags & IORESOURCE_ASSIGNED) ? "Assigned: " :
467                                "", dev_path(dev), resource->index,
468                                resource->base,
469                                resource->base + resource->size - 1,
470                                (resource->
471                                 flags & IORESOURCE_IO) ? "io" : (resource->
472                                                                  flags &
473                                                                  IORESOURCE_PREFETCH)
474                                ? "prefmem" : "mem");
475                 }
476
477                 printk_spew("%s%s %02lx *  [0x%llx - 0x%llx] %s\n",
478                        (resource->flags & IORESOURCE_ASSIGNED) ? "Assigned: "
479                        : "",
480                        dev_path(dev), resource->index, resource->base,
481                        resource->size ? resource->base + resource->size - 1 :
482                        resource->base,
483                        (resource->flags & IORESOURCE_IO) ? "io" :
484                        (resource->flags & IORESOURCE_PREFETCH) ? "prefmem" :
485                        "mem");
486         }
487         /* A PCI bridge resource does not need to be a power of two size, but
488          * it does have a minimum granularity. Round the size up to that
489          * minimum granularity so we know not to place something else at an
490          * address positively decoded by the bridge.
491          */
492
493         bridge->flags |= IORESOURCE_ASSIGNED;
494
495         printk_spew("%s %s_%s: next_base: %llx size: %llx align: %d gran: %d done\n",
496                dev_path(bus->dev), __func__,
497                (type & IORESOURCE_IO) ? "io" : (type & IORESOURCE_PREFETCH) ?
498                "prefmem" : "mem",
499                base, bridge->size, bridge->align, bridge->gran);
500
501         /* For each child which is a bridge, allocate_resources. */
502         for (dev = bus->children; dev; dev = dev->sibling) {
503                 unsigned i;
504                 struct resource *child_bridge;
505
506                 if (!dev->links)
507                         continue;
508
509                 /* Find the resources with matching type flags. */
510                 for (i = 0; i < dev->resources; i++) {
511                         unsigned link;
512                         child_bridge = &dev->resource[i];
513
514                         if (!(child_bridge->flags & IORESOURCE_BRIDGE) ||
515                             (child_bridge->flags & type_mask) != type)
516                                 continue;
517
518                         /* Split prefetchable memory if combined.  Many domains
519                          * use the same address space for prefetchable memory
520                          * and non-prefetchable memory.  Bridges below them
521                          * need it separated.  Add the PREFETCH flag to the
522                          * type_mask and type.
523                          */
524                         link = IOINDEX_LINK(child_bridge->index);
525                         allocate_resources(&dev->link[link], child_bridge,
526                                            type_mask | IORESOURCE_PREFETCH,
527                                            type | (child_bridge->flags &
528                                                    IORESOURCE_PREFETCH));
529                 }
530         }
531 }
532
533 #if CONFIG_PCI_64BIT_PREF_MEM == 1
534         #define MEM_MASK (IORESOURCE_PREFETCH | IORESOURCE_MEM)
535 #else
536         #define MEM_MASK (IORESOURCE_MEM)
537 #endif
538 #define IO_MASK (IORESOURCE_IO)
539 #define PREF_TYPE (IORESOURCE_PREFETCH | IORESOURCE_MEM)
540 #define MEM_TYPE (IORESOURCE_MEM)
541 #define IO_TYPE (IORESOURCE_IO)
542
543 struct constraints {
544         struct resource pref, io, mem;
545 };
546
547 static void constrain_resources(struct device *dev, struct constraints* limits)
548 {
549         struct device *child;
550         struct resource *res;
551         struct resource *lim;
552         int i;
553
554         printk_spew("%s: %s\n", __func__, dev_path(dev));
555
556         /* Constrain limits based on the fixed resources of this device. */
557         for (i = 0; i < dev->resources; i++) {
558                 res = &dev->resource[i];
559                 if (!(res->flags & IORESOURCE_FIXED))
560                         continue;
561
562                 /* PREFETCH, MEM, or I/O - skip any others. */
563                 if ((res->flags & MEM_MASK) == PREF_TYPE)
564                         lim = &limits->pref;
565                 else if ((res->flags & MEM_MASK) == MEM_TYPE)
566                         lim = &limits->mem;
567                 else if ((res->flags & IO_MASK) == IO_TYPE)
568                         lim = &limits->io;
569                 else
570                         continue;
571
572                 /* Is it already outside the limits? */
573                 if (res->size && (((res->base + res->size -1) < lim->base) ||
574                                   (res->base > lim->limit)))
575                         continue;
576
577                 /* Choose to be above or below fixed resources.  This
578                  * check is signed so that "negative" amounts of space
579                  * are handled correctly.
580                  */
581                 if ((signed long long)(lim->limit - (res->base + res->size -1)) >
582                     (signed long long)(res->base - lim->base))
583                         lim->base = res->base + res->size;
584                 else
585                         lim->limit = res->base -1;
586         }
587
588         /* Descend into every enabled child and look for fixed resources. */
589         for (i = 0; i < dev->links; i++)
590                 for (child = dev->link[i].children; child;
591                      child = child->sibling)
592                         if (child->enabled)
593                                 constrain_resources(child, limits);
594 }
595
596 static void avoid_fixed_resources(struct device *dev)
597 {
598         struct constraints limits;
599         struct resource *res;
600         int i;
601
602         printk_spew("%s: %s\n", __func__, dev_path(dev));
603         /* Initialize constraints to maximum size. */
604
605         limits.pref.base = 0;
606         limits.pref.limit = 0xffffffffffffffffULL;
607         limits.io.base = 0;
608         limits.io.limit = 0xffffffffffffffffULL;
609         limits.mem.base = 0;
610         limits.mem.limit = 0xffffffffffffffffULL;
611
612         /* Constrain the limits to dev's initial resources. */
613         for (i = 0; i < dev->resources; i++) {
614                 res = &dev->resource[i];
615                 if ((res->flags & IORESOURCE_FIXED))
616                         continue;
617                 printk_spew("%s:@%s %02lx limit %08Lx\n", __func__,
618                              dev_path(dev), res->index, res->limit);
619                 if ((res->flags & MEM_MASK) == PREF_TYPE &&
620                     (res->limit < limits.pref.limit))
621                         limits.pref.limit = res->limit;
622                 if ((res->flags & MEM_MASK) == MEM_TYPE &&
623                     (res->limit < limits.mem.limit))
624                         limits.mem.limit = res->limit;
625                 if ((res->flags & IO_MASK) == IO_TYPE &&
626                     (res->limit < limits.io.limit))
627                         limits.io.limit = res->limit;
628         }
629
630         /* Look through the tree for fixed resources and update the limits. */
631         constrain_resources(dev, &limits);
632
633         /* Update dev's resources with new limits. */
634         for (i = 0; i < dev->resources; i++) {
635                 struct resource *lim;
636                 res = &dev->resource[i];
637
638                 if ((res->flags & IORESOURCE_FIXED))
639                         continue;
640
641                 /* PREFETCH, MEM, or I/O - skip any others. */
642                 if ((res->flags & MEM_MASK) == PREF_TYPE)
643                         lim = &limits.pref;
644                 else if ((res->flags & MEM_MASK) == MEM_TYPE)
645                         lim = &limits.mem;
646                 else if ((res->flags & IO_MASK) == IO_TYPE)
647                         lim = &limits.io;
648                 else
649                         continue;
650
651                 printk_spew("%s2: %s@%02lx limit %08Lx\n", __func__,
652                              dev_path(dev), res->index, res->limit);
653                 printk_spew("\tlim->base %08Lx lim->limit %08Lx\n",
654                              lim->base, lim->limit);
655
656                 /* Is the resource outside the limits? */
657                 if (lim->base > res->base)
658                         res->base = lim->base;
659                 if (res->limit > lim->limit)
660                         res->limit = lim->limit;
661         }
662 }
663
664 #if CONFIG_CONSOLE_VGA == 1
665 device_t vga_pri = 0;
666 static void set_vga_bridge_bits(void)
667 {
668 #warning "FIXME modify set_vga_bridge so it is less pci centric!"
669 #warning "This function knows too much about PCI stuff, it should be just a iterator/visitor."
670
671         /* FIXME: Handle the VGA palette snooping. */
672         struct device *dev, *vga, *vga_onboard, *vga_first, *vga_last;
673         struct bus *bus;
674         bus = 0;
675         vga = 0;
676         vga_onboard = 0;
677         vga_first = 0;
678         vga_last = 0;
679         for (dev = all_devices; dev; dev = dev->next) {
680                 if (!dev->enabled)
681                         continue;
682                 if (((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY) &&
683                     ((dev->class >> 8) != PCI_CLASS_DISPLAY_OTHER)) {
684                         if (!vga_first) {
685                                 if (dev->on_mainboard) {
686                                         vga_onboard = dev;
687                                 } else {
688                                         vga_first = dev;
689                                 }
690                         } else {
691                                 if (dev->on_mainboard) {
692                                         vga_onboard = dev;
693                                 } else {
694                                         vga_last = dev;
695                                 }
696                         }
697
698                         /* It isn't safe to enable other VGA cards. */
699                         dev->command &= ~(PCI_COMMAND_MEMORY | PCI_COMMAND_IO);
700                 }
701         }
702
703         vga = vga_last;
704
705         if (!vga) {
706                 vga = vga_first;
707         }
708 #if CONFIG_CONSOLE_VGA_ONBOARD_AT_FIRST == 1
709         if (vga_onboard)        // Will use on board VGA as pri.
710 #else
711         if (!vga)               // Will use last add on adapter as pri.
712 #endif
713         {
714                 vga = vga_onboard;
715         }
716
717         if (vga) {
718                 /* VGA is first add on card or the only onboard VGA. */
719                 printk_debug("Setting up VGA for %s\n", dev_path(vga));
720                 /* All legacy VGA cards have MEM & I/O space registers. */
721                 vga->command |= (PCI_COMMAND_MEMORY | PCI_COMMAND_IO);
722                 vga_pri = vga;
723                 bus = vga->bus;
724         }
725         /* Now walk up the bridges setting the VGA enable. */
726         while (bus) {
727                 printk_debug("Setting PCI_BRIDGE_CTL_VGA for bridge %s\n",
728                              dev_path(bus->dev));
729                 bus->bridge_ctrl |= PCI_BRIDGE_CTL_VGA;
730                 bus = (bus == bus->dev->bus) ? 0 : bus->dev->bus;
731         }
732 }
733
734 #endif
735
736 /**
737  * @brief  Assign the computed resources to the devices on the bus.
738  *
739  * @param bus Pointer to the structure for this bus
740  *
741  * Use the device specific set_resources method to store the computed
742  * resources to hardware. For bridge devices, the set_resources() method
743  * has to recurse into every down stream buses.
744  *
745  * Mutual recursion:
746  *      assign_resources() -> device_operation::set_resources()
747  *      device_operation::set_resources() -> assign_resources()
748  */
749 void assign_resources(struct bus *bus)
750 {
751         struct device *curdev;
752
753         printk_spew("%s assign_resources, bus %d link: %d\n",
754                     dev_path(bus->dev), bus->secondary, bus->link);
755
756         for (curdev = bus->children; curdev; curdev = curdev->sibling) {
757                 if (!curdev->enabled || !curdev->resources) {
758                         continue;
759                 }
760                 if (!curdev->ops || !curdev->ops->set_resources) {
761                         printk_err("%s missing set_resources\n",
762                                    dev_path(curdev));
763                         continue;
764                 }
765                 curdev->ops->set_resources(curdev);
766         }
767         printk_spew("%s assign_resources, bus %d link: %d\n",
768                     dev_path(bus->dev), bus->secondary, bus->link);
769 }
770
771 /**
772  * @brief Enable the resources for a specific device
773  *
774  * @param dev the device whose resources are to be enabled
775  *
776  * Enable resources of the device by calling the device specific
777  * enable_resources() method.
778  *
779  * The parent's resources should be enabled first to avoid having enabling
780  * order problem. This is done by calling the parent's enable_resources()
781  * method and let that method to call it's children's enable_resoruces()
782  * method via the (global) enable_childrens_resources().
783  *
784  * Indirect mutual recursion:
785  *      enable_resources() -> device_operations::enable_resource()
786  *      device_operations::enable_resource() -> enable_children_resources()
787  *      enable_children_resources() -> enable_resources()
788  */
789 void enable_resources(struct device *dev)
790 {
791         if (!dev->enabled) {
792                 return;
793         }
794         if (!dev->ops || !dev->ops->enable_resources) {
795                 printk_err("%s missing enable_resources\n", dev_path(dev));
796                 return;
797         }
798         dev->ops->enable_resources(dev);
799 }
800
801 /**
802  * @brief Reset all of the devices a bus
803  *
804  * Reset all of the devices on a bus and clear the bus's reset_needed flag.
805  *
806  * @param bus pointer to the bus structure
807  *
808  * @return 1 if the bus was successfully reset, 0 otherwise.
809  *
810  */
811 int reset_bus(struct bus *bus)
812 {
813         if (bus && bus->dev && bus->dev->ops && bus->dev->ops->reset_bus) {
814                 bus->dev->ops->reset_bus(bus);
815                 bus->reset_needed = 0;
816                 return 1;
817         }
818         return 0;
819 }
820
821 /**
822  * @brief Scan for devices on a bus.
823  *
824  * If there are bridges on the bus, recursively scan the buses behind the
825  * bridges. If the setting up and tuning of the bus causes a reset to be
826  * required, reset the bus and scan it again.
827  *
828  * @param busdev Pointer to the bus device.
829  * @param max Current bus number.
830  * @return The maximum bus number found, after scanning all subordinate buses.
831  */
832 unsigned int scan_bus(struct device *busdev, unsigned int max)
833 {
834         unsigned int new_max;
835         int do_scan_bus;
836         if (!busdev || !busdev->enabled || !busdev->ops ||
837             !busdev->ops->scan_bus) {
838                 return max;
839         }
840
841         do_scan_bus = 1;
842         while (do_scan_bus) {
843                 int link;
844                 new_max = busdev->ops->scan_bus(busdev, max);
845                 do_scan_bus = 0;
846                 for (link = 0; link < busdev->links; link++) {
847                         if (busdev->link[link].reset_needed) {
848                                 if (reset_bus(&busdev->link[link])) {
849                                         do_scan_bus = 1;
850                                 } else {
851                                         busdev->bus->reset_needed = 1;
852                                 }
853                         }
854                 }
855         }
856         return new_max;
857 }
858
859 /**
860  * @brief Determine the existence of devices and extend the device tree.
861  *
862  * Most of the devices in the system are listed in the mainboard Config.lb
863  * file. The device structures for these devices are generated at compile
864  * time by the config tool and are organized into the device tree. This
865  * function determines if the devices created at compile time actually exist
866  * in the physical system.
867  *
868  * For devices in the physical system but not listed in the Config.lb file,
869  * the device structures have to be created at run time and attached to the
870  * device tree.
871  *
872  * This function starts from the root device 'dev_root', scan the buses in
873  * the system recursively, modify the device tree according to the result of
874  * the probe.
875  *
876  * This function has no idea how to scan and probe buses and devices at all.
877  * It depends on the bus/device specific scan_bus() method to do it. The
878  * scan_bus() method also has to create the device structure and attach
879  * it to the device tree.
880  */
881 void dev_enumerate(void)
882 {
883         struct device *root;
884         printk_info("Enumerating buses...\n");
885         root = &dev_root;
886
887         show_all_devs(BIOS_DEBUG, "Before Device Enumeration.");
888         printk_debug("Compare with tree...\n");
889
890         show_devs_tree(root, BIOS_DEBUG, 0, 0);
891
892         if (root->chip_ops && root->chip_ops->enable_dev) {
893                 root->chip_ops->enable_dev(root);
894         }
895         if (!root->ops || !root->ops->scan_bus) {
896                 printk_err("dev_root missing scan_bus operation");
897                 return;
898         }
899         scan_bus(root, 0);
900         printk_info("done\n");
901 }
902
903 /**
904  * @brief Configure devices on the devices tree.
905  *
906  * Starting at the root of the device tree, travel it recursively in two
907  * passes. In the first pass, we compute and allocate resources (ranges)
908  * requried by each device. In the second pass, the resources ranges are
909  * relocated to their final position and stored to the hardware.
910  *
911  * I/O resources grow upward. MEM resources grow downward.
912  *
913  * Since the assignment is hierarchical we set the values into the dev_root
914  * struct.
915  */
916 void dev_configure(void)
917 {
918         struct resource *res;
919         struct device *root;
920         struct device *child;
921         int i;
922
923 #if CONFIG_CONSOLE_VGA == 1
924         set_vga_bridge_bits();
925 #endif
926
927         printk_info("Allocating resources...\n");
928
929         root = &dev_root;
930
931         /* Each domain should create resources which contain the entire address
932          * space for IO, MEM, and PREFMEM resources in the domain. The
933          * allocation of device resources will be done from this address space.
934          */
935
936         /* Read the resources for the entire tree. */
937
938         printk_info("Reading resources...\n");
939         read_resources(&root->link[0]);
940         printk_info("Done reading resources.\n");
941
942         print_resource_tree(root, BIOS_DEBUG, "After reading.");
943
944         /* Compute resources for all domains. */
945         for (child = root->link[0].children; child; child = child->sibling) {
946                 if (!(child->path.type == DEVICE_PATH_PCI_DOMAIN))
947                         continue;
948                 for (i = 0; i < child->resources; i++) {
949                         res = &child->resource[i];
950                         if (res->flags & IORESOURCE_FIXED)
951                                 continue;
952                         if (res->flags & IORESOURCE_PREFETCH) {
953                                 compute_resources(&child->link[0],
954                                                res, MEM_MASK, PREF_TYPE);
955                                 continue;
956                         }
957                         if (res->flags & IORESOURCE_MEM) {
958                                 compute_resources(&child->link[0],
959                                                res, MEM_MASK, MEM_TYPE);
960                                 continue;
961                         }
962                         if (res->flags & IORESOURCE_IO) {
963                                 compute_resources(&child->link[0],
964                                                res, IO_MASK, IO_TYPE);
965                                 continue;
966                         }
967                 }
968         }
969
970         /* For all domains. */
971         for (child = root->link[0].children; child; child=child->sibling)
972                 if (child->path.type == DEVICE_PATH_PCI_DOMAIN)
973                         avoid_fixed_resources(child);
974
975         /* Now we need to adjust the resources. MEM resources need to start at
976          * the highest address managable.
977          */
978         for (child = root->link[0].children; child; child = child->sibling) {
979                 if (child->path.type != DEVICE_PATH_PCI_DOMAIN)
980                         continue;
981                 for (i = 0; i < child->resources; i++) {
982                         res = &child->resource[i];
983                         if (!(res->flags & IORESOURCE_MEM) ||
984                             res->flags & IORESOURCE_FIXED)
985                                 continue;
986                         res->base = resource_max(res);
987                 }
988         }
989
990         /* Store the computed resource allocations into device registers ... */
991         printk_info("Setting resources...\n");
992         for (child = root->link[0].children; child; child = child->sibling) {
993                 if (!(child->path.type == DEVICE_PATH_PCI_DOMAIN))
994                         continue;
995                 for (i = 0; i < child->resources; i++) {
996                         res = &child->resource[i];
997                         if (res->flags & IORESOURCE_FIXED)
998                                 continue;
999                         if (res->flags & IORESOURCE_PREFETCH) {
1000                                 allocate_resources(&child->link[0],
1001                                                res, MEM_MASK, PREF_TYPE);
1002                                 continue;
1003                         }
1004                         if (res->flags & IORESOURCE_MEM) {
1005                                 allocate_resources(&child->link[0],
1006                                                res, MEM_MASK, MEM_TYPE);
1007                                 continue;
1008                         }
1009                         if (res->flags & IORESOURCE_IO) {
1010                                 allocate_resources(&child->link[0],
1011                                                res, IO_MASK, IO_TYPE);
1012                                 continue;
1013                         }
1014                 }
1015         }
1016         assign_resources(&root->link[0]);
1017         printk_info("Done setting resources.\n");
1018         print_resource_tree(root, BIOS_DEBUG, "After assigning values.");
1019
1020         printk_info("Done allocating resources.\n");
1021 }
1022
1023 /**
1024  * @brief Enable devices on the device tree.
1025  *
1026  * Starting at the root, walk the tree and enable all devices/bridges by
1027  * calling the device's enable_resources() method.
1028  */
1029 void dev_enable(void)
1030 {
1031         printk_info("Enabling resources...\n");
1032
1033         /* now enable everything. */
1034         enable_resources(&dev_root);
1035
1036         printk_info("done.\n");
1037 }
1038
1039 /**
1040  * @brief Initialize all devices in the global device list.
1041  *
1042  * Starting at the first device on the global device link list,
1043  * walk the list and call the device's init() method to do deivce
1044  * specific setup.
1045  */
1046 void dev_initialize(void)
1047 {
1048         struct device *dev;
1049
1050         printk_info("Initializing devices...\n");
1051         for (dev = all_devices; dev; dev = dev->next) {
1052                 if (dev->enabled && !dev->initialized &&
1053                     dev->ops && dev->ops->init) {
1054                         if (dev->path.type == DEVICE_PATH_I2C) {
1055                                 printk_debug("smbus: %s[%d]->",
1056                                              dev_path(dev->bus->dev),
1057                                              dev->bus->link);
1058                         }
1059                         printk_debug("%s init\n", dev_path(dev));
1060                         dev->initialized = 1;
1061                         dev->ops->init(dev);
1062                 }
1063         }
1064         printk_info("Devices initialized\n");
1065         show_all_devs(BIOS_DEBUG, "After init.");
1066 }