Blame src/freebsd_pci.c

Packit 7d1034
/*
Packit 7d1034
 * (C) Copyright Eric Anholt 2006
Packit 7d1034
 * (C) Copyright IBM Corporation 2006
Packit 7d1034
 * (C) Copyright Mark Kettenis 2011
Packit 7d1034
 * (C) Copyright Robert Millan 2012
Packit 7d1034
 * All Rights Reserved.
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 freebsd_pci.c
Packit 7d1034
 *
Packit 7d1034
 * Access the kernel PCI support using /dev/pci's ioctl and mmap interface.
Packit 7d1034
 *
Packit 7d1034
 * \author Eric Anholt <eric@anholt.net>
Packit 7d1034
 */
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 <stdio.h>
Packit 7d1034
#include <string.h>
Packit 7d1034
#include <unistd.h>
Packit 7d1034
#include <fcntl.h>
Packit 7d1034
#include <errno.h>
Packit 7d1034
#include <sys/types.h>
Packit 7d1034
#include <sys/param.h>
Packit 7d1034
#include <sys/pciio.h>
Packit 7d1034
#include <sys/mman.h>
Packit 7d1034
#include <sys/memrange.h>
Packit 7d1034
Packit 7d1034
#include "pciaccess.h"
Packit 7d1034
#include "pciaccess_private.h"
Packit 7d1034
Packit 7d1034
#define	PCIC_DISPLAY	0x03
Packit 7d1034
#define	PCIS_DISPLAY_VGA	0x00
Packit 7d1034
#define	PCIS_DISPLAY_XGA	0x01
Packit 7d1034
#define	PCIS_DISPLAY_3D		0x02
Packit 7d1034
#define	PCIS_DISPLAY_OTHER	0x80
Packit 7d1034
Packit 7d1034
/* Registers taken from pcireg.h */
Packit 7d1034
#define PCIR_COMMAND    0x04
Packit 7d1034
#define PCIM_CMD_PORTEN         0x0001
Packit 7d1034
#define PCIM_CMD_MEMEN          0x0002
Packit 7d1034
#define PCIR_BIOS	0x30
Packit 7d1034
#define PCIM_BIOS_ENABLE	0x01
Packit 7d1034
#define PCIM_BIOS_ADDR_MASK	0xfffff800
Packit 7d1034
Packit 7d1034
#define PCIR_BARS       0x10
Packit 7d1034
#define PCIR_BAR(x)             (PCIR_BARS + (x) * 4)
Packit 7d1034
#define PCI_BAR_IO(x)           (((x) & PCIM_BAR_SPACE) == PCIM_BAR_IO_SPACE)
Packit 7d1034
#define PCI_BAR_MEM(x)          (((x) & PCIM_BAR_SPACE) == PCIM_BAR_MEM_SPACE)
Packit 7d1034
#define PCIM_BAR_MEM_TYPE       0x00000006
Packit 7d1034
#define PCIM_BAR_MEM_64         4
Packit 7d1034
#define PCIM_BAR_MEM_PREFETCH   0x00000008
Packit 7d1034
#define PCIM_BAR_SPACE          0x00000001
Packit 7d1034
#define PCIM_BAR_MEM_SPACE      0
Packit 7d1034
#define PCIM_BAR_IO_SPACE       1
Packit 7d1034
Packit 7d1034
/**
Packit 7d1034
 * FreeBSD private pci_system structure that extends the base pci_system
Packit 7d1034
 * structure.
Packit 7d1034
 *
Packit 7d1034
 * It is initialized once and used as a global, just as pci_system is used.
Packit 7d1034
 */
Packit 7d1034
_pci_hidden
Packit 7d1034
struct freebsd_pci_system {
Packit 7d1034
    /* This must be the first entry in the structure, as pci_system_cleanup()
Packit 7d1034
     * frees pci_sys.
Packit 7d1034
     */
Packit 7d1034
    struct pci_system pci_sys;
Packit 7d1034
Packit 7d1034
    int pcidev; /**< fd for /dev/pci */
Packit 7d1034
} *freebsd_pci_sys;
Packit 7d1034
Packit 7d1034
/**
Packit 7d1034
 * Map a memory region for a device using /dev/mem.
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
static int
Packit 7d1034
pci_device_freebsd_map_range(struct pci_device *dev,
Packit 7d1034
			     struct pci_device_mapping *map)
Packit 7d1034
{
Packit 7d1034
    const int prot = ((map->flags & PCI_DEV_MAP_FLAG_WRITABLE) != 0)
Packit 7d1034
        ? (PROT_READ | PROT_WRITE) : PROT_READ;
Packit 7d1034
    struct mem_range_desc mrd;
Packit 7d1034
    struct mem_range_op mro;
Packit 7d1034
Packit 7d1034
    int fd, err = 0;
Packit 7d1034
Packit 7d1034
    fd = open("/dev/mem", O_RDWR | 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, map->base);
Packit 7d1034
Packit 7d1034
    if (map->memory == MAP_FAILED) {
Packit 7d1034
	err = errno;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    mrd.mr_base = map->base;
Packit 7d1034
    mrd.mr_len = map->size;
Packit 7d1034
    strncpy(mrd.mr_owner, "pciaccess", sizeof(mrd.mr_owner));
Packit 7d1034
    if (map->flags & PCI_DEV_MAP_FLAG_CACHABLE)
Packit 7d1034
	mrd.mr_flags = MDF_WRITEBACK;
Packit 7d1034
    else if (map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE)
Packit 7d1034
	mrd.mr_flags = MDF_WRITECOMBINE;
Packit 7d1034
    else
Packit 7d1034
	mrd.mr_flags = MDF_UNCACHEABLE;
Packit 7d1034
    mro.mo_desc = &mr;;
Packit 7d1034
    mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
Packit 7d1034
Packit 7d1034
    /* No need to set an MTRR if it's the default mode. */
Packit 7d1034
    if (mrd.mr_flags != MDF_UNCACHEABLE) {
Packit 7d1034
	if (ioctl(fd, MEMRANGE_SET, &mro)) {
Packit 7d1034
	    fprintf(stderr, "failed to set mtrr: %s\n", strerror(errno));
Packit 7d1034
	}
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    close(fd);
Packit 7d1034
Packit 7d1034
    return err;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_unmap_range( struct pci_device *dev,
Packit 7d1034
				struct pci_device_mapping *map )
Packit 7d1034
{
Packit 7d1034
    struct mem_range_desc mrd;
Packit 7d1034
    struct mem_range_op mro;
Packit 7d1034
    int fd;
Packit 7d1034
Packit 7d1034
    if ((map->flags & PCI_DEV_MAP_FLAG_CACHABLE) ||
Packit 7d1034
	(map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE))
Packit 7d1034
    {
Packit 7d1034
	fd = open("/dev/mem", O_RDWR | O_CLOEXEC);
Packit 7d1034
	if (fd != -1) {
Packit 7d1034
	    mrd.mr_base = map->base;
Packit 7d1034
	    mrd.mr_len = map->size;
Packit 7d1034
	    strncpy(mrd.mr_owner, "pciaccess", sizeof(mrd.mr_owner));
Packit 7d1034
	    mrd.mr_flags = MDF_UNCACHEABLE;
Packit 7d1034
	    mro.mo_desc = &mr;;
Packit 7d1034
	    mro.mo_arg[0] = MEMRANGE_SET_REMOVE;
Packit 7d1034
Packit 7d1034
	    if (ioctl(fd, MEMRANGE_SET, &mro)) {
Packit 7d1034
		fprintf(stderr, "failed to unset mtrr: %s\n", strerror(errno));
Packit 7d1034
	    }
Packit 7d1034
Packit 7d1034
	    close(fd);
Packit 7d1034
	} else {
Packit 7d1034
	    fprintf(stderr, "Failed to open /dev/mem\n");
Packit 7d1034
	}
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return pci_device_generic_unmap_range(dev, map);
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_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
    struct pci_io io;
Packit 7d1034
Packit 7d1034
#if HAVE_PCI_IO_PC_DOMAIN
Packit 7d1034
    io.pi_sel.pc_domain = dev->domain;
Packit 7d1034
#endif
Packit 7d1034
    io.pi_sel.pc_bus = dev->bus;
Packit 7d1034
    io.pi_sel.pc_dev = dev->dev;
Packit 7d1034
    io.pi_sel.pc_func = dev->func;
Packit 7d1034
Packit 7d1034
    *bytes_read = 0;
Packit 7d1034
    while ( size > 0 ) {
Packit 7d1034
	int toread = (size < 4) ? size : 4;
Packit 7d1034
Packit 7d1034
	/* Only power of two allowed. */
Packit 7d1034
	if (toread == 3)
Packit 7d1034
	    toread = 2;
Packit 7d1034
Packit 7d1034
	io.pi_reg = offset;
Packit 7d1034
	io.pi_width = toread;
Packit 7d1034
Packit 7d1034
	if ( ioctl( freebsd_pci_sys->pcidev, PCIOCREAD, &io ) < 0 )
Packit 7d1034
	    return errno;
Packit 7d1034
Packit 7d1034
	memcpy(data, &io.pi_data, toread );
Packit 7d1034
Packit 7d1034
	offset += toread;
Packit 7d1034
	data = (char *)data + toread;
Packit 7d1034
	size -= toread;
Packit 7d1034
	*bytes_read += toread;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_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
    struct pci_io io;
Packit 7d1034
Packit 7d1034
#if HAVE_PCI_IO_PC_DOMAIN
Packit 7d1034
    io.pi_sel.pc_domain = dev->domain;
Packit 7d1034
#endif
Packit 7d1034
    io.pi_sel.pc_bus = dev->bus;
Packit 7d1034
    io.pi_sel.pc_dev = dev->dev;
Packit 7d1034
    io.pi_sel.pc_func = dev->func;
Packit 7d1034
Packit 7d1034
    *bytes_written = 0;
Packit 7d1034
    while ( size > 0 ) {
Packit 7d1034
	int towrite = (size < 4 ? size : 4);
Packit 7d1034
Packit 7d1034
	/* Only power of two allowed. */
Packit 7d1034
	if (towrite == 3)
Packit 7d1034
	    towrite = 2;
Packit 7d1034
Packit 7d1034
	io.pi_reg = offset;
Packit 7d1034
	io.pi_width = towrite;
Packit 7d1034
	memcpy( &io.pi_data, data, towrite );
Packit 7d1034
Packit 7d1034
	if ( ioctl( freebsd_pci_sys->pcidev, PCIOCWRITE, &io ) < 0 )
Packit 7d1034
	    return errno;
Packit 7d1034
Packit 7d1034
	offset += towrite;
Packit 7d1034
	data = (char *)data + towrite;
Packit 7d1034
	size -= towrite;
Packit 7d1034
	*bytes_written += towrite;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
/**
Packit 7d1034
 * Read a VGA rom using the 0xc0000 mapping.
Packit 7d1034
 *
Packit 7d1034
 * This function should be extended to handle access through PCI resources,
Packit 7d1034
 * which should be more reliable when available.
Packit 7d1034
 */
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_read_rom( struct pci_device * dev, void * buffer )
Packit 7d1034
{
Packit 7d1034
    struct pci_device_private *priv = (struct pci_device_private *) dev;
Packit 7d1034
    void *bios;
Packit 7d1034
    pciaddr_t rom_base;
Packit 7d1034
    uint32_t rom;
Packit 7d1034
    uint16_t reg;
Packit 7d1034
    int pci_rom, memfd;
Packit 7d1034
Packit 7d1034
    if ( ( dev->device_class & 0x00ffff00 ) !=
Packit 7d1034
	 ( ( PCIC_DISPLAY << 16 ) | ( PCIS_DISPLAY_VGA << 8 ) ) )
Packit 7d1034
    {
Packit 7d1034
	return ENOSYS;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    if (priv->rom_base == 0) {
Packit 7d1034
#if defined(__amd64__) || defined(__i386__)
Packit 7d1034
	rom_base = 0xc0000;
Packit 7d1034
	pci_rom = 0;
Packit 7d1034
#else
Packit 7d1034
	return ENOSYS;
Packit 7d1034
#endif
Packit 7d1034
    } else {
Packit 7d1034
	rom_base = priv->rom_base;
Packit 7d1034
	pci_rom = 1;
Packit 7d1034
Packit 7d1034
	pci_device_cfg_read_u16( dev, &reg, PCIR_COMMAND );
Packit 7d1034
	pci_device_cfg_write_u16( dev, reg | PCIM_CMD_MEMEN, PCIR_COMMAND );
Packit 7d1034
	pci_device_cfg_read_u32( dev, &rom, PCIR_BIOS );
Packit 7d1034
	pci_device_cfg_write_u32( dev, rom | PCIM_BIOS_ENABLE, PCIR_BIOS );
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    printf("Using rom_base = 0x%lx\n", (long)rom_base);
Packit 7d1034
    memfd = open( "/dev/mem", O_RDONLY | O_CLOEXEC );
Packit 7d1034
    if ( memfd == -1 )
Packit 7d1034
	return errno;
Packit 7d1034
Packit 7d1034
    bios = mmap( NULL, dev->rom_size, PROT_READ, 0, memfd, rom_base );
Packit 7d1034
    if ( bios == MAP_FAILED ) {
Packit 7d1034
	close( memfd );
Packit 7d1034
	return errno;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    memcpy( buffer, bios, dev->rom_size );
Packit 7d1034
Packit 7d1034
    munmap( bios, dev->rom_size );
Packit 7d1034
    close( memfd );
Packit 7d1034
Packit 7d1034
    if (pci_rom) {
Packit 7d1034
	pci_device_cfg_write_u32( dev, PCIR_BIOS, rom );
Packit 7d1034
	pci_device_cfg_write_u16( dev, PCIR_COMMAND, reg );
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
/** Returns the number of regions (base address registers) the device has */
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_get_num_regions( struct pci_device * dev )
Packit 7d1034
{
Packit 7d1034
    struct pci_device_private *priv = (struct pci_device_private *) dev;
Packit 7d1034
Packit 7d1034
    switch (priv->header_type) {
Packit 7d1034
    case 0:
Packit 7d1034
	return 6;
Packit 7d1034
    case 1:
Packit 7d1034
	return 2;
Packit 7d1034
    case 2:
Packit 7d1034
	return 1;
Packit 7d1034
    default:
Packit 7d1034
	printf("unknown header type %02x\n", priv->header_type);
Packit 7d1034
	return 0;
Packit 7d1034
    }
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
#ifdef PCIOCGETBAR
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_probe( struct pci_device * dev )
Packit 7d1034
{
Packit 7d1034
    struct pci_device_private *priv = (struct pci_device_private *) dev;
Packit 7d1034
    struct pci_bar_io bar;
Packit 7d1034
    uint8_t irq;
Packit 7d1034
    int err, i;
Packit 7d1034
Packit 7d1034
#if HAVE_PCI_IO_PC_DOMAIN
Packit 7d1034
    bar.pbi_sel.pc_domain = dev->domain;
Packit 7d1034
#endif
Packit 7d1034
    bar.pbi_sel.pc_bus = dev->bus;
Packit 7d1034
    bar.pbi_sel.pc_dev = dev->dev;
Packit 7d1034
    bar.pbi_sel.pc_func = dev->func;
Packit 7d1034
Packit 7d1034
Packit 7d1034
    /* Many of the fields were filled in during initial device enumeration.
Packit 7d1034
     * At this point, we need to fill in regions, rom_size, and irq.
Packit 7d1034
     */
Packit 7d1034
Packit 7d1034
    err = pci_device_cfg_read_u8( dev, &irq, 60 );
Packit 7d1034
    if (err)
Packit 7d1034
	return errno;
Packit 7d1034
    dev->irq = irq;
Packit 7d1034
Packit 7d1034
    for (i = 0; i < pci_device_freebsd_get_num_regions( dev ); i++) {
Packit 7d1034
	bar.pbi_reg = PCIR_BAR(i);
Packit 7d1034
	if ( ioctl( freebsd_pci_sys->pcidev, PCIOCGETBAR, &bar ) < 0 )
Packit 7d1034
	    continue;
Packit 7d1034
Packit 7d1034
	if (PCI_BAR_IO(bar.pbi_base))
Packit 7d1034
	    dev->regions[i].is_IO = 1;
Packit 7d1034
Packit 7d1034
	if ((bar.pbi_base & PCIM_BAR_MEM_TYPE) == PCIM_BAR_MEM_64)
Packit 7d1034
	    dev->regions[i].is_64 = 1;
Packit 7d1034
Packit 7d1034
	if (bar.pbi_base & PCIM_BAR_MEM_PREFETCH)
Packit 7d1034
	    dev->regions[i].is_prefetchable = 1;
Packit 7d1034
Packit 7d1034
	dev->regions[i].base_addr = bar.pbi_base & ~((uint64_t)0xf);
Packit 7d1034
	dev->regions[i].size = bar.pbi_length;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    /* If it's a VGA device, set up the rom size for read_rom using the
Packit 7d1034
     * 0xc0000 mapping.
Packit 7d1034
     */
Packit 7d1034
     if ((dev->device_class & 0x00ffff00) ==
Packit 7d1034
	((PCIC_DISPLAY << 16) | (PCIS_DISPLAY_VGA << 8))) {
Packit 7d1034
	     dev->rom_size = 64 * 1024;
Packit 7d1034
     }
Packit 7d1034
Packit 7d1034
     return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
#else
Packit 7d1034
Packit 7d1034
/** Masks out the flag bigs of the base address register value */
Packit 7d1034
static uint32_t
Packit 7d1034
get_map_base( uint32_t val )
Packit 7d1034
{
Packit 7d1034
    if (val & 0x01)
Packit 7d1034
	return val & ~0x03;
Packit 7d1034
    else
Packit 7d1034
	return val & ~0x0f;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
/** Returns the size of a region based on the all-ones test value */
Packit 7d1034
static int
Packit 7d1034
get_test_val_size( uint32_t testval )
Packit 7d1034
{
Packit 7d1034
    if (testval == 0)
Packit 7d1034
	return 0;
Packit 7d1034
Packit 7d1034
    /* Mask out the flag bits */
Packit 7d1034
    testval = get_map_base( testval );
Packit 7d1034
Packit 7d1034
    return 1 << (ffs(testval) - 1);
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
/**
Packit 7d1034
 * Sets the address and size information for the region from config space
Packit 7d1034
 * registers.
Packit 7d1034
 *
Packit 7d1034
 * This would be much better provided by a kernel interface.
Packit 7d1034
 *
Packit 7d1034
 * \return 0 on success, or an errno value.
Packit 7d1034
 */
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_get_region_info( struct pci_device * dev, int region,
Packit 7d1034
				    int bar )
Packit 7d1034
{
Packit 7d1034
    uint32_t addr, testval;
Packit 7d1034
    uint16_t cmd;
Packit 7d1034
    int err;
Packit 7d1034
Packit 7d1034
    /* Get the base address */
Packit 7d1034
    err = pci_device_cfg_read_u32( dev, &addr, bar );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
Packit 7d1034
    /*
Packit 7d1034
     * We are going to be doing evil things to the registers here
Packit 7d1034
     * so disable them via the command register first.
Packit 7d1034
     */
Packit 7d1034
    err = pci_device_cfg_read_u16( dev, &cmd, PCIR_COMMAND );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
Packit 7d1034
    err = pci_device_cfg_write_u16( dev,
Packit 7d1034
	cmd & ~(PCI_BAR_MEM(addr) ? PCIM_CMD_MEMEN : PCIM_CMD_PORTEN),
Packit 7d1034
	PCIR_COMMAND );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
Packit 7d1034
    /* Test write all ones to the register, then restore it. */
Packit 7d1034
    err = pci_device_cfg_write_u32( dev, 0xffffffff, bar );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
    err = pci_device_cfg_read_u32( dev, &testval, bar );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
    err = pci_device_cfg_write_u32( dev, addr, bar );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
Packit 7d1034
    /* Restore the command register */
Packit 7d1034
    err = pci_device_cfg_write_u16( dev, cmd, PCIR_COMMAND );
Packit 7d1034
    if (err != 0)
Packit 7d1034
	return err;
Packit 7d1034
Packit 7d1034
    if (addr & 0x01)
Packit 7d1034
	dev->regions[region].is_IO = 1;
Packit 7d1034
    if (addr & 0x04)
Packit 7d1034
	dev->regions[region].is_64 = 1;
Packit 7d1034
    if (addr & 0x08)
Packit 7d1034
	dev->regions[region].is_prefetchable = 1;
Packit 7d1034
Packit 7d1034
    /* Set the size */
Packit 7d1034
    dev->regions[region].size = get_test_val_size( testval );
Packit 7d1034
	printf("size = 0x%lx\n", (long)dev->regions[region].size);
Packit 7d1034
Packit 7d1034
    /* Set the base address value */
Packit 7d1034
    if (dev->regions[region].is_64) {
Packit 7d1034
	uint32_t top;
Packit 7d1034
Packit 7d1034
	err = pci_device_cfg_read_u32( dev, &top, bar + 4 );
Packit 7d1034
	if (err != 0)
Packit 7d1034
	    return err;
Packit 7d1034
Packit 7d1034
	dev->regions[region].base_addr = ((uint64_t)top << 32) |
Packit 7d1034
					  get_map_base(addr);
Packit 7d1034
    } else {
Packit 7d1034
	dev->regions[region].base_addr = get_map_base(addr);
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_probe( struct pci_device * dev )
Packit 7d1034
{
Packit 7d1034
    struct pci_device_private *priv = (struct pci_device_private *) dev;
Packit 7d1034
    uint32_t reg, size;
Packit 7d1034
    uint8_t irq;
Packit 7d1034
    int err, i, bar;
Packit 7d1034
Packit 7d1034
    /* Many of the fields were filled in during initial device enumeration.
Packit 7d1034
     * At this point, we need to fill in regions, rom_size, and irq.
Packit 7d1034
     */
Packit 7d1034
Packit 7d1034
    err = pci_device_cfg_read_u8( dev, &irq, 60 );
Packit 7d1034
    if (err)
Packit 7d1034
	return errno;
Packit 7d1034
    dev->irq = irq;
Packit 7d1034
Packit 7d1034
    bar = 0x10;
Packit 7d1034
    for (i = 0; i < pci_device_freebsd_get_num_regions( dev ); i++) {
Packit 7d1034
	pci_device_freebsd_get_region_info( dev, i, bar );
Packit 7d1034
	if (dev->regions[i].is_64) {
Packit 7d1034
	    bar += 0x08;
Packit 7d1034
	    i++;
Packit 7d1034
	} else
Packit 7d1034
	    bar += 0x04;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    /* If it's a VGA device, set up the rom size for read_rom */
Packit 7d1034
    if ((dev->device_class & 0x00ffff00) ==
Packit 7d1034
	((PCIC_DISPLAY << 16) | (PCIS_DISPLAY_VGA << 8)))
Packit 7d1034
    {
Packit 7d1034
	err = pci_device_cfg_read_u32( dev, &reg, PCIR_BIOS );
Packit 7d1034
	if (err)
Packit 7d1034
	    return errno;
Packit 7d1034
Packit 7d1034
	if (reg == 0) {
Packit 7d1034
	    dev->rom_size = 0x10000;
Packit 7d1034
	    return 0;
Packit 7d1034
	}
Packit 7d1034
Packit 7d1034
	err = pci_device_cfg_write_u32( dev, ~PCIM_BIOS_ENABLE, PCIR_BIOS );
Packit 7d1034
	if (err)
Packit 7d1034
	    return errno;
Packit 7d1034
	pci_device_cfg_read_u32( dev, &size, PCIR_BIOS );
Packit 7d1034
	pci_device_cfg_write_u32( dev, reg, PCIR_BIOS );
Packit 7d1034
Packit 7d1034
	if ((reg & PCIM_BIOS_ADDR_MASK) != 0) {
Packit 7d1034
	    priv->rom_base = (reg & PCIM_BIOS_ADDR_MASK);
Packit 7d1034
	    dev->rom_size = -(size & PCIM_BIOS_ADDR_MASK);
Packit 7d1034
	}
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
#endif
Packit 7d1034
Packit 7d1034
static void
Packit 7d1034
pci_system_freebsd_destroy(void)
Packit 7d1034
{
Packit 7d1034
    close(freebsd_pci_sys->pcidev);
Packit 7d1034
    free(freebsd_pci_sys->pci_sys.devices);
Packit 7d1034
    freebsd_pci_sys = NULL;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
#include <machine/cpufunc.h>
Packit 7d1034
#endif
Packit 7d1034
Packit 7d1034
static struct pci_io_handle *
Packit 7d1034
pci_device_freebsd_open_legacy_io(struct pci_io_handle *ret,
Packit 7d1034
    struct pci_device *dev, pciaddr_t base, pciaddr_t size)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	ret->fd = open("/dev/io", 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 = 1;
Packit 7d1034
	return ret;
Packit 7d1034
#elif defined(PCI_MAGIC_IO_RANGE)
Packit 7d1034
	ret->memory = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED,
Packit 7d1034
	    aperturefd, PCI_MAGIC_IO_RANGE + base);
Packit 7d1034
	if (ret->memory == MAP_FAILED)
Packit 7d1034
		return NULL;
Packit 7d1034
Packit 7d1034
	ret->base = base;
Packit 7d1034
	ret->size = size;
Packit 7d1034
	ret->is_legacy = 1;
Packit 7d1034
	return ret;
Packit 7d1034
#else
Packit 7d1034
	return NULL;
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
static void
Packit 7d1034
pci_device_freebsd_close_io(struct pci_device *dev, struct pci_io_handle *handle)
Packit 7d1034
{
Packit 7d1034
	if (handle->fd > -1)
Packit 7d1034
		close(handle->fd);
Packit 7d1034
}
Packit 7d1034
#endif
Packit 7d1034
Packit 7d1034
static uint32_t
Packit 7d1034
pci_device_freebsd_read32(struct pci_io_handle *handle, uint32_t reg)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	return inl(handle->base + reg);
Packit 7d1034
#else
Packit 7d1034
	return *(uint32_t *)((uintptr_t)handle->memory + reg);
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static uint16_t
Packit 7d1034
pci_device_freebsd_read16(struct pci_io_handle *handle, uint32_t reg)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	return inw(handle->base + reg);
Packit 7d1034
#else
Packit 7d1034
	return *(uint16_t *)((uintptr_t)handle->memory + reg);
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static uint8_t
Packit 7d1034
pci_device_freebsd_read8(struct pci_io_handle *handle, uint32_t reg)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	return inb(handle->base + reg);
Packit 7d1034
#else
Packit 7d1034
	return *(uint8_t *)((uintptr_t)handle->memory + reg);
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static void
Packit 7d1034
pci_device_freebsd_write32(struct pci_io_handle *handle, uint32_t reg,
Packit 7d1034
    uint32_t data)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	outl(handle->base + reg, data);
Packit 7d1034
#else
Packit 7d1034
	*(uint16_t *)((uintptr_t)handle->memory + reg) = data;
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static void
Packit 7d1034
pci_device_freebsd_write16(struct pci_io_handle *handle, uint32_t reg,
Packit 7d1034
    uint16_t data)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	outw(handle->base + reg, data);
Packit 7d1034
#else
Packit 7d1034
	*(uint8_t *)((uintptr_t)handle->memory + reg) = data;
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static void
Packit 7d1034
pci_device_freebsd_write8(struct pci_io_handle *handle, uint32_t reg,
Packit 7d1034
    uint8_t data)
Packit 7d1034
{
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
	outb(handle->base + reg, data);
Packit 7d1034
#else
Packit 7d1034
	*(uint32_t *)((uintptr_t)handle->memory + reg) = data;
Packit 7d1034
#endif
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_map_legacy(struct pci_device *dev, pciaddr_t base,
Packit 7d1034
    pciaddr_t size, unsigned map_flags, void **addr)
Packit 7d1034
{
Packit 7d1034
	struct pci_device_mapping map;
Packit 7d1034
	int err;
Packit 7d1034
Packit 7d1034
	map.base = base;
Packit 7d1034
	map.size = size;
Packit 7d1034
	map.flags = map_flags;
Packit 7d1034
	map.memory = NULL;
Packit 7d1034
	err = pci_device_freebsd_map_range(dev, &map);
Packit 7d1034
	*addr = map.memory;
Packit 7d1034
Packit 7d1034
	return err;
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static int
Packit 7d1034
pci_device_freebsd_unmap_legacy(struct pci_device *dev, void *addr,
Packit 7d1034
    pciaddr_t size)
Packit 7d1034
{
Packit 7d1034
	struct pci_device_mapping map;
Packit 7d1034
Packit 7d1034
	map.memory = addr;
Packit 7d1034
	map.size = size;
Packit 7d1034
	map.flags = 0;
Packit 7d1034
	return pci_device_freebsd_unmap_range(dev, &map);
Packit 7d1034
}
Packit 7d1034
Packit 7d1034
static const struct pci_system_methods freebsd_pci_methods = {
Packit 7d1034
    .destroy = pci_system_freebsd_destroy,
Packit 7d1034
    .destroy_device = NULL, /* nothing to do for this */
Packit 7d1034
    .read_rom = pci_device_freebsd_read_rom,
Packit 7d1034
    .probe = pci_device_freebsd_probe,
Packit 7d1034
    .map_range = pci_device_freebsd_map_range,
Packit 7d1034
    .unmap_range = pci_device_freebsd_unmap_range,
Packit 7d1034
    .read = pci_device_freebsd_read,
Packit 7d1034
    .write = pci_device_freebsd_write,
Packit 7d1034
    .fill_capabilities = pci_fill_capabilities_generic,
Packit 7d1034
    .open_legacy_io = pci_device_freebsd_open_legacy_io,
Packit 7d1034
#if defined(__i386__) || defined(__amd64__)
Packit 7d1034
    .close_io = pci_device_freebsd_close_io,
Packit 7d1034
#endif
Packit 7d1034
    .read32 = pci_device_freebsd_read32,
Packit 7d1034
    .read16 = pci_device_freebsd_read16,
Packit 7d1034
    .read8 = pci_device_freebsd_read8,
Packit 7d1034
    .write32 = pci_device_freebsd_write32,
Packit 7d1034
    .write16 = pci_device_freebsd_write16,
Packit 7d1034
    .write8 = pci_device_freebsd_write8,
Packit 7d1034
    .map_legacy = pci_device_freebsd_map_legacy,
Packit 7d1034
    .unmap_legacy = pci_device_freebsd_unmap_legacy,
Packit 7d1034
};
Packit 7d1034
Packit 7d1034
/**
Packit 7d1034
 * Attempt to access the FreeBSD PCI interface.
Packit 7d1034
 */
Packit 7d1034
_pci_hidden int
Packit 7d1034
pci_system_freebsd_create( void )
Packit 7d1034
{
Packit 7d1034
    struct pci_conf_io pciconfio;
Packit 7d1034
    struct pci_conf pciconf[255];
Packit 7d1034
    int pcidev;
Packit 7d1034
    int i;
Packit 7d1034
Packit 7d1034
    /* Try to open the PCI device */
Packit 7d1034
    pcidev = open( "/dev/pci", O_RDWR | O_CLOEXEC );
Packit 7d1034
    if ( pcidev == -1 )
Packit 7d1034
	return ENXIO;
Packit 7d1034
Packit 7d1034
    freebsd_pci_sys = calloc( 1, sizeof( struct freebsd_pci_system ) );
Packit 7d1034
    if ( freebsd_pci_sys == NULL ) {
Packit 7d1034
	close( pcidev );
Packit 7d1034
	return ENOMEM;
Packit 7d1034
    }
Packit 7d1034
    pci_sys = &freebsd_pci_sys->pci_sys;
Packit 7d1034
Packit 7d1034
    pci_sys->methods = & freebsd_pci_methods;
Packit 7d1034
    freebsd_pci_sys->pcidev = pcidev;
Packit 7d1034
Packit 7d1034
    /* Probe the list of devices known by the system */
Packit 7d1034
    bzero( &pciconfio, sizeof( struct pci_conf_io ) );
Packit 7d1034
    pciconfio.match_buf_len = sizeof(pciconf);
Packit 7d1034
    pciconfio.matches = pciconf;
Packit 7d1034
Packit 7d1034
    if ( ioctl( pcidev, PCIOCGETCONF, &pciconfio ) == -1) {
Packit 7d1034
	free( pci_sys );
Packit 7d1034
	close( pcidev );
Packit 7d1034
	return errno;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    if (pciconfio.status == PCI_GETCONF_ERROR ) {
Packit 7d1034
	free( pci_sys );
Packit 7d1034
	close( pcidev );
Packit 7d1034
	return EINVAL;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    /* Translate the list of devices into pciaccess's format. */
Packit 7d1034
    pci_sys->num_devices = pciconfio.num_matches;
Packit 7d1034
    pci_sys->devices = calloc( pciconfio.num_matches,
Packit 7d1034
			       sizeof( struct pci_device_private ) );
Packit 7d1034
Packit 7d1034
    for ( i = 0; i < pciconfio.num_matches; i++ ) {
Packit 7d1034
	struct pci_conf *p = &pciconf[ i ];
Packit 7d1034
Packit 7d1034
#if HAVE_PCI_IO_PC_DOMAIN
Packit 7d1034
	pci_sys->devices[ i ].base.domain = p->pc_sel.pc_domain;
Packit 7d1034
#else
Packit 7d1034
	pci_sys->devices[ i ].base.domain = 0;
Packit 7d1034
#endif
Packit 7d1034
	pci_sys->devices[ i ].base.bus = p->pc_sel.pc_bus;
Packit 7d1034
	pci_sys->devices[ i ].base.dev = p->pc_sel.pc_dev;
Packit 7d1034
	pci_sys->devices[ i ].base.func = p->pc_sel.pc_func;
Packit 7d1034
	pci_sys->devices[ i ].base.vendor_id = p->pc_vendor;
Packit 7d1034
	pci_sys->devices[ i ].base.device_id = p->pc_device;
Packit 7d1034
	pci_sys->devices[ i ].base.subvendor_id = p->pc_subvendor;
Packit 7d1034
	pci_sys->devices[ i ].base.subdevice_id = p->pc_subdevice;
Packit 7d1034
	pci_sys->devices[ i ].base.revision = p->pc_revid;
Packit 7d1034
	pci_sys->devices[ i ].base.device_class = (uint32_t)p->pc_class << 16 |
Packit 7d1034
	    (uint32_t)p->pc_subclass << 8 | (uint32_t)p->pc_progif;
Packit 7d1034
	pci_sys->devices[ i ].header_type = p->pc_hdr & 0x7f;
Packit 7d1034
    }
Packit 7d1034
Packit 7d1034
    return 0;
Packit 7d1034
}