Use the magic of common symbols to allow struct dev to effectively grow at
[people/xl0/gpxe.git] / src / drivers / bus / mca.c
1 /*
2  * MCA bus driver code
3  *
4  * Abstracted from 3c509.c.
5  *
6  */
7
8 #include "etherboot.h"
9 #include "dev.h"
10 #include "io.h"
11 #include "mca.h"
12
13 #define DEBUG_MCA
14
15 #undef DBG
16 #ifdef DEBUG_MCA
17 #define DBG(...) printf ( __VA_ARGS__ )
18 #else
19 #define DBG(...)
20 #endif
21
22 /*
23  * Ensure that there is sufficient space in the shared dev_bus
24  * structure for a struct pci_device.
25  *
26  */
27 DEV_BUS( struct mca_device, mca_dev );
28 static char mca_magic[0]; /* guaranteed unique symbol */
29
30 /*
31  * Fill in parameters for an MCA device based on slot number
32  *
33  */
34 static int fill_mca_device ( struct mca_device *mca ) {
35         unsigned int i;
36
37         /* Make sure motherboard setup is off */
38         outb_p ( 0xff, MCA_MOTHERBOARD_SETUP_REG );
39
40         /* Select the slot */
41         outb_p ( 0x8 | ( mca->slot & 0xf ), MCA_ADAPTER_SETUP_REG );
42
43         /* Read the POS registers */
44         for ( i = 0 ; i < ( sizeof ( mca->pos ) / sizeof ( mca->pos[0] ) ) ;
45               i++ ) {
46                 mca->pos[i] = inb_p ( MCA_POS_REG ( i ) );
47         }
48
49         /* Kill all setup modes */
50         outb_p ( 0, MCA_ADAPTER_SETUP_REG );
51
52         DBG ( "MCA slot %d id %hx (%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx:%hhx)\n",
53               mca->slot, MCA_ID ( mca ),
54               mca->pos[0], mca->pos[1], mca->pos[2], mca->pos[3],
55               mca->pos[4], mca->pos[5], mca->pos[6], mca->pos[7] );
56
57         return 1;
58 }
59
60 /*
61  * Obtain a struct mca * from a struct dev *
62  *
63  * If dev has not previously been used for an MCA device scan, blank
64  * out struct mca
65  */
66 struct mca_device * mca_device ( struct dev *dev ) {
67         struct mca_device *mca = dev->bus;
68
69         if ( mca->magic != mca_magic ) {
70                 memset ( mca, 0, sizeof ( *mca ) );
71                 mca->magic = mca_magic;
72         }
73         mca->dev = dev;
74         return mca;
75 }
76
77 /*
78  * Find an MCA device matching the specified driver
79  *
80  */
81 int find_mca_device ( struct mca_device *mca, struct mca_driver *driver ) {
82         unsigned int i;
83
84         /* Iterate through all possible MCA slots, starting where we
85          * left off/
86          */
87         for ( ; mca->slot < MCA_MAX_SLOT_NR ; mca->slot++ ) {
88                 /* If we've already used this device, skip it */
89                 if ( mca->already_tried ) {
90                         mca->already_tried = 0;
91                         continue;
92                 }
93
94                 /* Fill in device parameters */
95                 if ( ! fill_mca_device ( mca ) ) {
96                         continue;
97                 }
98
99                 /* Compare against driver's ID list */
100                 for ( i = 0 ; i < driver->id_count ; i++ ) {
101                         struct mca_id *id = &driver->ids[i];
102
103                         if ( MCA_ID ( mca ) == id->id ) {
104                                 DBG ( "Device %s (driver %s) matches ID %hx\n",
105                                       id->name, driver->name, id->id );
106                                 if ( mca->dev ) {
107                                         mca->dev->name = driver->name;
108                                         mca->dev->devid.bus_type
109                                                 = MCA_BUS_TYPE;
110                                         mca->dev->devid.vendor_id
111                                                 = GENERIC_MCA_VENDOR;
112                                         mca->dev->devid.device_id = id->id;
113                                 }
114                                 mca->already_tried = 1;
115                                 return 1;
116                         }
117                 }
118         }
119
120         /* No device found */
121         mca->slot = 0;
122         return 0;
123 }