Return to nbsd-libpci.c CVS log

Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / pciutils / lib

Annotation of embedaddon/pciutils/lib/nbsd-libpci.c, revision 1.1.1.1

1.1       misho       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:   pci_define_param(a, "nbsd.path", PCI_PATH_NBSD_DEVICE, "Path to the NetBSD PCI device");
                     29: }
                     30: 
                     31: static int
                     32: nbsd_detect(struct pci_access *a)
                     33: {
                     34:   char *name = pci_get_param(a, "nbsd.path");
                     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 = pci_get_param(a, "nbsd.path");
                     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:   "nbsd-libpci",
                    145:   "NetBSD libpci",
                    146:   nbsd_config,
                    147:   nbsd_detect,
                    148:   nbsd_init,
                    149:   nbsd_cleanup,
                    150:   pci_generic_scan,
                    151:   pci_generic_fill_info,
                    152:   nbsd_read,
                    153:   nbsd_write,
                    154:   NULL,                                 /* read_vpd */
                    155:   NULL,                                 /* dev_init */
                    156:   NULL                                  /* dev_cleanup */
                    157: };