/
githubmirror
/
pciutils
Обзор
Документация
Войти
/
githubmirror
/
pciutils
Код
Запросы
0
Пакеты
0
Релизы
0
Аналитика
Безопасность
v3.1.9
lib/sysfs.c
396 строк
9 KB
Matthew Wilcox
Make Physical Slot work for multifunction cards
14 авг 2009, 16:56
14 авг 2009, 16:56
fc038be
Код
Авторство
О чём код?
/* * The PCI Library -- Configuration Access via /sys/bus/pci * * Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx> * Copyright (c) 1997--2008 Martin Mares <mj@ucw.cz> * * Can be freely distributed and used under the terms of the GNU GPL. */ #define _GNU_SOURCE #include <stdio.h> #include <stdlib.h> #include <string.h> #include <stdarg.h> #include <unistd.h> #include <errno.h> #include <dirent.h> #include <fcntl.h> #include <sys/types.h> #include "internal.h" #include "pread.h" static void sysfs_config(struct pci_access *a) { pci_define_param(a, "sysfs.path", PCI_PATH_SYS_BUS_PCI, "Path to the sysfs device tree"); } static inline char * sysfs_name(struct pci_access *a) { return pci_get_param(a, "sysfs.path"); } static int sysfs_detect(struct pci_access *a) { if (access(sysfs_name(a), R_OK)) { a->debug("...cannot open %s", sysfs_name(a)); return 0; } a->debug("...using %s", sysfs_name(a)); return 1; } static void sysfs_init(struct pci_access *a) { a->fd = -1; a->fd_vpd = -1; } static void sysfs_flush_cache(struct pci_access *a) { if (a->fd >= 0) { close(a->fd); a->fd = -1; } if (a->fd_vpd >= 0) { close(a->fd_vpd); a->fd_vpd = -1; } a->cached_dev = NULL; } static void sysfs_cleanup(struct pci_access *a) { sysfs_flush_cache(a); } #define OBJNAMELEN 1024 static void sysfs_obj_name(struct pci_dev *d, char *object, char *buf) { int n = snprintf(buf, OBJNAMELEN, "%s/devices/%04x:%02x:%02x.%d/%s", sysfs_name(d->access), d->domain, d->bus, d->dev, d->func, object); if (n < 0 || n >= OBJNAMELEN) d->access->error("File name too long"); } static int sysfs_get_value(struct pci_dev *d, char *object) { struct pci_access *a = d->access; int fd, n; char namebuf[OBJNAMELEN], buf[256]; sysfs_obj_name(d, object, namebuf); fd = open(namebuf, O_RDONLY); if (fd < 0) a->error("Cannot open %s: %s", namebuf, strerror(errno)); n = read(fd, buf, sizeof(buf)); close(fd); if (n < 0) a->error("Error reading %s: %s", namebuf, strerror(errno)); if (n >= (int) sizeof(buf)) a->error("Value in %s too long", namebuf); buf[n] = 0; return strtol(buf, NULL, 0); } static void sysfs_get_resources(struct pci_dev *d) { struct pci_access *a = d->access; char namebuf[OBJNAMELEN], buf[256]; FILE *file; int i; sysfs_obj_name(d, "resource", namebuf); file = fopen(namebuf, "r"); if (!file) a->error("Cannot open %s: %s", namebuf, strerror(errno)); for (i = 0; i < 7; i++) { unsigned long long start, end, size, flags; if (!fgets(buf, sizeof(buf), file)) break; if (sscanf(buf, "%llx %llx %llx", &start, &end, &flags) != 3) a->error("Syntax error in %s", namebuf); if (start) size = end - start + 1; else size = 0; flags &= PCI_ADDR_FLAG_MASK; if (i < 6) { d->base_addr[i] = start | flags; d->size[i] = size; } else { d->rom_base_addr = start | flags; d->rom_size = size; } } fclose(file); } static void sysfs_scan(struct pci_access *a) { char dirname[1024]; DIR *dir; struct dirent *entry; int n; n = snprintf(dirname, sizeof(dirname), "%s/devices", sysfs_name(a)); if (n < 0 || n >= (int) sizeof(dirname)) a->error("Directory name too long"); dir = opendir(dirname); if (!dir) a->error("Cannot open %s", dirname); while ((entry = readdir(dir))) { struct pci_dev *d; unsigned int dom, bus, dev, func; /* ".", ".." or a special non-device perhaps */ if (entry->d_name[0] == '.') continue; d = pci_alloc_dev(a); if (sscanf(entry->d_name, "%x:%x:%x.%d", &dom, &bus, &dev, &func) < 4) a->error("sysfs_scan: Couldn't parse entry name %s", entry->d_name); d->domain = dom; d->bus = bus; d->dev = dev; d->func = func; if (!a->buscentric) { sysfs_get_resources(d); d->irq = sysfs_get_value(d, "irq"); /* * We could read these faster from the config registers, but we want to give * the kernel a chance to fix up ID's and especially classes of broken devices. */ d->vendor_id = sysfs_get_value(d, "vendor"); d->device_id = sysfs_get_value(d, "device"); d->device_class = sysfs_get_value(d, "class") >> 8; d->known_fields = PCI_FILL_IDENT | PCI_FILL_CLASS | PCI_FILL_IRQ | PCI_FILL_BASES | PCI_FILL_ROM_BASE | PCI_FILL_SIZES; } pci_link_dev(a, d); } closedir(dir); } static void sysfs_fill_slots(struct pci_access *a) { char dirname[1024]; DIR *dir; struct dirent *entry; int n; n = snprintf(dirname, sizeof(dirname), "%s/slots", sysfs_name(a)); if (n < 0 || n >= (int) sizeof(dirname)) a->error("Directory name too long"); dir = opendir(dirname); if (!dir) return; while (entry = readdir(dir)) { char namebuf[OBJNAMELEN], buf[16]; FILE *file; unsigned int dom, bus, dev; struct pci_dev *d; /* ".", ".." or a special non-device perhaps */ if (entry->d_name[0] == '.') continue; n = snprintf(namebuf, OBJNAMELEN, "%s/%s/%s", dirname, entry->d_name, "address"); if (n < 0 || n >= OBJNAMELEN) a->error("File name too long"); file = fopen(namebuf, "r"); /* * Old versions of Linux had a fakephp which didn't have an 'address' * file. There's no useful information to be gleaned from these * devices, pretend they're not there. */ if (!file) continue; if (!fgets(buf, sizeof(buf), file) || sscanf(buf, "%x:%x:%x", &dom, &bus, &dev) < 3) a->warning("sysfs_fill_slots: Couldn't parse entry address %s", buf); else { for (d = a->devices; d; d = d->next) if (dom == d->domain && bus == d->bus && dev == d->dev && !d->phy_slot) { d->phy_slot = pci_malloc(a, strlen(entry->d_name) + 1); strcpy(d->phy_slot, entry->d_name); } } fclose(file); } closedir(dir); } static int sysfs_fill_info(struct pci_dev *d, int flags) { if ((flags & PCI_FILL_PHYS_SLOT) && !(d->known_fields & PCI_FILL_PHYS_SLOT)) { struct pci_dev *pd; sysfs_fill_slots(d->access); for (pd = d->access->devices; pd; pd = pd->next) pd->known_fields |= PCI_FILL_PHYS_SLOT; } return pci_generic_fill_info(d, flags); } /* Intent of the sysfs_setup() caller */ enum { SETUP_READ_CONFIG = 0, SETUP_WRITE_CONFIG = 1, SETUP_READ_VPD = 2 }; static int sysfs_setup(struct pci_dev *d, int intent) { struct pci_access *a = d->access; char namebuf[OBJNAMELEN]; if (a->cached_dev != d || (intent == SETUP_WRITE_CONFIG && !a->fd_rw)) { sysfs_flush_cache(a); a->cached_dev = d; } if (intent == SETUP_READ_VPD) { if (a->fd_vpd < 0) { sysfs_obj_name(d, "vpd", namebuf); a->fd_vpd = open(namebuf, O_RDONLY); /* No warning on error; vpd may be absent or accessible only to root */ } return a->fd_vpd; } if (a->fd < 0) { sysfs_obj_name(d, "config", namebuf); a->fd_rw = a->writeable || intent == SETUP_WRITE_CONFIG; a->fd = open(namebuf, a->fd_rw ? O_RDWR : O_RDONLY); if (a->fd < 0) a->warning("Cannot open %s", namebuf); a->fd_pos = 0; } return a->fd; } static int sysfs_read(struct pci_dev *d, int pos, byte *buf, int len) { int fd = sysfs_setup(d, SETUP_READ_CONFIG); int res; if (fd < 0) return 0; res = do_read(d, fd, buf, len, pos); if (res < 0) { d->access->warning("sysfs_read: read failed: %s", strerror(errno)); return 0; } else if (res != len) return 0; return 1; } static int sysfs_write(struct pci_dev *d, int pos, byte *buf, int len) { int fd = sysfs_setup(d, SETUP_WRITE_CONFIG); int res; if (fd < 0) return 0; res = do_write(d, fd, buf, len, pos); if (res < 0) { d->access->warning("sysfs_write: write failed: %s", strerror(errno)); return 0; } else if (res != len) { d->access->warning("sysfs_write: tried to write %d bytes at %d, but only %d succeeded", len, pos, res); return 0; } return 1; } #ifdef PCI_HAVE_DO_READ /* pread() is not available and do_read() only works for a single fd, so we * cannot implement read_vpd properly. */ static int sysfs_read_vpd(struct pci_dev *d, int pos, byte *buf, int len) { return 0; } #else /* !PCI_HAVE_DO_READ */ static int sysfs_read_vpd(struct pci_dev *d, int pos, byte *buf, int len) { int fd = sysfs_setup(d, SETUP_READ_VPD); int res; if (fd < 0) return 0; res = pread(fd, buf, len, pos); if (res < 0) { d->access->warning("sysfs_read_vpd: read failed: %s", strerror(errno)); return 0; } else if (res != len) return 0; return 1; } #endif /* PCI_HAVE_DO_READ */ static void sysfs_cleanup_dev(struct pci_dev *d) { struct pci_access *a = d->access; if (a->cached_dev == d) sysfs_flush_cache(a); } struct pci_methods pm_linux_sysfs = { "linux-sysfs", "The sys filesystem on Linux", sysfs_config, sysfs_detect, sysfs_init, sysfs_cleanup, sysfs_scan, sysfs_fill_info, sysfs_read, sysfs_write, sysfs_read_vpd, NULL, /* init_dev */ sysfs_cleanup_dev };