diff options
| -rw-r--r-- | src/openbsd_pci.c | 153 | ||||
| -rw-r--r-- | src/pciaccess_private.h | 1 |
2 files changed, 152 insertions, 2 deletions
diff --git a/src/openbsd_pci.c b/src/openbsd_pci.c index 219aba7..14e976d 100644 --- a/src/openbsd_pci.c +++ b/src/openbsd_pci.c @@ -1,5 +1,5 @@ /* - * Copyright (c) 2008 Mark Kettenis + * Copyright (c) 2008, 2011 Mark Kettenis * * Permission to use, copy, modify, and distribute this software for any * purpose with or without fee is hereby granted, provided that the above @@ -394,6 +394,141 @@ pci_device_openbsd_probe(struct pci_device *device) return 0; } +#if defined(__i386__) || defined(__amd64__) +#include <machine/sysarch.h> +#include <machine/pio.h> +#endif + +static struct pci_io_handle * +pci_device_openbsd_open_legacy_io(struct pci_io_handle *ret, + struct pci_device *dev, pciaddr_t base, pciaddr_t size) +{ +#if defined(__i386__) + struct i386_iopl_args ia; + + ia.iopl = 1; + if (sysarch(I386_IOPL, &ia)) + return NULL; + + ret->base = base; + ret->size = size; + return ret; +#elif defined(__amd64__) + struct amd64_iopl_args ia; + + ia.iopl = 1; + if (sysarch(AMD64_IOPL, &ia)) + return NULL; + + ret->base = base; + ret->size = size; + return ret; +#elif defined(PCI_MAGIC_IO_RANGE) + ret->memory = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED, + aperturefd, PCI_MAGIC_IO_RANGE + base); + if (ret->memory == MAP_FAILED) + return NULL; + + ret->base = base; + ret->size = size; + return ret; +#else + return NULL; +#endif +} + +static uint32_t +pci_device_openbsd_read32(struct pci_io_handle *handle, uint32_t reg) +{ +#if defined(__i386__) || defined(__amd64__) + return inl(handle->base + reg); +#else + return *(uint32_t *)((uintptr_t)handle->memory + reg); +#endif +} + +static uint16_t +pci_device_openbsd_read16(struct pci_io_handle *handle, uint32_t reg) +{ +#if defined(__i386__) || defined(__amd64__) + return inw(handle->base + reg); +#else + return *(uint16_t *)((uintptr_t)handle->memory + reg); +#endif +} + +static uint8_t +pci_device_openbsd_read8(struct pci_io_handle *handle, uint32_t reg) +{ +#if defined(__i386__) || defined(__amd64__) + return inb(handle->base + reg); +#else + return *(uint8_t *)((uintptr_t)handle->memory + reg); +#endif +} + +static void +pci_device_openbsd_write32(struct pci_io_handle *handle, uint32_t reg, + uint32_t data) +{ +#if defined(__i386__) || defined(__amd64__) + outl(handle->base + reg, data); +#else + *(uint16_t *)((uintptr_t)handle->memory + reg) = data; +#endif +} + +static void +pci_device_openbsd_write16(struct pci_io_handle *handle, uint32_t reg, + uint16_t data) +{ +#if defined(__i386__) || defined(__amd64__) + outw(handle->base + reg, data); +#else + *(uint8_t *)((uintptr_t)handle->memory + reg) = data; +#endif +} + +static void +pci_device_openbsd_write8(struct pci_io_handle *handle, uint32_t reg, + uint8_t data) +{ +#if defined(__i386__) || defined(__amd64__) + outb(handle->base + reg, data); +#else + *(uint32_t *)((uintptr_t)handle->memory + reg) = data; +#endif +} + +static int +pci_device_openbsd_map_legacy(struct pci_device *dev, pciaddr_t base, + pciaddr_t size, unsigned map_flags, void **addr) +{ + struct pci_device_mapping map; + int err; + + map.base = base; + map.size = size; + map.flags = map_flags; + map.memory = NULL; + err = pci_device_openbsd_map_range(dev, &map); + *addr = map.memory; + + return err; +} + +static int +pci_device_openbsd_unmap_legacy(struct pci_device *dev, void *addr, + pciaddr_t size) +{ + struct pci_device_mapping map; + + map.memory = addr; + map.size = size; + map.flags = 0; + return pci_device_openbsd_unmap_range(dev, &map); +} + static const struct pci_system_methods openbsd_pci_methods = { pci_system_openbsd_destroy, NULL, @@ -403,7 +538,21 @@ static const struct pci_system_methods openbsd_pci_methods = { pci_device_openbsd_unmap_range, pci_device_openbsd_read, pci_device_openbsd_write, - pci_fill_capabilities_generic + pci_fill_capabilities_generic, + NULL, + NULL, + NULL, + NULL, + pci_device_openbsd_open_legacy_io, + NULL, + pci_device_openbsd_read32, + pci_device_openbsd_read16, + pci_device_openbsd_read8, + pci_device_openbsd_write32, + pci_device_openbsd_write16, + pci_device_openbsd_write8, + pci_device_openbsd_map_legacy, + pci_device_openbsd_unmap_legacy }; int diff --git a/src/pciaccess_private.h b/src/pciaccess_private.h index 1653b8b..32f8a75 100644 --- a/src/pciaccess_private.h +++ b/src/pciaccess_private.h @@ -94,6 +94,7 @@ struct pci_device_mapping { struct pci_io_handle { pciaddr_t base; pciaddr_t size; + void *memory; int fd; }; |