hurd_init_dev(struct pci_dev *d)
{
d->aux = pci_malloc(d->access, sizeof(mach_port_t));
+ *((mach_port_t *) d->aux) = MACH_PORT_NULL;
}
/* Deallocate the port and free its space */
pci_mfree(d->aux);
}
+static mach_port_t
+device_port_lookup(struct pci_dev *d)
+{
+ char server[NAME_MAX];
+ mach_port_t device_port = *((mach_port_t *) d->aux);
+
+ if (device_port != MACH_PORT_NULL)
+ return device_port;
+
+ snprintf(server, NAME_MAX, "%s/%04x/%02x/%02x/%01u/%s",
+ _SERVERS_BUS_PCI, d->domain, d->bus, d->dev, d->func,
+ FILE_CONFIG_NAME);
+ device_port = file_name_lookup(server, 0, 0);
+
+ if (device_port == MACH_PORT_NULL)
+ d->access->error("Cannot find the PCI arbiter");
+
+ *((mach_port_t *) d->aux) = device_port;
+ return device_port;
+}
+
/* Walk through the FS tree to see what is allowed for us */
static void
enum_devices(const char *parent, struct pci_access *a, int domain, int bus,
DIR *dir;
struct dirent *entry;
char path[NAME_MAX];
- char server[NAME_MAX];
- uint32_t vd;
- uint8_t ht;
- mach_port_t device_port;
struct pci_dev *d;
dir = opendir(parent);
if (closedir(dir) < 0)
a->warning("Cannot close directory: %s (%s)", parent,
strerror(errno));
- a->error("Wrong directory name: %s (number expected) probably \
- not connected to an arbiter", entry->d_name);
+ a->error("Wrong directory name: %s (number expected) probably "
+ "not connected to an arbiter", entry->d_name);
}
/*
if (closedir(dir) < 0)
a->warning("Cannot close directory: %s (%s)", parent,
strerror(errno));
- a->error("Wrong directory tree, probably not connected \
- to an arbiter");
+ a->error("Wrong directory tree, probably not connected to an arbiter");
}
enum_devices(path, a, domain, bus, dev, func, lev + 1);
continue;
/* We found an available virtual device, add it to our list */
- snprintf(server, NAME_MAX, "%s/%04x/%02x/%02x/%01u/%s",
- _SERVERS_BUS_PCI, domain, bus, dev, func, entry->d_name);
- device_port = file_name_lookup(server, 0, 0);
- if (device_port == MACH_PORT_NULL)
- {
- if (closedir(dir) < 0)
- a->warning("Cannot close directory: %s (%s)", parent,
- strerror(errno));
- a->error("Cannot open %s", server);
- }
-
d = pci_alloc_dev(a);
- *((mach_port_t *) d->aux) = device_port;
+ d->domain = domain;
d->bus = bus;
d->dev = dev;
d->func = func;
pci_link_dev(a, d);
-
- vd = pci_read_long(d, PCI_VENDOR_ID);
- ht = pci_read_byte(d, PCI_HEADER_TYPE);
-
- d->vendor_id = vd & 0xffff;
- d->device_id = vd >> 16U;
- d->known_fields = PCI_FILL_IDENT;
- d->hdrtype = ht;
}
}
int err;
size_t nread;
char *data;
- mach_port_t device_port;
+ mach_port_t device_port = device_port_lookup(d);
- nread = len;
- device_port = *((mach_port_t *) d->aux);
if (len > 4)
- err = !pci_generic_block_read(d, pos, buf, nread);
- else
- {
- data = (char *) buf;
- err = pci_conf_read(device_port, pos, &data, &nread, len);
+ return pci_generic_block_read(d, pos, buf, len);
- if (data != (char *) buf)
- {
- if (nread > (size_t) len) /* Sanity check for bogus server. */
- {
- vm_deallocate(mach_task_self(), (vm_address_t) data, nread);
- return 0;
- }
+ data = (char *) buf;
+ err = pci_conf_read(device_port, pos, &data, &nread, len);
- memcpy(buf, data, nread);
+ if (data != (char *) buf)
+ {
+ if (nread > (size_t) len) /* Sanity check for bogus server. */
+ {
vm_deallocate(mach_task_self(), (vm_address_t) data, nread);
+ return 0;
}
+
+ memcpy(buf, data, nread);
+ vm_deallocate(mach_task_self(), (vm_address_t) data, nread);
}
- if (err)
- return 0;
- return nread == (size_t) len;
+ return !err && nread == (size_t) len;
}
/*
{
int err;
size_t nwrote;
- mach_port_t device_port;
+ mach_port_t device_port = device_port_lookup(d);
- nwrote = len;
- device_port = *((mach_port_t *) d->aux);
if (len > 4)
- err = !pci_generic_block_write(d, pos, buf, len);
- else
- err = pci_conf_write(device_port, pos, (char *) buf, len, &nwrote);
- if (err)
- return 0;
+ return pci_generic_block_write(d, pos, buf, len);
+
+ err = pci_conf_write(device_port, pos, (char *) buf, len, &nwrote);
- return nwrote == (size_t) len;
+ return !err && nwrote == (size_t) len;
}
/* Get requested info from the server */
static void
hurd_fill_regions(struct pci_dev *d)
{
- mach_port_t device_port = *((mach_port_t *) d->aux);
+ mach_port_t device_port = device_port_lookup(d);
struct pci_bar regions[6];
char *buf = (char *) ®ions;
size_t size = sizeof(regions);
hurd_fill_rom(struct pci_dev *d)
{
struct pci_xrom_bar rom;
- mach_port_t device_port = *((mach_port_t *) d->aux);
+ mach_port_t device_port = device_port_lookup(d);
char *buf = (char *) &rom;
size_t size = sizeof(rom);