165 lines
3.3 KiB
Plaintext
165 lines
3.3 KiB
Plaintext
$OpenBSD: patch-lib_obsd-device_c,v 1.2 2006/12/12 20:32:37 kettenis Exp $
|
|
--- lib/obsd-device.c.orig Wed Nov 22 20:07:11 2006
|
|
+++ lib/obsd-device.c Tue Dec 12 12:03:49 2006
|
|
@@ -0,0 +1,160 @@
|
|
+/*
|
|
+ * The PCI Library -- FreeBSD /dev/pci access
|
|
+ *
|
|
+ * Copyright (c) 1999 Jari Kirma <kirma@cs.hut.fi>
|
|
+ * Updated in 2003 by Samy Al Bahra <samy@kerneled.com>
|
|
+ *
|
|
+ * 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) (pi.pi_data >> ((pos % 4) * 8));
|
|
+ break;
|
|
+ case 2:
|
|
+ ((u16 *) buf)[0] = (u16) htole16(pi.pi_data >> ((pos % 4) * 8));
|
|
+ break;
|
|
+ case 4:
|
|
+ ((u32 *) buf)[0] = (u32) htole32(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 */
|
|
+};
|