1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
|
#include "string.h"
#include "config/isa.h"
#include "isa.h"
/*
* isa.c implements a "classical" port-scanning method of ISA device
* detection. The driver must provide a list of probe addresses
* (probe_addrs), together with a function (probe_addr) that can be
* used to test for the physical presence of a device at any given
* address.
*
* Note that this should probably be considered the "last resort" for
* device probing. If the card supports ISAPnP or EISA, use that
* instead. Some cards (e.g. the 3c509) implement a proprietary
* ISAPnP-like mechanism.
*
* The ISA probe address list can be overridden by config.c; if the
* user specifies ISA_PROBE_ADDRS then that list will be used first.
* (If ISA_PROBE_ADDRS ends with a zero, the driver's own list will
* never be used).
*/
/*
* Ensure that there is sufficient space in the shared dev_bus
* structure for a struct isa_device.
*
*/
DEV_BUS( struct isa_device, isa_dev );
static char isa_magic[0]; /* guaranteed unique symbol */
/*
* User-supplied probe address list
*
*/
#ifdef ISA_PROBE_ADDRS
# ifdef ISA_PROBE_ONLY
# define HAVE_ISA_PROBE_ADDRS 1
# define ISA_PROBE_ADDR_LIST ISA_PROBE_ADDRS, 0
# else
# define HAVE_ISA_PROBE_ADDRS 1
# define ISA_PROBE_ADDR_LIST ISA_PROBE_ADDRS
# endif
#else
# define HAVE_ISA_PROBE_ADDRS 0
# define ISA_PROBE_ADDR_LIST
#endif
static isa_probe_addr_t isa_extra_probe_addrs[] = {
ISA_PROBE_ADDR_LIST
};
#define isa_extra_probe_addr_count \
( sizeof ( isa_extra_probe_addrs ) / sizeof ( isa_extra_probe_addrs[0] ) )
/*
* Find an ISA device matching the specified driver
*
*/
int find_isa_device ( struct isa_device *isa, struct isa_driver *driver ) {
unsigned int i;
uint16_t ioaddr;
/* Initialise struct isa if it's the first time it's been used. */
if ( isa->magic != isa_magic ) {
memset ( isa, 0, sizeof ( *isa ) );
isa->magic = isa_magic;
}
/* Iterate through any ISA probe addresses specified by the
* user, starting where we left off.
*/
DBG ( "ISA searching for device matching driver %s\n", driver->name );
for ( i = isa->probe_idx ; i < isa_extra_probe_addr_count ; i++ ) {
/* If we've already used this device, skip it */
if ( isa->already_tried ) {
isa->already_tried = 0;
continue;
}
/* Set I/O address */
ioaddr = isa_extra_probe_addrs[i];
/* An I/O address of 0 in extra_probe_addrs list means
* stop probing (i.e. don't continue to the
* driver-provided list)
*/
if ( ! ioaddr )
goto notfound;
/* Use probe_addr method to see if there's a device
* present at this address.
*/
if ( driver->probe_addr ( ioaddr ) ) {
isa->probe_idx = i;
goto found;
}
}
/* Iterate through all ISA probe addresses provided by the
* driver, starting where we left off.
*/
for ( i = isa->probe_idx - isa_extra_probe_addr_count ;
i < driver->addr_count ; i++ ) {
/* If we've already used this device, skip it */
if ( isa->already_tried ) {
isa->already_tried = 0;
continue;
}
/* Set I/O address */
ioaddr = driver->probe_addrs[i];
/* Use probe_addr method to see if there's a device
* present at this address.
*/
if ( driver->probe_addr ( ioaddr ) ) {
isa->probe_idx = i + isa_extra_probe_addr_count;
goto found;
}
}
notfound:
/* No device found */
DBG ( "ISA found no device matching driver %s\n", driver->name );
isa->probe_idx = 0;
return 0;
found:
DBG ( "ISA found %s device at address %hx\n", driver->name, ioaddr );
isa->ioaddr = ioaddr;
isa->already_tried = 1;
return 1;
}
/*
* Find the next ISA device that can be used to boot using the
* specified driver.
*
*/
int find_isa_boot_device ( struct dev *dev, struct isa_driver *driver ) {
struct isa_device *isa = ( struct isa_device * )dev->bus;
if ( ! find_isa_device ( isa, driver ) )
return 0;
dev->name = driver->name;
dev->devid.bus_type = ISA_BUS_TYPE;
dev->devid.vendor_id = driver->mfg_id;
dev->devid.device_id = driver->prod_id;
return 1;
}
|
