Blame src/linux_sysfs.c

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
};