|
Packit |
7d1034 |
/*
|
|
Packit |
7d1034 |
* (C) Copyright IBM Corporation 2006
|
|
Packit |
7d1034 |
* All Rights Reserved.
|
|
Packit |
7d1034 |
* Copyright 2012 Red Hat, Inc.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
Packit |
7d1034 |
* copy of this software and associated documentation files (the "Software"),
|
|
Packit |
7d1034 |
* to deal in the Software without restriction, including without limitation
|
|
Packit |
7d1034 |
* on the rights to use, copy, modify, merge, publish, distribute, sub
|
|
Packit |
7d1034 |
* license, and/or sell copies of the Software, and to permit persons to whom
|
|
Packit |
7d1034 |
* the Software is furnished to do so, subject to the following conditions:
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* The above copyright notice and this permission notice (including the next
|
|
Packit |
7d1034 |
* paragraph) shall be included in all copies or substantial portions of the
|
|
Packit |
7d1034 |
* Software.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
Packit |
7d1034 |
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
Packit |
7d1034 |
* FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
|
|
Packit |
7d1034 |
* IBM AND/OR THEIR SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
Packit |
7d1034 |
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
Packit |
7d1034 |
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
|
|
Packit |
7d1034 |
* DEALINGS IN THE SOFTWARE.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* \file linux_sysfs.c
|
|
Packit |
7d1034 |
* Access PCI subsystem using Linux's sysfs interface. This interface is
|
|
Packit |
7d1034 |
* available starting somewhere in the late 2.5.x kernel phase, and is the
|
|
Packit |
7d1034 |
* preferred method on all 2.6.x kernels.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \author Ian Romanick <idr@us.ibm.com>
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#define _GNU_SOURCE
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#ifdef HAVE_CONFIG_H
|
|
Packit |
7d1034 |
#include "config.h"
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include <stdlib.h>
|
|
Packit |
7d1034 |
#include <string.h>
|
|
Packit |
7d1034 |
#include <stdio.h>
|
|
Packit |
7d1034 |
#include <unistd.h>
|
|
Packit |
7d1034 |
#include <sys/types.h>
|
|
Packit |
7d1034 |
#include <sys/stat.h>
|
|
Packit |
7d1034 |
#include <fcntl.h>
|
|
Packit |
7d1034 |
#include <limits.h>
|
|
Packit |
7d1034 |
#include <sys/mman.h>
|
|
Packit |
7d1034 |
#include <dirent.h>
|
|
Packit |
7d1034 |
#include <errno.h>
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#if defined(__i386__) || defined(__x86_64__) || defined(__arm__)
|
|
Packit |
7d1034 |
#include <sys/io.h>
|
|
Packit |
7d1034 |
#else
|
|
Packit |
7d1034 |
#define inb(x) -1
|
|
Packit |
7d1034 |
#define inw(x) -1
|
|
Packit |
7d1034 |
#define inl(x) -1
|
|
Packit |
7d1034 |
#define outb(x,y) do {} while (0)
|
|
Packit |
7d1034 |
#define outw(x,y) do {} while (0)
|
|
Packit |
7d1034 |
#define outl(x,y) do {} while (0)
|
|
Packit |
7d1034 |
#define iopl(x) -1
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
#include <asm/mtrr.h>
|
|
Packit |
7d1034 |
#include <sys/ioctl.h>
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include "pciaccess.h"
|
|
Packit |
7d1034 |
#include "pciaccess_private.h"
|
|
Packit |
7d1034 |
#include "linux_devmem.h"
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static const struct pci_system_methods linux_sysfs_methods;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#define SYS_BUS_PCI "/sys/bus/pci/devices"
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read( struct pci_device * dev, void * data,
|
|
Packit |
7d1034 |
pciaddr_t offset, pciaddr_t size,
|
|
Packit |
7d1034 |
pciaddr_t * bytes_read );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int populate_entries(struct pci_system * pci_sys);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* Attempt to access PCI subsystem using Linux's sysfs interface.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
_pci_hidden int
|
|
Packit |
7d1034 |
pci_system_linux_sysfs_create( void )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
struct stat st;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* If the directory "/sys/bus/pci/devices" exists, then the PCI subsystem
|
|
Packit |
7d1034 |
* can be accessed using this interface.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( stat( SYS_BUS_PCI, & st ) == 0 ) {
|
|
Packit |
7d1034 |
pci_sys = calloc( 1, sizeof( struct pci_system ) );
|
|
Packit |
7d1034 |
if ( pci_sys != NULL ) {
|
|
Packit |
7d1034 |
pci_sys->methods = & linux_sysfs_methods;
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
pci_sys->mtrr_fd = open("/proc/mtrr", O_WRONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
err = populate_entries(pci_sys);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
else {
|
|
Packit |
7d1034 |
err = ENOMEM;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
else {
|
|
Packit |
7d1034 |
err = errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* Filter out the names "." and ".." from the scanned sysfs entries.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \param d Directory entry being processed by \c scandir.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \return
|
|
Packit |
7d1034 |
* Zero if the entry name matches either "." or ".."
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \sa scandir, populate_entries
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
scan_sys_pci_filter( const struct dirent * d )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
return !((strcmp( d->d_name, "." ) == 0)
|
|
Packit |
7d1034 |
|| (strcmp( d->d_name, ".." ) == 0));
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
parse_separate_sysfs_files(struct pci_device * dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
static const char *attrs[] = {
|
|
Packit |
7d1034 |
"vendor",
|
|
Packit |
7d1034 |
"device",
|
|
Packit |
7d1034 |
"class",
|
|
Packit |
7d1034 |
"revision",
|
|
Packit |
7d1034 |
"subsystem_vendor",
|
|
Packit |
7d1034 |
"subsystem_device",
|
|
Packit |
7d1034 |
};
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
char resource[512];
|
|
Packit |
7d1034 |
uint64_t data[6];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
int i;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
for (i = 0; i < 6; i++) {
|
|
Packit |
7d1034 |
snprintf(name, 255, "%s/%04x:%02x:%02x.%1u/%s",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func,
|
|
Packit |
7d1034 |
attrs[i]);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open(name, O_RDONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd == -1) {
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
read(fd, resource, 512);
|
|
Packit |
7d1034 |
resource[511] = '\0';
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
data[i] = strtoull(resource, NULL, 16);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev->vendor_id = data[0] & 0xffff;
|
|
Packit |
7d1034 |
dev->device_id = data[1] & 0xffff;
|
|
Packit |
7d1034 |
dev->device_class = data[2] & 0xffffff;
|
|
Packit |
7d1034 |
dev->revision = data[3] & 0xff;
|
|
Packit |
7d1034 |
dev->subvendor_id = data[4] & 0xffff;
|
|
Packit |
7d1034 |
dev->subdevice_id = data[5] & 0xffff;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
populate_entries( struct pci_system * p )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct dirent ** devices = NULL;
|
|
Packit |
7d1034 |
int n;
|
|
Packit |
7d1034 |
int i;
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
n = scandir( SYS_BUS_PCI, & devices, scan_sys_pci_filter, alphasort );
|
|
Packit |
7d1034 |
if ( n > 0 ) {
|
|
Packit |
7d1034 |
p->num_devices = n;
|
|
Packit |
7d1034 |
p->devices = calloc( n, sizeof( struct pci_device_private ) );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (p->devices != NULL) {
|
|
Packit |
7d1034 |
for (i = 0 ; i < n ; i++) {
|
|
Packit |
7d1034 |
uint8_t config[48];
|
|
Packit |
7d1034 |
pciaddr_t bytes;
|
|
Packit |
7d1034 |
unsigned dom, bus, dev, func;
|
|
Packit |
7d1034 |
struct pci_device_private *device =
|
|
Packit |
7d1034 |
(struct pci_device_private *) &p->devices[i];
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
sscanf(devices[i]->d_name, "%x:%02x:%02x.%1u",
|
|
Packit |
7d1034 |
& dom, & bus, & dev, & func);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device->base.domain = dom;
|
|
Packit |
7d1034 |
/*
|
|
Packit |
7d1034 |
* Applications compiled with older versions do not expect
|
|
Packit |
7d1034 |
* 32-bit domain numbers. To keep them working, we keep a 16-bit
|
|
Packit |
7d1034 |
* version of the domain number at the previous location.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
if (dom > 0xffff)
|
|
Packit |
7d1034 |
device->base.domain_16 = 0xffff;
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
device->base.domain_16 = dom;
|
|
Packit |
7d1034 |
device->base.bus = bus;
|
|
Packit |
7d1034 |
device->base.dev = dev;
|
|
Packit |
7d1034 |
device->base.func = func;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = parse_separate_sysfs_files(& device->base);
|
|
Packit |
7d1034 |
if (!err)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_device_linux_sysfs_read(& device->base, config, 0,
|
|
Packit |
7d1034 |
48, & bytes);
|
|
Packit |
7d1034 |
if ((bytes == 48) && !err) {
|
|
Packit |
7d1034 |
device->base.vendor_id = (uint16_t)config[0]
|
|
Packit |
7d1034 |
+ ((uint16_t)config[1] << 8);
|
|
Packit |
7d1034 |
device->base.device_id = (uint16_t)config[2]
|
|
Packit |
7d1034 |
+ ((uint16_t)config[3] << 8);
|
|
Packit |
7d1034 |
device->base.device_class = (uint32_t)config[9]
|
|
Packit |
7d1034 |
+ ((uint32_t)config[10] << 8)
|
|
Packit |
7d1034 |
+ ((uint32_t)config[11] << 16);
|
|
Packit |
7d1034 |
device->base.revision = config[8];
|
|
Packit |
7d1034 |
device->base.subvendor_id = (uint16_t)config[44]
|
|
Packit |
7d1034 |
+ ((uint16_t)config[45] << 8);
|
|
Packit |
7d1034 |
device->base.subdevice_id = (uint16_t)config[46]
|
|
Packit |
7d1034 |
+ ((uint16_t)config[47] << 8);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (err) {
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
else {
|
|
Packit |
7d1034 |
err = ENOMEM;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
for (i = 0; i < n; i++)
|
|
Packit |
7d1034 |
free(devices[i]);
|
|
Packit |
7d1034 |
free(devices);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (err) {
|
|
Packit |
7d1034 |
free(p->devices);
|
|
Packit |
7d1034 |
p->devices = NULL;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_probe( struct pci_device * dev )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
uint8_t config[256];
|
|
Packit |
7d1034 |
char resource[512];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
pciaddr_t bytes;
|
|
Packit |
7d1034 |
unsigned i;
|
|
Packit |
7d1034 |
int err;
|
|
Packit Service |
df18dc |
struct stat st;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_device_linux_sysfs_read( dev, config, 0, 256, & bytes );
|
|
Packit |
7d1034 |
if ( bytes >= 64 ) {
|
|
Packit |
7d1034 |
struct pci_device_private *priv = (struct pci_device_private *) dev;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev->irq = config[60];
|
|
Packit |
7d1034 |
priv->header_type = config[14];
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* The PCI config registers can be used to obtain information
|
|
Packit |
7d1034 |
* about the memory and I/O regions for the device. However,
|
|
Packit |
7d1034 |
* doing so requires some tricky parsing (to correctly handle
|
|
Packit |
7d1034 |
* 64-bit memory regions) and requires writing to the config
|
|
Packit |
7d1034 |
* registers. Since we'd like to avoid having to deal with the
|
|
Packit |
7d1034 |
* parsing issues and non-root users can write to PCI config
|
|
Packit |
7d1034 |
* registers, we use a different file in the device's sysfs
|
|
Packit |
7d1034 |
* directory called "resource".
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* The resource file contains all of the needed information in
|
|
Packit |
7d1034 |
* a format that is consistent across all platforms. Each BAR
|
|
Packit |
7d1034 |
* and the expansion ROM have a single line of data containing
|
|
Packit |
7d1034 |
* 3, 64-bit hex values: the first address in the region,
|
|
Packit |
7d1034 |
* the last address in the region, and the region's flags.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/resource",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
fd = open( name, O_RDONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
if ( fd != -1 ) {
|
|
Packit |
7d1034 |
char * next;
|
|
Packit |
7d1034 |
pciaddr_t low_addr;
|
|
Packit |
7d1034 |
pciaddr_t high_addr;
|
|
Packit |
7d1034 |
pciaddr_t flags;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bytes = read( fd, resource, 512 );
|
|
Packit |
7d1034 |
resource[511] = '\0';
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close( fd );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
next = resource;
|
|
Packit |
7d1034 |
for ( i = 0 ; i < 6 ; i++ ) {
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev->regions[i].base_addr = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
high_addr = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
flags = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( dev->regions[i].base_addr != 0 ) {
|
|
Packit |
7d1034 |
dev->regions[i].size = (high_addr
|
|
Packit |
7d1034 |
- dev->regions[i].base_addr) + 1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev->regions[i].is_IO = (flags & 0x01);
|
|
Packit |
7d1034 |
dev->regions[i].is_64 = (flags & 0x04);
|
|
Packit |
7d1034 |
dev->regions[i].is_prefetchable = (flags & 0x08);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
low_addr = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
high_addr = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
flags = strtoull( next, & next, 16 );
|
|
Packit |
7d1034 |
if ( low_addr != 0 ) {
|
|
Packit |
7d1034 |
priv->rom_base = low_addr;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit Service |
df18dc |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/rom",
|
|
Packit Service |
df18dc |
SYS_BUS_PCI,
|
|
Packit Service |
df18dc |
dev->domain,
|
|
Packit Service |
df18dc |
dev->bus,
|
|
Packit Service |
df18dc |
dev->dev,
|
|
Packit Service |
df18dc |
dev->func );
|
|
Packit Service |
df18dc |
|
|
Packit Service |
df18dc |
fd = open( name, O_RDWR );
|
|
Packit Service |
df18dc |
if ( fd == -1 ) {
|
|
Packit Service |
df18dc |
dev->rom_size = 0x10000;
|
|
Packit Service |
df18dc |
} else if ( fstat( fd, & st ) == -1 ) {
|
|
Packit Service |
df18dc |
close( fd );
|
|
Packit Service |
df18dc |
dev->rom_size = 0x10000;
|
|
Packit Service |
df18dc |
} else {
|
|
Packit Service |
df18dc |
close( fd );
|
|
Packit Service |
df18dc |
dev->rom_size = st.st_size == 0 ? 0x10000 : st.st_size;
|
|
Packit Service |
df18dc |
}
|
|
Packit Service |
df18dc |
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read_rom( struct pci_device * dev, void * buffer )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
struct stat st;
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
size_t total_bytes;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/rom",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open( name, O_RDWR | O_CLOEXEC);
|
|
Packit |
7d1034 |
if ( fd == -1 ) {
|
|
Packit |
7d1034 |
#ifdef LINUX_ROM
|
|
Packit |
7d1034 |
/* If reading the ROM using sysfs fails, fall back to the old
|
|
Packit |
7d1034 |
* /dev/mem based interface.
|
|
Packit |
7d1034 |
* disable this for newer kernels using configure
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
return pci_device_linux_devmem_read_rom(dev, buffer);
|
|
Packit |
7d1034 |
#else
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( fstat( fd, & st ) == -1 ) {
|
|
Packit |
7d1034 |
close( fd );
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* This is a quirky thing on Linux. Even though the ROM and the file
|
|
Packit |
7d1034 |
* for the ROM in sysfs are read-only, the string "1" must be written to
|
|
Packit |
7d1034 |
* the file to enable the ROM. After the data has been read, "0" must be
|
|
Packit |
7d1034 |
* written to the file to disable the ROM.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
write( fd, "1", 1 );
|
|
Packit |
7d1034 |
lseek( fd, 0, SEEK_SET );
|
|
Packit |
7d1034 |
|
|
Packit Service |
df18dc |
for ( total_bytes = 0 ; total_bytes < dev->rom_size ; /* empty */ ) {
|
|
Packit |
7d1034 |
const int bytes = read( fd, (char *) buffer + total_bytes,
|
|
Packit Service |
df18dc |
dev->rom_size - total_bytes );
|
|
Packit |
7d1034 |
if ( bytes == -1 ) {
|
|
Packit |
7d1034 |
err = errno;
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
else if ( bytes == 0 ) {
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
total_bytes += bytes;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
lseek( fd, 0, SEEK_SET );
|
|
Packit |
7d1034 |
write( fd, "0", 1 );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close( fd );
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read( struct pci_device * dev, void * data,
|
|
Packit |
7d1034 |
pciaddr_t offset, pciaddr_t size,
|
|
Packit |
7d1034 |
pciaddr_t * bytes_read )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
pciaddr_t temp_size = size;
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
char *data_bytes = data;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( bytes_read != NULL ) {
|
|
Packit |
7d1034 |
*bytes_read = 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* Each device has a directory under sysfs. Within that directory there
|
|
Packit |
7d1034 |
* is a file named "config". This file used to access the PCI config
|
|
Packit |
7d1034 |
* space. It is used here to obtain most of the information about the
|
|
Packit |
7d1034 |
* device.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/config",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open( name, O_RDONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
if ( fd == -1 ) {
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
while ( temp_size > 0 ) {
|
|
Packit |
7d1034 |
const ssize_t bytes = pread64( fd, data_bytes, temp_size, offset );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* If zero bytes were read, then we assume it's the end of the
|
|
Packit |
7d1034 |
* config file.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
if (bytes == 0)
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
if ( bytes < 0 ) {
|
|
Packit |
7d1034 |
err = errno;
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
temp_size -= bytes;
|
|
Packit |
7d1034 |
offset += bytes;
|
|
Packit |
7d1034 |
data_bytes += bytes;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( bytes_read != NULL ) {
|
|
Packit |
7d1034 |
*bytes_read = size - temp_size;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close( fd );
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_write( struct pci_device * dev, const void * data,
|
|
Packit |
7d1034 |
pciaddr_t offset, pciaddr_t size,
|
|
Packit |
7d1034 |
pciaddr_t * bytes_written )
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
pciaddr_t temp_size = size;
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
const char *data_bytes = data;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( bytes_written != NULL ) {
|
|
Packit |
7d1034 |
*bytes_written = 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* Each device has a directory under sysfs. Within that directory there
|
|
Packit |
7d1034 |
* is a file named "config". This file used to access the PCI config
|
|
Packit |
7d1034 |
* space. It is used here to obtain most of the information about the
|
|
Packit |
7d1034 |
* device.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/config",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open( name, O_WRONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
if ( fd == -1 ) {
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
while ( temp_size > 0 ) {
|
|
Packit |
7d1034 |
const ssize_t bytes = pwrite64( fd, data_bytes, temp_size, offset );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* If zero bytes were written, then we assume it's the end of the
|
|
Packit |
7d1034 |
* config file.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
if ( bytes == 0 )
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
if ( bytes < 0 ) {
|
|
Packit |
7d1034 |
err = errno;
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
temp_size -= bytes;
|
|
Packit |
7d1034 |
offset += bytes;
|
|
Packit |
7d1034 |
data_bytes += bytes;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ( bytes_written != NULL ) {
|
|
Packit |
7d1034 |
*bytes_written = size - temp_size;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close( fd );
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_map_range_wc(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_device_mapping *map)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
const int prot = ((map->flags & PCI_DEV_MAP_FLAG_WRITABLE) != 0)
|
|
Packit |
7d1034 |
? (PROT_READ | PROT_WRITE) : PROT_READ;
|
|
Packit |
7d1034 |
const int open_flags = ((map->flags & PCI_DEV_MAP_FLAG_WRITABLE) != 0)
|
|
Packit |
7d1034 |
? O_RDWR : O_RDONLY;
|
|
Packit |
7d1034 |
const off_t offset = map->base - dev->regions[map->region].base_addr;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf(name, 255, "%s/%04x:%02x:%02x.%1u/resource%u_wc",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func,
|
|
Packit |
7d1034 |
map->region);
|
|
Packit |
7d1034 |
fd = open(name, open_flags | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd == -1)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
map->memory = mmap(NULL, map->size, prot, MAP_SHARED, fd, offset);
|
|
Packit |
7d1034 |
if (map->memory == MAP_FAILED) {
|
|
Packit |
7d1034 |
map->memory = NULL;
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* Map a memory region for a device using the Linux sysfs interface.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \param dev Device whose memory region is to be mapped.
|
|
Packit |
7d1034 |
* \param map Parameters of the mapping that is to be created.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \return
|
|
Packit |
7d1034 |
* Zero on success or an \c errno value on failure.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \sa pci_device_map_rrange, pci_device_linux_sysfs_unmap_range
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \todo
|
|
Packit |
7d1034 |
* Some older 2.6.x kernels don't implement the resourceN files. On those
|
|
Packit |
7d1034 |
* systems /dev/mem must be used. On these systems it is also possible that
|
|
Packit |
7d1034 |
* \c mmap64 may need to be used.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_map_range(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_device_mapping *map)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
const int prot = ((map->flags & PCI_DEV_MAP_FLAG_WRITABLE) != 0)
|
|
Packit |
7d1034 |
? (PROT_READ | PROT_WRITE) : PROT_READ;
|
|
Packit |
7d1034 |
const int open_flags = ((map->flags & PCI_DEV_MAP_FLAG_WRITABLE) != 0)
|
|
Packit |
7d1034 |
? O_RDWR : O_RDONLY;
|
|
Packit |
7d1034 |
const off_t offset = map->base - dev->regions[map->region].base_addr;
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
struct mtrr_sentry sentry = {
|
|
Packit |
7d1034 |
.base = map->base,
|
|
Packit |
7d1034 |
.size = map->size,
|
|
Packit |
7d1034 |
.type = MTRR_TYPE_UNCACHABLE
|
|
Packit |
7d1034 |
};
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* For WC mappings, try sysfs resourceN_wc file first */
|
|
Packit |
7d1034 |
if ((map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE) &&
|
|
Packit |
7d1034 |
!pci_device_linux_sysfs_map_range_wc(dev, map))
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf(name, 255, "%s/%04x:%02x:%02x.%1u/resource%u",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func,
|
|
Packit |
7d1034 |
map->region);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open(name, open_flags | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd == -1) {
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
map->memory = mmap(NULL, map->size, prot, MAP_SHARED, fd, offset);
|
|
Packit |
7d1034 |
if (map->memory == MAP_FAILED) {
|
|
Packit |
7d1034 |
map->memory = NULL;
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
if ((map->flags & PCI_DEV_MAP_FLAG_CACHABLE) != 0) {
|
|
Packit |
7d1034 |
sentry.type = MTRR_TYPE_WRBACK;
|
|
Packit |
7d1034 |
} else if ((map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE) != 0) {
|
|
Packit |
7d1034 |
sentry.type = MTRR_TYPE_WRCOMB;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_sys->mtrr_fd != -1 && sentry.type != MTRR_TYPE_UNCACHABLE) {
|
|
Packit |
7d1034 |
if (ioctl(pci_sys->mtrr_fd, MTRRIOC_ADD_ENTRY, &sentry) < 0) {
|
|
Packit |
7d1034 |
/* FIXME: Should we report an error in this case?
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
fprintf(stderr, "error setting MTRR "
|
|
Packit |
7d1034 |
"(base = 0x%016" PRIx64 ", size = 0x%08x, type = %u) %s (%d)\n",
|
|
Packit |
7d1034 |
(pciaddr_t)sentry.base, sentry.size, sentry.type,
|
|
Packit |
7d1034 |
strerror(errno), errno);
|
|
Packit |
7d1034 |
/* err = errno;*/
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
/* KLUDGE ALERT -- rewrite the PTEs to turn off the CD and WT bits */
|
|
Packit |
7d1034 |
mprotect (map->memory, map->size, PROT_NONE);
|
|
Packit |
7d1034 |
err = mprotect (map->memory, map->size, PROT_READ|PROT_WRITE);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (err != 0) {
|
|
Packit |
7d1034 |
fprintf(stderr, "mprotect(PROT_READ | PROT_WRITE) failed: %s\n",
|
|
Packit |
7d1034 |
strerror(errno));
|
|
Packit |
7d1034 |
fprintf(stderr, "remapping without mprotect performance kludge.\n");
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
munmap(map->memory, map->size);
|
|
Packit |
7d1034 |
map->memory = mmap(NULL, map->size, prot, MAP_SHARED, fd, offset);
|
|
Packit |
7d1034 |
if (map->memory == MAP_FAILED) {
|
|
Packit |
7d1034 |
map->memory = NULL;
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* Unmap a memory region for a device using the Linux sysfs interface.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \param dev Device whose memory region is to be unmapped.
|
|
Packit |
7d1034 |
* \param map Parameters of the mapping that is to be destroyed.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \return
|
|
Packit |
7d1034 |
* Zero on success or an \c errno value on failure.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \sa pci_device_map_rrange, pci_device_linux_sysfs_map_range
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* \todo
|
|
Packit |
7d1034 |
* Some older 2.6.x kernels don't implement the resourceN files. On those
|
|
Packit |
7d1034 |
* systems /dev/mem must be used. On these systems it is also possible that
|
|
Packit |
7d1034 |
* \c mmap64 may need to be used.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_unmap_range(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_device_mapping *map)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
int err = 0;
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
struct mtrr_sentry sentry = {
|
|
Packit |
7d1034 |
.base = map->base,
|
|
Packit |
7d1034 |
.size = map->size,
|
|
Packit |
7d1034 |
.type = MTRR_TYPE_UNCACHABLE
|
|
Packit |
7d1034 |
};
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_device_generic_unmap_range (dev, map);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
if ((map->flags & PCI_DEV_MAP_FLAG_CACHABLE) != 0) {
|
|
Packit |
7d1034 |
sentry.type = MTRR_TYPE_WRBACK;
|
|
Packit |
7d1034 |
} else if ((map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE) != 0) {
|
|
Packit |
7d1034 |
sentry.type = MTRR_TYPE_WRCOMB;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_sys->mtrr_fd != -1 && sentry.type != MTRR_TYPE_UNCACHABLE) {
|
|
Packit |
7d1034 |
if (ioctl(pci_sys->mtrr_fd, MTRRIOC_DEL_ENTRY, &sentry) < 0) {
|
|
Packit |
7d1034 |
/* FIXME: Should we report an error in this case?
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
fprintf(stderr, "error setting MTRR "
|
|
Packit |
7d1034 |
"(base = 0x%016" PRIx64 ", size = 0x%08x, type = %u) %s (%d)\n",
|
|
Packit |
7d1034 |
(pciaddr_t)sentry.base, sentry.size, sentry.type,
|
|
Packit |
7d1034 |
strerror(errno), errno);
|
|
Packit |
7d1034 |
/* err = errno;*/
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void pci_device_linux_sysfs_enable(struct pci_device *dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/enable",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open( name, O_RDWR | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd == -1)
|
|
Packit |
7d1034 |
return;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
write( fd, "1", 1 );
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int pci_device_linux_sysfs_boot_vga(struct pci_device *dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
char reply[3];
|
|
Packit |
7d1034 |
int fd, bytes_read;
|
|
Packit |
7d1034 |
int ret = 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/boot_vga",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open( name, O_RDONLY | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd == -1)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bytes_read = read(fd, reply, 1);
|
|
Packit |
7d1034 |
if (bytes_read != 1)
|
|
Packit |
7d1034 |
goto out;
|
|
Packit |
7d1034 |
if (reply[0] == '1')
|
|
Packit |
7d1034 |
ret = 1;
|
|
Packit |
7d1034 |
out:
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int pci_device_linux_sysfs_has_kernel_driver(struct pci_device *dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[256];
|
|
Packit |
7d1034 |
struct stat dummy;
|
|
Packit |
7d1034 |
int ret;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf( name, 255, "%s/%04x:%02x:%02x.%1u/driver",
|
|
Packit |
7d1034 |
SYS_BUS_PCI,
|
|
Packit |
7d1034 |
dev->domain,
|
|
Packit |
7d1034 |
dev->bus,
|
|
Packit |
7d1034 |
dev->dev,
|
|
Packit |
7d1034 |
dev->func );
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ret = stat(name, &dummy);
|
|
Packit |
7d1034 |
if (ret < 0)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
return 1;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static struct pci_io_handle *
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_open_device_io(struct pci_io_handle *ret,
|
|
Packit |
7d1034 |
struct pci_device *dev, int bar,
|
|
Packit |
7d1034 |
pciaddr_t base, pciaddr_t size)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[PATH_MAX];
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
snprintf(name, PATH_MAX, "%s/%04x:%02x:%02x.%1u/resource%d",
|
|
Packit |
7d1034 |
SYS_BUS_PCI, dev->domain, dev->bus, dev->dev, dev->func, bar);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ret->fd = open(name, O_RDWR | O_CLOEXEC);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ret->fd < 0)
|
|
Packit |
7d1034 |
return NULL;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ret->base = base;
|
|
Packit |
7d1034 |
ret->size = size;
|
|
Packit |
7d1034 |
ret->is_legacy = 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static struct pci_io_handle *
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_open_legacy_io(struct pci_io_handle *ret,
|
|
Packit |
7d1034 |
struct pci_device *dev, pciaddr_t base,
|
|
Packit |
7d1034 |
pciaddr_t size)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[PATH_MAX];
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* First check if there's a legacy io method for the device */
|
|
Packit |
7d1034 |
while (dev) {
|
|
Packit |
7d1034 |
snprintf(name, PATH_MAX, "/sys/class/pci_bus/%04x:%02x/legacy_io",
|
|
Packit |
7d1034 |
dev->domain, dev->bus);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ret->fd = open(name, O_RDWR | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (ret->fd >= 0)
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev = pci_device_get_parent_bridge(dev);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/*
|
|
Packit |
7d1034 |
* You would think you'd want to use /dev/port here. Don't make that
|
|
Packit |
7d1034 |
* mistake, /dev/port only does byte-wide i/o cycles which means it
|
|
Packit |
7d1034 |
* doesn't work. If you think this is stupid, well, you're right.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* If we've no other choice, iopl */
|
|
Packit |
7d1034 |
if (ret->fd < 0) {
|
|
Packit |
7d1034 |
if (iopl(3))
|
|
Packit |
7d1034 |
return NULL;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ret->base = base;
|
|
Packit |
7d1034 |
ret->size = size;
|
|
Packit |
7d1034 |
ret->is_legacy = 1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_close_io(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_io_handle *handle)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
if (handle->fd > -1)
|
|
Packit |
7d1034 |
close(handle->fd);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static uint32_t
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read32(struct pci_io_handle *handle, uint32_t port)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
uint32_t ret;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 4, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 4, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
ret = inl(port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static uint16_t
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read16(struct pci_io_handle *handle, uint32_t port)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
uint16_t ret;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 2, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 2, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
ret = inw(port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static uint8_t
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_read8(struct pci_io_handle *handle, uint32_t port)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
uint8_t ret;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 1, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pread(handle->fd, &ret, 1, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
ret = inb(port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_write32(struct pci_io_handle *handle, uint32_t port,
|
|
Packit |
7d1034 |
uint32_t data)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 4, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 4, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
outl(data, port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_write16(struct pci_io_handle *handle, uint32_t port,
|
|
Packit |
7d1034 |
uint16_t data)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 2, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 2, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
outw(data, port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_write8(struct pci_io_handle *handle, uint32_t port,
|
|
Packit |
7d1034 |
uint8_t data)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
if (handle->fd > -1) {
|
|
Packit |
7d1034 |
if (handle->is_legacy)
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 1, port + handle->base);
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
pwrite(handle->fd, &data, 1, port);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
outb(data, port + handle->base);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_map_legacy(struct pci_device *dev, pciaddr_t base,
|
|
Packit |
7d1034 |
pciaddr_t size, unsigned map_flags, void **addr)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
char name[PATH_MAX];
|
|
Packit |
7d1034 |
int flags = O_RDONLY;
|
|
Packit |
7d1034 |
int prot = PROT_READ;
|
|
Packit |
7d1034 |
int fd;
|
|
Packit |
7d1034 |
int ret=0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (map_flags & PCI_DEV_MAP_FLAG_WRITABLE) {
|
|
Packit |
7d1034 |
flags = O_RDWR; /* O_RDWR != O_WRONLY | O_RDONLY */;
|
|
Packit |
7d1034 |
prot |= PROT_WRITE;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* First check if there's a legacy memory method for the device */
|
|
Packit |
7d1034 |
while (dev) {
|
|
Packit |
7d1034 |
snprintf(name, PATH_MAX, "/sys/class/pci_bus/%04x:%02x/legacy_mem",
|
|
Packit |
7d1034 |
dev->domain, dev->bus);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
fd = open(name, flags | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (fd >= 0)
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev = pci_device_get_parent_bridge(dev);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* If not, /dev/mem is the best we can do */
|
|
Packit |
7d1034 |
if (!dev)
|
|
Packit |
7d1034 |
fd = open("/dev/mem", flags | O_CLOEXEC);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (fd < 0)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
*addr = mmap(NULL, size, prot, MAP_SHARED, fd, base);
|
|
Packit |
7d1034 |
if (*addr == MAP_FAILED) {
|
|
Packit |
7d1034 |
ret = errno;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
close(fd);
|
|
Packit |
7d1034 |
return ret;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_linux_sysfs_unmap_legacy(struct pci_device *dev, void *addr, pciaddr_t size)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
return munmap(addr, size);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_system_linux_destroy(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
#ifdef HAVE_MTRR
|
|
Packit |
7d1034 |
if (pci_sys->mtrr_fd != -1)
|
|
Packit |
7d1034 |
close(pci_sys->mtrr_fd);
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static const struct pci_system_methods linux_sysfs_methods = {
|
|
Packit |
7d1034 |
.destroy = pci_system_linux_destroy,
|
|
Packit |
7d1034 |
.destroy_device = NULL,
|
|
Packit |
7d1034 |
.read_rom = pci_device_linux_sysfs_read_rom,
|
|
Packit |
7d1034 |
.probe = pci_device_linux_sysfs_probe,
|
|
Packit |
7d1034 |
.map_range = pci_device_linux_sysfs_map_range,
|
|
Packit |
7d1034 |
.unmap_range = pci_device_linux_sysfs_unmap_range,
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
.read = pci_device_linux_sysfs_read,
|
|
Packit |
7d1034 |
.write = pci_device_linux_sysfs_write,
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
.fill_capabilities = pci_fill_capabilities_generic,
|
|
Packit |
7d1034 |
.enable = pci_device_linux_sysfs_enable,
|
|
Packit |
7d1034 |
.boot_vga = pci_device_linux_sysfs_boot_vga,
|
|
Packit |
7d1034 |
.has_kernel_driver = pci_device_linux_sysfs_has_kernel_driver,
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
.open_device_io = pci_device_linux_sysfs_open_device_io,
|
|
Packit |
7d1034 |
.open_legacy_io = pci_device_linux_sysfs_open_legacy_io,
|
|
Packit |
7d1034 |
.close_io = pci_device_linux_sysfs_close_io,
|
|
Packit |
7d1034 |
.read32 = pci_device_linux_sysfs_read32,
|
|
Packit |
7d1034 |
.read16 = pci_device_linux_sysfs_read16,
|
|
Packit |
7d1034 |
.read8 = pci_device_linux_sysfs_read8,
|
|
Packit |
7d1034 |
.write32 = pci_device_linux_sysfs_write32,
|
|
Packit |
7d1034 |
.write16 = pci_device_linux_sysfs_write16,
|
|
Packit |
7d1034 |
.write8 = pci_device_linux_sysfs_write8,
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
.map_legacy = pci_device_linux_sysfs_map_legacy,
|
|
Packit |
7d1034 |
.unmap_legacy = pci_device_linux_sysfs_unmap_legacy,
|
|
Packit |
7d1034 |
};
|