|
Packit |
7d1034 |
/*
|
|
Packit |
7d1034 |
* Copyright (c) 2008, 2011 Mark Kettenis
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* Permission to use, copy, modify, and distribute this software for any
|
|
Packit |
7d1034 |
* purpose with or without fee is hereby granted, provided that the above
|
|
Packit |
7d1034 |
* copyright notice and this permission notice appear in all copies.
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
Packit |
7d1034 |
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
Packit |
7d1034 |
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
Packit |
7d1034 |
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
Packit |
7d1034 |
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
Packit |
7d1034 |
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
Packit |
7d1034 |
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
#ifdef HAVE_CONFIG_H
|
|
Packit |
7d1034 |
#include "config.h"
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include <sys/param.h>
|
|
Packit |
7d1034 |
#include <sys/ioctl.h>
|
|
Packit |
7d1034 |
#include <sys/memrange.h>
|
|
Packit |
7d1034 |
#include <sys/mman.h>
|
|
Packit |
7d1034 |
#include <sys/pciio.h>
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include <dev/pci/pcireg.h>
|
|
Packit |
7d1034 |
#include <dev/pci/pcidevs.h>
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include <errno.h>
|
|
Packit |
7d1034 |
#include <fcntl.h>
|
|
Packit |
7d1034 |
#include <stdio.h>
|
|
Packit |
7d1034 |
#include <stdlib.h>
|
|
Packit |
7d1034 |
#include <string.h>
|
|
Packit |
7d1034 |
#include <unistd.h>
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#include "pciaccess.h"
|
|
Packit |
7d1034 |
#include "pciaccess_private.h"
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/*
|
|
Packit |
7d1034 |
* This should allow for 16 domains, which should cover everything
|
|
Packit |
7d1034 |
* except perhaps the really big fridge-sized sparc64 server machines
|
|
Packit |
7d1034 |
* that are unlikely to have any graphics hardware in them.
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
static int pcifd[16];
|
|
Packit |
7d1034 |
static int ndomains;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int aperturefd = -1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_read(int domain, int bus, int dev, int func, uint32_t reg, uint32_t *val)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_io io;
|
|
Packit |
7d1034 |
int err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bzero(&io, sizeof(io));
|
|
Packit |
7d1034 |
io.pi_sel.pc_bus = bus;
|
|
Packit |
7d1034 |
io.pi_sel.pc_dev = dev;
|
|
Packit |
7d1034 |
io.pi_sel.pc_func = func;
|
|
Packit |
7d1034 |
io.pi_reg = reg;
|
|
Packit |
7d1034 |
io.pi_width = 4;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = ioctl(pcifd[domain], PCIOCREAD, &io);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return (err);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
*val = io.pi_data;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_write(int domain, int bus, int dev, int func, uint32_t reg, uint32_t val)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_io io;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bzero(&io, sizeof(io));
|
|
Packit |
7d1034 |
io.pi_sel.pc_bus = bus;
|
|
Packit |
7d1034 |
io.pi_sel.pc_dev = dev;
|
|
Packit |
7d1034 |
io.pi_sel.pc_func = func;
|
|
Packit |
7d1034 |
io.pi_reg = reg;
|
|
Packit |
7d1034 |
io.pi_width = 4;
|
|
Packit |
7d1034 |
io.pi_data = val;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return ioctl(pcifd[domain], PCIOCWRITE, &io);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_readmask(int domain, int bus, int dev, int func, uint32_t reg,
|
|
Packit |
7d1034 |
uint32_t *val)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_io io;
|
|
Packit |
7d1034 |
int err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bzero(&io, sizeof(io));
|
|
Packit |
7d1034 |
io.pi_sel.pc_bus = bus;
|
|
Packit |
7d1034 |
io.pi_sel.pc_dev = dev;
|
|
Packit |
7d1034 |
io.pi_sel.pc_func = func;
|
|
Packit |
7d1034 |
io.pi_reg = reg;
|
|
Packit |
7d1034 |
io.pi_width = 4;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = ioctl(pcifd[domain], PCIOCREADMASK, &io);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return (err);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
*val = io.pi_data;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/**
|
|
Packit |
7d1034 |
* Read a VGA ROM
|
|
Packit |
7d1034 |
*
|
|
Packit |
7d1034 |
*/
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_read_rom(struct pci_device *device, void *buffer)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device_private *priv = (struct pci_device_private *)device;
|
|
Packit |
7d1034 |
unsigned char *bios;
|
|
Packit |
7d1034 |
pciaddr_t rom_base;
|
|
Packit |
7d1034 |
pciaddr_t rom_size;
|
|
Packit |
7d1034 |
u_int32_t csr, rom;
|
|
Packit |
7d1034 |
int pci_rom, domain, bus, dev, func;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
domain = device->domain;
|
|
Packit |
7d1034 |
if (domain < 0 || domain >= ndomains)
|
|
Packit |
7d1034 |
return ENXIO;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bus = device->bus;
|
|
Packit |
7d1034 |
dev = device->dev;
|
|
Packit |
7d1034 |
func = device->func;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (aperturefd == -1)
|
|
Packit |
7d1034 |
return ENOSYS;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (priv->base.rom_size == 0) {
|
|
Packit |
7d1034 |
#if defined(__alpha__) || defined(__amd64__) || defined(__i386__)
|
|
Packit |
7d1034 |
if ((device->device_class & 0x00ffff00) ==
|
|
Packit |
7d1034 |
((PCI_CLASS_DISPLAY << 16) |
|
|
Packit |
7d1034 |
(PCI_SUBCLASS_DISPLAY_VGA << 8))) {
|
|
Packit |
7d1034 |
rom_base = 0xc0000;
|
|
Packit |
7d1034 |
rom_size = 0x10000;
|
|
Packit |
7d1034 |
pci_rom = 0;
|
|
Packit |
7d1034 |
} else
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
return ENOSYS;
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
rom_base = priv->rom_base;
|
|
Packit |
7d1034 |
rom_size = priv->base.rom_size;
|
|
Packit |
7d1034 |
pci_rom = 1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pci_read(domain, bus, dev, func, PCI_COMMAND_STATUS_REG, &csr;;
|
|
Packit |
7d1034 |
pci_write(domain, bus, dev, func, PCI_COMMAND_STATUS_REG,
|
|
Packit |
7d1034 |
csr | PCI_COMMAND_MEM_ENABLE);
|
|
Packit |
7d1034 |
pci_read(domain, bus, dev, func, PCI_ROM_REG, &rom;;
|
|
Packit |
7d1034 |
pci_write(domain, bus, dev, func, PCI_ROM_REG,
|
|
Packit |
7d1034 |
rom | PCI_ROM_ENABLE);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bios = mmap(NULL, rom_size, PROT_READ, MAP_SHARED,
|
|
Packit |
7d1034 |
aperturefd, (off_t)rom_base);
|
|
Packit |
7d1034 |
if (bios == MAP_FAILED)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
memcpy(buffer, bios, rom_size);
|
|
Packit |
7d1034 |
munmap(bios, rom_size);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_rom) {
|
|
Packit |
7d1034 |
/* Restore PCI config space */
|
|
Packit |
7d1034 |
pci_write(domain, bus, dev, func, PCI_ROM_REG, rom);
|
|
Packit |
7d1034 |
pci_write(domain, bus, dev, func, PCI_COMMAND_STATUS_REG, csr);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_nfuncs(int domain, int bus, int dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
uint32_t hdr;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (domain < 0 || domain >= ndomains)
|
|
Packit |
7d1034 |
return ENXIO;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_read(domain, bus, dev, 0, PCI_BHLC_REG, &hdr) != 0)
|
|
Packit |
7d1034 |
return -1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return (PCI_HDRTYPE_MULTIFN(hdr) ? 8 : 1);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_map_range(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_device_mapping *map)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct mem_range_desc mr;
|
|
Packit |
7d1034 |
struct mem_range_op mo;
|
|
Packit |
7d1034 |
int prot = PROT_READ;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (map->flags & PCI_DEV_MAP_FLAG_WRITABLE)
|
|
Packit |
7d1034 |
prot |= PROT_WRITE;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
map->memory = mmap(NULL, map->size, prot, MAP_SHARED, aperturefd,
|
|
Packit |
7d1034 |
map->base);
|
|
Packit |
7d1034 |
if (map->memory == MAP_FAILED)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
#if defined(__i386__) || defined(__amd64__)
|
|
Packit |
7d1034 |
/* No need to set an MTRR if it's the default mode. */
|
|
Packit |
7d1034 |
if ((map->flags & PCI_DEV_MAP_FLAG_CACHABLE) ||
|
|
Packit |
7d1034 |
(map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE)) {
|
|
Packit |
7d1034 |
mr.mr_base = map->base;
|
|
Packit |
7d1034 |
mr.mr_len = map->size;
|
|
Packit |
7d1034 |
mr.mr_flags = 0;
|
|
Packit |
7d1034 |
if (map->flags & PCI_DEV_MAP_FLAG_CACHABLE)
|
|
Packit |
7d1034 |
mr.mr_flags |= MDF_WRITEBACK;
|
|
Packit |
7d1034 |
if (map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE)
|
|
Packit |
7d1034 |
mr.mr_flags |= MDF_WRITECOMBINE;
|
|
Packit |
7d1034 |
strlcpy(mr.mr_owner, "pciaccess", sizeof(mr.mr_owner));
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
mo.mo_desc = &mr;
|
|
Packit |
7d1034 |
mo.mo_arg[0] = MEMRANGE_SET_UPDATE;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ioctl(aperturefd, MEMRANGE_SET, &mo))
|
|
Packit |
7d1034 |
(void)fprintf(stderr, "mtrr set failed: %s\n",
|
|
Packit |
7d1034 |
strerror(errno));
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_unmap_range(struct pci_device *dev,
|
|
Packit |
7d1034 |
struct pci_device_mapping *map)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
#if defined(__i386__) || defined(__amd64__)
|
|
Packit |
7d1034 |
struct mem_range_desc mr;
|
|
Packit |
7d1034 |
struct mem_range_op mo;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ((map->flags & PCI_DEV_MAP_FLAG_CACHABLE) ||
|
|
Packit |
7d1034 |
(map->flags & PCI_DEV_MAP_FLAG_WRITE_COMBINE)) {
|
|
Packit |
7d1034 |
mr.mr_base = map->base;
|
|
Packit |
7d1034 |
mr.mr_len = map->size;
|
|
Packit |
7d1034 |
mr.mr_flags = MDF_UNCACHEABLE;
|
|
Packit |
7d1034 |
strlcpy(mr.mr_owner, "pciaccess", sizeof(mr.mr_owner));
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
mo.mo_desc = &mr;
|
|
Packit |
7d1034 |
mo.mo_arg[0] = MEMRANGE_SET_REMOVE;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
(void)ioctl(aperturefd, MEMRANGE_SET, &mo);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
return pci_device_generic_unmap_range(dev, map);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_read(struct pci_device *dev, void *data,
|
|
Packit |
7d1034 |
pciaddr_t offset, pciaddr_t size, pciaddr_t *bytes_read)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_io io;
|
|
Packit |
7d1034 |
|
|
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 = MIN(size, 4 - (offset & 0x3));
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
io.pi_reg = (offset & ~0x3);
|
|
Packit |
7d1034 |
io.pi_width = 4;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ioctl(pcifd[dev->domain], PCIOCREAD, &io) == -1)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
io.pi_data = htole32(io.pi_data);
|
|
Packit |
7d1034 |
io.pi_data >>= ((offset & 0x3) * 8);
|
|
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 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_write(struct pci_device *dev, const void *data,
|
|
Packit |
7d1034 |
pciaddr_t offset, pciaddr_t size, pciaddr_t *bytes_written)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_io io;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if ((offset % 4) != 0 || (size % 4) != 0)
|
|
Packit |
7d1034 |
return EINVAL;
|
|
Packit |
7d1034 |
|
|
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 |
io.pi_reg = offset;
|
|
Packit |
7d1034 |
io.pi_width = 4;
|
|
Packit |
7d1034 |
memcpy(&io.pi_data, data, 4);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ioctl(pcifd[dev->domain], PCIOCWRITE, &io) == -1)
|
|
Packit |
7d1034 |
return errno;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
offset += 4;
|
|
Packit |
7d1034 |
data = (char *)data + 4;
|
|
Packit |
7d1034 |
size -= 4;
|
|
Packit |
7d1034 |
*bytes_written += 4;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static void
|
|
Packit |
7d1034 |
pci_system_openbsd_destroy(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
int domain;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
for (domain = 0; domain < ndomains; domain++)
|
|
Packit |
7d1034 |
close(pcifd[domain]);
|
|
Packit |
7d1034 |
ndomains = 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static int
|
|
Packit |
7d1034 |
pci_device_openbsd_probe(struct pci_device *device)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device_private *priv = (struct pci_device_private *)device;
|
|
Packit |
7d1034 |
struct pci_mem_region *region;
|
|
Packit |
7d1034 |
uint64_t reg64, size64;
|
|
Packit |
7d1034 |
uint32_t bar, reg, size;
|
|
Packit |
7d1034 |
int domain, bus, dev, func, err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
domain = device->domain;
|
|
Packit |
7d1034 |
bus = device->bus;
|
|
Packit |
7d1034 |
dev = device->dev;
|
|
Packit |
7d1034 |
func = device->func;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_read(domain, bus, dev, func, PCI_BHLC_REG, ®);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
priv->header_type = PCI_HDRTYPE_TYPE(reg);
|
|
Packit |
7d1034 |
if (priv->header_type != 0)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
region = device->regions;
|
|
Packit |
7d1034 |
for (bar = PCI_MAPREG_START; bar < PCI_MAPREG_END;
|
|
Packit |
7d1034 |
bar += sizeof(uint32_t), region++) {
|
|
Packit |
7d1034 |
err = pci_read(domain, bus, dev, func, bar, ®);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* Probe the size of the region. */
|
|
Packit |
7d1034 |
err = pci_readmask(domain, bus, dev, func, bar, &size);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (PCI_MAPREG_TYPE(reg) == PCI_MAPREG_TYPE_IO) {
|
|
Packit |
7d1034 |
region->is_IO = 1;
|
|
Packit |
7d1034 |
region->base_addr = PCI_MAPREG_IO_ADDR(reg);
|
|
Packit |
7d1034 |
region->size = PCI_MAPREG_IO_SIZE(size);
|
|
Packit |
7d1034 |
} else {
|
|
Packit |
7d1034 |
if (PCI_MAPREG_MEM_PREFETCHABLE(reg))
|
|
Packit |
7d1034 |
region->is_prefetchable = 1;
|
|
Packit |
7d1034 |
switch(PCI_MAPREG_MEM_TYPE(reg)) {
|
|
Packit |
7d1034 |
case PCI_MAPREG_MEM_TYPE_32BIT:
|
|
Packit |
7d1034 |
case PCI_MAPREG_MEM_TYPE_32BIT_1M:
|
|
Packit |
7d1034 |
region->base_addr = PCI_MAPREG_MEM_ADDR(reg);
|
|
Packit |
7d1034 |
region->size = PCI_MAPREG_MEM_SIZE(size);
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
case PCI_MAPREG_MEM_TYPE_64BIT:
|
|
Packit |
7d1034 |
region->is_64 = 1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
reg64 = reg;
|
|
Packit |
7d1034 |
size64 = size;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
bar += sizeof(uint32_t);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_read(domain, bus, dev, func, bar, ®);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
reg64 |= (uint64_t)reg << 32;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
err = pci_readmask(domain, bus, dev, func, bar, &size);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
size64 |= (uint64_t)size << 32;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
region->base_addr = PCI_MAPREG_MEM64_ADDR(reg64);
|
|
Packit |
7d1034 |
region->size = PCI_MAPREG_MEM64_SIZE(size64);
|
|
Packit |
7d1034 |
region++;
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* Probe expansion ROM if present */
|
|
Packit |
7d1034 |
err = pci_read(domain, bus, dev, func, PCI_ROM_REG, ®);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
if (reg != 0) {
|
|
Packit |
7d1034 |
err = pci_write(domain, bus, dev, func, PCI_ROM_REG, ~PCI_ROM_ENABLE);
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
pci_read(domain, bus, dev, func, PCI_ROM_REG, &size);
|
|
Packit |
7d1034 |
pci_write(domain, bus, dev, func, PCI_ROM_REG, reg);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (PCI_ROM_ADDR(reg) != 0) {
|
|
Packit |
7d1034 |
priv->rom_base = PCI_ROM_ADDR(reg);
|
|
Packit |
7d1034 |
device->rom_size = PCI_ROM_SIZE(size);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#if defined(__i386__) || defined(__amd64__)
|
|
Packit |
7d1034 |
#include <machine/sysarch.h>
|
|
Packit |
7d1034 |
#include <machine/pio.h>
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static struct pci_io_handle *
|
|
Packit |
7d1034 |
pci_device_openbsd_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__)
|
|
Packit |
7d1034 |
struct i386_iopl_args ia;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ia.iopl = 1;
|
|
Packit |
7d1034 |
if (sysarch(I386_IOPL, &ia))
|
|
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(__amd64__)
|
|
Packit |
7d1034 |
struct amd64_iopl_args ia;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ia.iopl = 1;
|
|
Packit |
7d1034 |
if (sysarch(AMD64_IOPL, &ia))
|
|
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 |
static uint32_t
|
|
Packit |
7d1034 |
pci_device_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_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_openbsd_unmap_range(dev, &map);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
static const struct pci_system_methods openbsd_pci_methods = {
|
|
Packit |
7d1034 |
pci_system_openbsd_destroy,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
pci_device_openbsd_read_rom,
|
|
Packit |
7d1034 |
pci_device_openbsd_probe,
|
|
Packit |
7d1034 |
pci_device_openbsd_map_range,
|
|
Packit |
7d1034 |
pci_device_openbsd_unmap_range,
|
|
Packit |
7d1034 |
pci_device_openbsd_read,
|
|
Packit |
7d1034 |
pci_device_openbsd_write,
|
|
Packit |
7d1034 |
pci_fill_capabilities_generic,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
pci_device_openbsd_open_legacy_io,
|
|
Packit |
7d1034 |
NULL,
|
|
Packit |
7d1034 |
pci_device_openbsd_read32,
|
|
Packit |
7d1034 |
pci_device_openbsd_read16,
|
|
Packit |
7d1034 |
pci_device_openbsd_read8,
|
|
Packit |
7d1034 |
pci_device_openbsd_write32,
|
|
Packit |
7d1034 |
pci_device_openbsd_write16,
|
|
Packit |
7d1034 |
pci_device_openbsd_write8,
|
|
Packit |
7d1034 |
pci_device_openbsd_map_legacy,
|
|
Packit |
7d1034 |
pci_device_openbsd_unmap_legacy
|
|
Packit |
7d1034 |
};
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_system_openbsd_create(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device_private *device;
|
|
Packit |
7d1034 |
int domain, bus, dev, func, ndevs, nfuncs;
|
|
Packit |
7d1034 |
char path[MAXPATHLEN];
|
|
Packit |
7d1034 |
uint32_t reg;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ndomains > 0)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
for (domain = 0; domain < sizeof(pcifd) / sizeof(pcifd[0]); domain++) {
|
|
Packit |
7d1034 |
snprintf(path, sizeof(path), "/dev/pci%d", domain);
|
|
Packit |
7d1034 |
pcifd[domain] = open(path, O_RDWR | O_CLOEXEC);
|
|
Packit |
7d1034 |
if (pcifd[domain] == -1)
|
|
Packit |
7d1034 |
break;
|
|
Packit |
7d1034 |
ndomains++;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (ndomains == 0)
|
|
Packit |
7d1034 |
return ENXIO;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pci_sys = calloc(1, sizeof(struct pci_system));
|
|
Packit |
7d1034 |
if (pci_sys == NULL) {
|
|
Packit |
7d1034 |
for (domain = 0; domain < ndomains; domain++)
|
|
Packit |
7d1034 |
close(pcifd[domain]);
|
|
Packit |
7d1034 |
ndomains = 0;
|
|
Packit |
7d1034 |
return ENOMEM;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pci_sys->methods = &openbsd_pci_methods;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ndevs = 0;
|
|
Packit |
7d1034 |
for (domain = 0; domain < ndomains; domain++) {
|
|
Packit |
7d1034 |
for (bus = 0; bus < 256; bus++) {
|
|
Packit |
7d1034 |
for (dev = 0; dev < 32; dev++) {
|
|
Packit |
7d1034 |
nfuncs = pci_nfuncs(domain, bus, dev);
|
|
Packit |
7d1034 |
for (func = 0; func < nfuncs; func++) {
|
|
Packit |
7d1034 |
if (pci_read(domain, bus, dev, func,
|
|
Packit |
7d1034 |
PCI_ID_REG, ®) != 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID ||
|
|
Packit |
7d1034 |
PCI_VENDOR(reg) == 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
ndevs++;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pci_sys->num_devices = ndevs;
|
|
Packit |
7d1034 |
pci_sys->devices = calloc(ndevs, sizeof(struct pci_device_private));
|
|
Packit |
7d1034 |
if (pci_sys->devices == NULL) {
|
|
Packit |
7d1034 |
free(pci_sys);
|
|
Packit |
7d1034 |
pci_sys = NULL;
|
|
Packit |
7d1034 |
for (domain = 0; domain < ndomains; domain++)
|
|
Packit |
7d1034 |
close(pcifd[domain]);
|
|
Packit |
7d1034 |
ndomains = 0;
|
|
Packit |
7d1034 |
return ENOMEM;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device = pci_sys->devices;
|
|
Packit |
7d1034 |
for (domain = 0; domain < ndomains; domain++) {
|
|
Packit |
7d1034 |
for (bus = 0; bus < 256; bus++) {
|
|
Packit |
7d1034 |
for (dev = 0; dev < 32; dev++) {
|
|
Packit |
7d1034 |
nfuncs = pci_nfuncs(domain, bus, dev);
|
|
Packit |
7d1034 |
for (func = 0; func < nfuncs; func++) {
|
|
Packit |
7d1034 |
if (pci_read(domain, bus, dev, func,
|
|
Packit |
7d1034 |
PCI_ID_REG, ®) != 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID ||
|
|
Packit |
7d1034 |
PCI_VENDOR(reg) == 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device->base.domain = domain;
|
|
Packit |
7d1034 |
if (domain > 0xffff)
|
|
Packit |
7d1034 |
device->base.domain_16 = 0xffff;
|
|
Packit |
7d1034 |
else
|
|
Packit |
7d1034 |
device->base.domain_16 = domain & 0xffff;
|
|
Packit |
7d1034 |
device->base.bus = bus;
|
|
Packit |
7d1034 |
device->base.dev = dev;
|
|
Packit |
7d1034 |
device->base.func = func;
|
|
Packit |
7d1034 |
device->base.vendor_id = PCI_VENDOR(reg);
|
|
Packit |
7d1034 |
device->base.device_id = PCI_PRODUCT(reg);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_read(domain, bus, dev, func,
|
|
Packit |
7d1034 |
PCI_CLASS_REG, ®) != 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device->base.device_class =
|
|
Packit |
7d1034 |
PCI_INTERFACE(reg) |
|
|
Packit |
7d1034 |
PCI_CLASS(reg) << 16 |
|
|
Packit |
7d1034 |
PCI_SUBCLASS(reg) << 8;
|
|
Packit |
7d1034 |
device->base.revision = PCI_REVISION(reg);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_read(domain, bus, dev, func,
|
|
Packit |
7d1034 |
PCI_SUBVEND_0, ®) != 0)
|
|
Packit |
7d1034 |
continue;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device->base.subvendor_id = PCI_VENDOR(reg);
|
|
Packit |
7d1034 |
device->base.subdevice_id = PCI_PRODUCT(reg);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device->base.vgaarb_rsrc =
|
|
Packit |
7d1034 |
VGA_ARB_RSRC_LEGACY_IO |
|
|
Packit |
7d1034 |
VGA_ARB_RSRC_LEGACY_MEM;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
device++;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
void
|
|
Packit |
7d1034 |
pci_system_openbsd_init_dev_mem(int fd)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
aperturefd = fd;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_init(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device *dev = pci_sys->vga_target;
|
|
Packit |
7d1034 |
struct pci_device_iterator *iter;
|
|
Packit |
7d1034 |
struct pci_id_match vga_match = {
|
|
Packit |
7d1034 |
PCI_MATCH_ANY, PCI_MATCH_ANY, PCI_MATCH_ANY, PCI_MATCH_ANY,
|
|
Packit |
7d1034 |
(PCI_CLASS_DISPLAY << 16) | (PCI_SUBCLASS_DISPLAY_VGA << 8),
|
|
Packit |
7d1034 |
0x00ffff00
|
|
Packit |
7d1034 |
};
|
|
Packit |
7d1034 |
struct pci_vga pv;
|
|
Packit |
7d1034 |
int err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pv.pv_sel.pc_bus = 0;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_dev = 0;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_func = 0;
|
|
Packit |
7d1034 |
err = ioctl(pcifd[0], PCIOCGETVGA, &pv;;
|
|
Packit |
7d1034 |
if (err)
|
|
Packit |
7d1034 |
return err;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pci_sys->vga_target = pci_device_find_by_slot(0, pv.pv_sel.pc_bus,
|
|
Packit |
7d1034 |
pv.pv_sel.pc_dev, pv.pv_sel.pc_func);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
/* Count the number of VGA devices in domain 0. */
|
|
Packit |
7d1034 |
iter = pci_id_match_iterator_create(&vga_match);
|
|
Packit |
7d1034 |
if (iter == NULL)
|
|
Packit |
7d1034 |
return -1;
|
|
Packit |
7d1034 |
pci_sys->vga_count = 0;
|
|
Packit |
7d1034 |
while ((dev = pci_device_next(iter)) != NULL) {
|
|
Packit |
7d1034 |
if (dev->domain == 0)
|
|
Packit |
7d1034 |
pci_sys->vga_count++;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
pci_iterator_destroy(iter);
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
void
|
|
Packit |
7d1034 |
pci_device_vgaarb_fini(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device *dev;
|
|
Packit |
7d1034 |
struct pci_vga pv;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (pci_sys == NULL)
|
|
Packit |
7d1034 |
return;
|
|
Packit |
7d1034 |
dev = pci_sys->vga_target;
|
|
Packit |
7d1034 |
if (dev == NULL)
|
|
Packit |
7d1034 |
return;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pv.pv_sel.pc_bus = dev->bus;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_dev = dev->dev;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_func = dev->func;
|
|
Packit |
7d1034 |
pv.pv_lock = PCI_VGA_UNLOCK;
|
|
Packit |
7d1034 |
ioctl(pcifd[dev->domain], PCIOCSETVGA, &pv;;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_set_target(struct pci_device *dev)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
pci_sys->vga_target = dev;
|
|
Packit |
7d1034 |
return (0);
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_lock(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device *dev = pci_sys->vga_target;
|
|
Packit |
7d1034 |
struct pci_vga pv;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (dev == NULL)
|
|
Packit |
7d1034 |
return -1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#if 0
|
|
Packit |
7d1034 |
if (dev->vgaarb_rsrc == 0 || pci_sys->vga_count == 1)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
#else
|
|
Packit |
7d1034 |
if (pci_sys->vga_count == 1)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pv.pv_sel.pc_bus = dev->bus;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_dev = dev->dev;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_func = dev->func;
|
|
Packit |
7d1034 |
pv.pv_lock = PCI_VGA_LOCK;
|
|
Packit |
7d1034 |
return ioctl(pcifd[dev->domain], PCIOCSETVGA, &pv;;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_unlock(void)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device *dev = pci_sys->vga_target;
|
|
Packit |
7d1034 |
struct pci_vga pv;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (dev == NULL)
|
|
Packit |
7d1034 |
return -1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
#if 0
|
|
Packit |
7d1034 |
if (dev->vgaarb_rsrc == 0 || pci_sys->vga_count == 1)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
#else
|
|
Packit |
7d1034 |
if (pci_sys->vga_count == 1)
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
#endif
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
pv.pv_sel.pc_bus = dev->bus;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_dev = dev->dev;
|
|
Packit |
7d1034 |
pv.pv_sel.pc_func = dev->func;
|
|
Packit |
7d1034 |
pv.pv_lock = PCI_VGA_UNLOCK;
|
|
Packit |
7d1034 |
return ioctl(pcifd[dev->domain], PCIOCSETVGA, &pv;;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_get_info(struct pci_device *dev, int *vga_count,
|
|
Packit |
7d1034 |
int *rsrc_decodes)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
*vga_count = pci_sys->vga_count;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (dev)
|
|
Packit |
7d1034 |
*rsrc_decodes = dev->vgaarb_rsrc;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
int
|
|
Packit |
7d1034 |
pci_device_vgaarb_decodes(int rsrc_decodes)
|
|
Packit |
7d1034 |
{
|
|
Packit |
7d1034 |
struct pci_device *dev = pci_sys->vga_target;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
if (dev == NULL)
|
|
Packit |
7d1034 |
return -1;
|
|
Packit |
7d1034 |
|
|
Packit |
7d1034 |
dev->vgaarb_rsrc = rsrc_decodes;
|
|
Packit |
7d1034 |
return 0;
|
|
Packit |
7d1034 |
}
|