diff options
Diffstat (limited to 'pci.c')
| -rw-r--r-- | pci.c | 112 |
1 files changed, 112 insertions, 0 deletions
@@ -0,0 +1,112 @@ +#define _GNU_SOURCE +#include <stdio.h> +#include <stdarg.h> +#include <stdlib.h> +#include <string.h> +#include <pci/pci.h> +#include <sys/types.h> +#include <sys/stat.h> +#include <fcntl.h> +#include <unistd.h> +#include <dirent.h> +#include <pci/header.h> +#include "common.h" + +/* /proc files're 256 bytes but we only need first 64 bytes*/ +#define CONFIG_SPACE_SIZE 64 + +static char *proc_pci_path_default = "/proc/bus/pci/devices"; +char* proc_pci_path = NULL; + +static void __attribute__((noreturn)) error_and_die(char *msg, ...) +{ + va_list args; + + va_start(args, msg); + fprintf(stderr, "%s: ", "lspcidrake"); + vfprintf(stderr, msg, args); + fputc('\n', stderr); + exit(1); +} + +extern struct pciusb_entries pci_probe(void) { + u8 buf[CONFIG_SPACE_SIZE]; + struct pciusb_entries r; + + static struct pci_access *pacc; + struct pci_dev *dev; + char classbuf[128], vendorbuf[128], devbuf[128]; + + pacc = pci_alloc(); + + if (proc_pci_path) { + pci_set_param(pacc, "proc.path", proc_pci_path); + } + + + pci_init(pacc); + pacc->error = error_and_die; + pci_scan_bus(pacc); + + r.nb = 0; + r.entries = malloc(sizeof(struct pciusb_entry) * MAX_DEVICES); + + for (dev = pacc->devices; dev && r.nb < MAX_DEVICES; dev = dev->next, r.nb++) { + + struct pciusb_entry *e = &r.entries[r.nb]; + memset(buf, 0, CONFIG_SPACE_SIZE); // make sure not to retrieve values from previous devices + pci_setup_cache(dev, (u8*)buf, CONFIG_SPACE_SIZE); + pci_read_block(dev, 0, buf, CONFIG_SPACE_SIZE); + pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_CLASS | PCI_FILL_CAPS); + + pciusb_initialize(e); + + asprintf(&e->text, "%s|%s", + pci_lookup_name(pacc, vendorbuf, sizeof(vendorbuf), PCI_LOOKUP_VENDOR, dev->vendor_id, dev->device_id), + pci_lookup_name(pacc, devbuf, sizeof(devbuf), PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id) + ); + pci_lookup_name(pacc, classbuf, sizeof(classbuf), PCI_LOOKUP_CLASS, dev->device_class), + e->class=strdup(classbuf); + + e->vendor = dev->vendor_id; + e->device = dev->device_id; + e->pci_domain = dev->domain; + e->pci_bus = dev->bus; + e->pci_device = dev->dev; + e->pci_function = dev->func; + + e->class_id = dev->device_class; + e->subvendor = pci_read_word(dev, PCI_SUBSYSTEM_VENDOR_ID); + e->subdevice = pci_read_word(dev, PCI_SUBSYSTEM_ID); + e->pci_revision = pci_read_byte(dev, PCI_REVISION_ID); + + if ((e->subvendor == 0 && e->subdevice == 0) || + (e->subvendor == e->vendor && e->subdevice == e->device)) { + e->subvendor = 0xffff; + e->subdevice = 0xffff; + } + + if (pci_find_cap(dev,PCI_CAP_ID_EXP, PCI_CAP_NORMAL)) + e->is_pciexpress = 1; + + /* special case for realtek 8139 that has two drivers */ + if (e->vendor == 0x10ec && e->device == 0x8139) { + if (e->pci_revision < 0x20) + e->module = strdup("8139too"); + else + e->module = strdup("8139cp"); + } + + } + + /* shrink to real size */ + r.entries = realloc(r.entries, sizeof(struct pciusb_entry) * r.nb); + + pci_cleanup(pacc); + + if (pciusb_find_modules(&r, "pcitable", DO_NOT_LOAD, 1)) + return r; + + /* should not happen */ + exit(1); +} |