lib/nbsd-libpci.c

   1 /*
   2  *      The PCI Library -- NetBSD libpci access
   3  *         (based on FreeBSD /dev/pci access)
   4  *
   5  *      Copyright (c) 1999 Jari Kirma <kirma@cs.hut.fi>
   6  *      Copyright (c) 2002 Quentin Garnier <cube@cubidou.net>
   7  *      Copyright (c) 2002 Martin Mares <mj@ucw.cz>
   8  *
   9  *      Can be freely distributed and used under the terms of the GNU GPL.
  10  */
  11
  12 /*
  13  *      Read functionality of this driver is briefly tested, and seems
  14  *      to supply basic information correctly, but I promise no more.
  15  */
  16
  17 #include <fcntl.h>
  18 #include <string.h>
  19 #include <unistd.h>
  20
  21 #include <pci.h>
  22
  23 #include "internal.h"
  24
  25 static void
  26 nbsd_config(struct pci_access *a)
  27 {
  28   a->method_params[PCI_ACCESS_NBSD_LIBPCI] = PCI_PATH_NBSD_DEVICE;
  29 }
  30
  31 static int
  32 nbsd_detect(struct pci_access *a)
  33 {
  34   char *name = a->method_params[PCI_ACCESS_NBSD_LIBPCI];
  35
  36   if (access(name, R_OK))
  37     {
  38       a->warning("Cannot open %s", name);
  39       return 0;
  40     }
  41
  42   if (!access(name, W_OK))
  43     a->writeable = O_RDWR;
  44   a->debug("...using %s", name);
  45   return 1;
  46 }
  47
  48 static void
  49 nbsd_init(struct pci_access *a)
  50 {
  51   char *name = a->method_params[PCI_ACCESS_NBSD_LIBPCI];
  52   int mode = a->writeable ? O_RDWR : O_RDONLY;
  53
  54   a->fd = open(name, mode, 0);
  55   if (a->fd < 0)
  56     a->error("nbsd_init: %s open failed", name);
  57 }
  58
  59 static void
  60 nbsd_cleanup(struct pci_access *a)
  61 {
  62   close(a->fd);
  63 }
  64
  65 static int
  66 nbsd_read(struct pci_dev *d, int pos, byte *buf, int len)
  67 {
  68   pcireg_t val;
  69   int shift;
  70
  71   if (!(len == 1 || len == 2 || len == 4))
  72     return pci_generic_block_read(d, pos, buf, len);
  73
  74   if (pos >= 256)
  75     return 0;
  76
  77   shift = 8*(pos % 4);
  78   pos &= ~3;
  79
  80   if (pcibus_conf_read(d->access->fd, d->bus, d->dev, d->func, pos, &val) < 0)
  81     d->access->error("nbsd_read: pci_bus_conf_read() failed");
  82
  83   switch (len)
  84     {
  85     case 1:
  86       *buf = val >> shift;
  87       break;
  88     case 2:
  89       *(u16*)buf = cpu_to_le16(val >> shift);
  90       break;
  91     case 4:
  92       *(u32*)buf = cpu_to_le32(val);
  93       break;
  94     }
  95   return 1;
  96 }
  97
  98 static int
  99 nbsd_write(struct pci_dev *d, int pos, byte *buf, int len)
 100 {
 101   pcireg_t val = 0;
 102   int shift;
 103
 104   if (!(len == 1 || len == 2 || len == 4))
 105     return pci_generic_block_write(d, pos, buf, len);
 106
 107   if (pos >= 256)
 108     return 0;
 109
 110   /*
 111    *  BEWARE: NetBSD seems to support only 32-bit access, so we have
 112    *  to emulate byte and word writes by read-modify-write, possibly
 113    *  causing troubles.
 114    */
 115
 116   shift = 8*(pos % 4);
 117   pos &= ~3;
 118   if (len != 4)
 119     {
 120       if (pcibus_conf_read(d->access->fd, d->bus, d->dev, d->func, pos, &val) < 0)
 121         d->access->error("nbsd_write: pci_bus_conf_read() failed");
 122     }
 123
 124   switch (len)
 125     {
 126     case 1:
 127       val = (val & ~(0xff << shift)) | (buf[0] << shift);
 128       break;
 129     case 2:
 130       val = (val & ~(0xffff << shift)) | (le16_to_cpu(*(u16*)buf) << shift);
 131       break;
 132     case 4:
 133       val = le32_to_cpu(*(u32*)buf);
 134       break;
 135     }
 136
 137   if (pcibus_conf_write(d->access->fd, d->bus, d->dev, d->func, pos, val) < 0)
 138     d->access->error("nbsd_write: pci_bus_conf_write() failed");
 139
 140   return 1;
 141 }
 142
 143 struct pci_methods pm_nbsd_libpci = {
 144   "NetBSD-libpci",
 145   nbsd_config,
 146   nbsd_detect,
 147   nbsd_init,
 148   nbsd_cleanup,
 149   pci_generic_scan,
 150   pci_generic_fill_info,
 151   nbsd_read,
 152   nbsd_write,
 153   NULL,                                 /* dev_init */
 154   NULL                                  /* dev_cleanup */
 155 };