diff options
author | Martin Mares <mj@ucw.cz> | 2006-05-05 14:30:35 +0200 |
---|---|---|
committer | Martin Mares <mj@ucw.cz> | 2006-05-05 14:30:35 +0200 |
commit | b6359063c32299c3d09de4cbdbb66d5b3468887a (patch) | |
tree | 87a82ed5e8e683aedb054ab607d68527ae3cdf2b /lib/obsd-device.c | |
parent | abf8d505e241eb3f3afa558f548a042c15f9dff8 (diff) | |
download | pciutils-b6359063c32299c3d09de4cbdbb66d5b3468887a.tar.gz |
Added OpenBSD interface.
Diffstat (limited to 'lib/obsd-device.c')
-rw-r--r-- | lib/obsd-device.c | 159 |
1 files changed, 159 insertions, 0 deletions
diff --git a/lib/obsd-device.c b/lib/obsd-device.c new file mode 100644 index 0000000..e3e3630 --- /dev/null +++ b/lib/obsd-device.c @@ -0,0 +1,159 @@ +/* + * The PCI Library -- OpenBSD /dev/pci access + * + * Adapted from fbsd-device.c by Matthieu Herrb <matthieu.herrb@laas.fr>, 2006 + * + * Can be freely distributed and used under the terms of the GNU GPL. + */ + +#include <fcntl.h> +#include <string.h> +#include <unistd.h> +#include <errno.h> +#include <sys/endian.h> +#include <sys/types.h> +#include <sys/ioctl.h> +#include <sys/pciio.h> +#include "internal.h" + +static void +obsd_config(struct pci_access *a) +{ + a->method_params[PCI_ACCESS_OBSD_DEVICE] = PCI_PATH_OBSD_DEVICE; +} + +static int +obsd_detect(struct pci_access *a) +{ + char *name = a->method_params[PCI_ACCESS_OBSD_DEVICE]; + + if (access(name, R_OK)) + { + a->warning("Cannot open %s", name); + return 0; + } + a->debug("...using %s", name); + return 1; +} + +static void +obsd_init(struct pci_access *a) +{ + char *name = a->method_params[PCI_ACCESS_OBSD_DEVICE]; + + a->fd = open(name, O_RDWR, 0); + if (a->fd < 0) + { + a->error("obsd_init: %s open failed", name); + } +} + +static void +obsd_cleanup(struct pci_access *a) +{ + close(a->fd); +} + +static int +obsd_read(struct pci_dev *d, int pos, byte *buf, int len) +{ + struct pci_io pi; + union { + u_int32_t u32; + u_int16_t u16[2]; + u_int8_t u8[4]; + } u; + + if (!(len == 1 || len == 2 || len == 4)) + { + return pci_generic_block_read(d, pos, buf, len); + } + + if (pos >= 256) + return 0; + + pi.pi_sel.pc_bus = d->bus; + pi.pi_sel.pc_dev = d->dev; + pi.pi_sel.pc_func = d->func; + + pi.pi_reg = pos - (pos % 4); + pi.pi_width = 4; + + if (ioctl(d->access->fd, PCIOCREAD, &pi) < 0) { + if (errno == ENXIO) { + pi.pi_data = 0xffffffff; + } else { + d->access->error("obsd_read: ioctl(PCIOCREAD) failed"); + } + } + u.u32 = pi.pi_data; + + switch (len) + { + case 1: + buf[0] = (u8) u.u8[pos % 4]; + break; + case 2: + ((u16 *) buf)[0] = letoh16(u.u16[(pos % 4) / 2]); + break; + case 4: + ((u32 *) buf)[0] = (u32) letoh32(pi.pi_data); + break; + } + return 1; +} + +static int +obsd_write(struct pci_dev *d, int pos, byte *buf, int len) +{ + struct pci_io pi; + + if (!(len == 1 || len == 2 || len == 4)) + { + return pci_generic_block_write(d, pos, buf, len); + } + + if (pos >= 256) + return 0; + + pi.pi_sel.pc_bus = d->bus; + pi.pi_sel.pc_dev = d->dev; + pi.pi_sel.pc_func = d->func; + + pi.pi_reg = pos; + pi.pi_width = len; + + switch (len) + { + case 1: + pi.pi_data = buf[0]; + break; + case 2: + pi.pi_data = ((u16 *) buf)[0]; + break; + case 4: + pi.pi_data = ((u32 *) buf)[0]; + break; + } + + if (ioctl(d->access->fd, PCIOCWRITE, &pi) < 0) + { + d->access->error("obsd_write: ioctl(PCIOCWRITE) failed"); + } + + return 1; +} + +struct pci_methods pm_obsd_device = { + "OpenBSD-device", + obsd_config, + obsd_detect, + obsd_init, + obsd_cleanup, + pci_generic_scan, + pci_generic_fill_info, + obsd_read, + obsd_write, + NULL, /* dev_init */ + NULL /* dev_cleanup */ +}; |