usr.sbin/pciconf/pciconf.c

   1 /*
   2  * Copyright 1996 Massachusetts Institute of Technology
   3  *
   4  * Permission to use, copy, modify, and distribute this software and
   5  * its documentation for any purpose and without fee is hereby
   6  * granted, provided that both the above copyright notice and this
   7  * permission notice appear in all copies, that both the above
   8  * copyright notice and this permission notice appear in all
   9  * supporting documentation, and that the name of M.I.T. not be used
  10  * in advertising or publicity pertaining to distribution of the
  11  * software without specific, written prior permission.  M.I.T. makes
  12  * no representations about the suitability of this software for any
  13  * purpose.  It is provided "as is" without express or implied
  14  * warranty.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''.  M.I.T. DISCLAIMS
  17  * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE,
  18  * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  19  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT
  20  * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  21  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  22  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
  23  * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  24  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  25  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  26  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  29
  30 #ifndef lint
  31 static const char rcsid[] =
  32   "$FreeBSD$";
  33 #endif /* not lint */
  34
  35 #include <sys/types.h>
  36 #include <sys/fcntl.h>
  37
  38 #include <assert.h>
  39 #include <ctype.h>
  40 #include <err.h>
  41 #include <inttypes.h>
  42 #include <stdlib.h>
  43 #include <stdio.h>
  44 #include <string.h>
  45 #include <unistd.h>
  46 #include <sys/pciio.h>
  47 #include <sys/queue.h>
  48
  49 #include <dev/pci/pcireg.h>
  50
  51 #include "pathnames.h"
  52 #include "pciconf.h"
  53
  54 struct pci_device_info
  55 {
  56     TAILQ_ENTRY(pci_device_info)        link;
  57     int                                 id;
  58     char                                *desc;
  59 };
  60
  61 struct pci_vendor_info
  62 {
  63     TAILQ_ENTRY(pci_vendor_info)        link;
  64     TAILQ_HEAD(,pci_device_info)        devs;
  65     int                                 id;
  66     char                                *desc;
  67 };
  68
  69 TAILQ_HEAD(,pci_vendor_info)    pci_vendors;
  70
  71 static struct pcisel getsel(const char *str);
  72 static void list_bars(int fd, struct pci_conf *p);
  73 static void list_devs(const char *name, int verbose, int bars, int caps,
  74     int errors, int vpd);
  75 static void list_verbose(struct pci_conf *p);
  76 static void list_vpd(int fd, struct pci_conf *p);
  77 static const char *guess_class(struct pci_conf *p);
  78 static const char *guess_subclass(struct pci_conf *p);
  79 static int load_vendors(void);
  80 static void readit(const char *, const char *, int);
  81 static void writeit(const char *, const char *, const char *, int);
  82 static void chkattached(const char *);
  83
  84 static int exitstatus = 0;
  85
  86 static void
  87 usage(void)
  88 {
  89         fprintf(stderr, "%s\n%s\n%s\n%s\n",
  90                 "usage: pciconf -l [-bcevV] [device]",
  91                 "       pciconf -a device",
  92                 "       pciconf -r [-b | -h] device addr[:addr2]",
  93                 "       pciconf -w [-b | -h] device addr value");
  94         exit (1);
  95 }
  96
  97 int
  98 main(int argc, char **argv)
  99 {
 100         int c;
 101         int listmode, readmode, writemode, attachedmode;
 102         int bars, caps, errors, verbose, vpd;
 103         int byte, isshort;
 104
 105         listmode = readmode = writemode = attachedmode = 0;
 106         bars = caps = errors = verbose = vpd = byte = isshort = 0;
 107
 108         while ((c = getopt(argc, argv, "abcehlrwvV")) != -1) {
 109                 switch(c) {
 110                 case 'a':
 111                         attachedmode = 1;
 112                         break;
 113
 114                 case 'b':
 115                         bars = 1;
 116                         byte = 1;
 117                         break;
 118
 119                 case 'c':
 120                         caps = 1;
 121                         break;
 122
 123                 case 'e':
 124                         errors = 1;
 125                         break;
 126
 127                 case 'h':
 128                         isshort = 1;
 129                         break;
 130
 131                 case 'l':
 132                         listmode = 1;
 133                         break;
 134
 135                 case 'r':
 136                         readmode = 1;
 137                         break;
 138
 139                 case 'w':
 140                         writemode = 1;
 141                         break;
 142
 143                 case 'v':
 144                         verbose = 1;
 145                         break;
 146
 147                 case 'V':
 148                         vpd = 1;
 149                         break;
 150
 151                 default:
 152                         usage();
 153                 }
 154         }
 155
 156         if ((listmode && optind >= argc + 1)
 157             || (writemode && optind + 3 != argc)
 158             || (readmode && optind + 2 != argc)
 159             || (attachedmode && optind + 1 != argc))
 160                 usage();
 161
 162         if (listmode) {
 163                 list_devs(optind + 1 == argc ? argv[optind] : NULL, verbose,
 164                     bars, caps, errors, vpd);
 165         } else if (attachedmode) {
 166                 chkattached(argv[optind]);
 167         } else if (readmode) {
 168                 readit(argv[optind], argv[optind + 1],
 169                     byte ? 1 : isshort ? 2 : 4);
 170         } else if (writemode) {
 171                 writeit(argv[optind], argv[optind + 1], argv[optind + 2],
 172                     byte ? 1 : isshort ? 2 : 4);
 173         } else {
 174                 usage();
 175         }
 176
 177         return exitstatus;
 178 }
 179
 180 static void
 181 list_devs(const char *name, int verbose, int bars, int caps, int errors,
 182     int vpd)
 183 {
 184         int fd;
 185         struct pci_conf_io pc;
 186         struct pci_conf conf[255], *p;
 187         struct pci_match_conf patterns[1];
 188         int none_count = 0;
 189
 190         if (verbose)
 191                 load_vendors();
 192
 193         fd = open(_PATH_DEVPCI, (caps || errors) ? O_RDWR : O_RDONLY, 0);
 194         if (fd < 0)
 195                 err(1, "%s", _PATH_DEVPCI);
 196
 197         bzero(&pc, sizeof(struct pci_conf_io));
 198         pc.match_buf_len = sizeof(conf);
 199         pc.matches = conf;
 200         if (name != NULL) {
 201                 bzero(&patterns, sizeof(patterns));
 202                 patterns[0].pc_sel = getsel(name);
 203                 patterns[0].flags = PCI_GETCONF_MATCH_DOMAIN |
 204                     PCI_GETCONF_MATCH_BUS | PCI_GETCONF_MATCH_DEV |
 205                     PCI_GETCONF_MATCH_FUNC;
 206                 pc.num_patterns = 1;
 207                 pc.pat_buf_len = sizeof(patterns);
 208                 pc.patterns = patterns;
 209         }
 210
 211         do {
 212                 if (ioctl(fd, PCIOCGETCONF, &pc) == -1)
 213                         err(1, "ioctl(PCIOCGETCONF)");
 214
 215                 /*
 216                  * 255 entries should be more than enough for most people,
 217                  * but if someone has more devices, and then changes things
 218                  * around between ioctls, we'll do the cheesy thing and
 219                  * just bail.  The alternative would be to go back to the
 220                  * beginning of the list, and print things twice, which may
 221                  * not be desirable.
 222                  */
 223                 if (pc.status == PCI_GETCONF_LIST_CHANGED) {
 224                         warnx("PCI device list changed, please try again");
 225                         exitstatus = 1;
 226                         close(fd);
 227                         return;
 228                 } else if (pc.status ==  PCI_GETCONF_ERROR) {
 229                         warnx("error returned from PCIOCGETCONF ioctl");
 230                         exitstatus = 1;
 231                         close(fd);
 232                         return;
 233                 }
 234                 for (p = conf; p < &conf[pc.num_matches]; p++) {
 235                         printf("%s%d@pci%d:%d:%d:%d:\tclass=0x%06x card=0x%08x "
 236                             "chip=0x%08x rev=0x%02x hdr=0x%02x\n",
 237                             (p->pd_name && *p->pd_name) ? p->pd_name :
 238                             "none",
 239                             (p->pd_name && *p->pd_name) ? (int)p->pd_unit :
 240                             none_count++, p->pc_sel.pc_domain,
 241                             p->pc_sel.pc_bus, p->pc_sel.pc_dev,
 242                             p->pc_sel.pc_func, (p->pc_class << 16) |
 243                             (p->pc_subclass << 8) | p->pc_progif,
 244                             (p->pc_subdevice << 16) | p->pc_subvendor,
 245                             (p->pc_device << 16) | p->pc_vendor,
 246                             p->pc_revid, p->pc_hdr);
 247                         if (verbose)
 248                                 list_verbose(p);
 249                         if (bars)
 250                                 list_bars(fd, p);
 251                         if (caps)
 252                                 list_caps(fd, p);
 253                         if (errors)
 254                                 list_errors(fd, p);
 255                         if (vpd)
 256                                 list_vpd(fd, p);
 257                 }
 258         } while (pc.status == PCI_GETCONF_MORE_DEVS);
 259
 260         close(fd);
 261 }
 262
 263 static void
 264 list_bars(int fd, struct pci_conf *p)
 265 {
 266         struct pci_bar_io bar;
 267         uint64_t base;
 268         const char *type;
 269         int i, range, max;
 270
 271         switch (p->pc_hdr & PCIM_HDRTYPE) {
 272         case PCIM_HDRTYPE_NORMAL:
 273                 max = PCIR_MAX_BAR_0;
 274                 break;
 275         case PCIM_HDRTYPE_BRIDGE:
 276                 max = PCIR_MAX_BAR_1;
 277                 break;
 278         case PCIM_HDRTYPE_CARDBUS:
 279                 max = PCIR_MAX_BAR_2;
 280                 break;
 281         default:
 282                 return;
 283         }
 284
 285         for (i = 0; i <= max; i++) {
 286                 bar.pbi_sel = p->pc_sel;
 287                 bar.pbi_reg = PCIR_BAR(i);
 288                 if (ioctl(fd, PCIOCGETBAR, &bar) < 0)
 289                         continue;
 290                 if (PCI_BAR_IO(bar.pbi_base)) {
 291                         type = "I/O Port";
 292                         range = 32;
 293                         base = bar.pbi_base & PCIM_BAR_IO_BASE;
 294                 } else {
 295                         if (bar.pbi_base & PCIM_BAR_MEM_PREFETCH)
 296                                 type = "Prefetchable Memory";
 297                         else
 298                                 type = "Memory";
 299                         switch (bar.pbi_base & PCIM_BAR_MEM_TYPE) {
 300                         case PCIM_BAR_MEM_32:
 301                                 range = 32;
 302                                 break;
 303                         case PCIM_BAR_MEM_1MB:
 304                                 range = 20;
 305                                 break;
 306                         case PCIM_BAR_MEM_64:
 307                                 range = 64;
 308                                 break;
 309                         default:
 310                                 range = -1;
 311                         }
 312                         base = bar.pbi_base & ~((uint64_t)0xf);
 313                 }
 314                 printf("    bar   [%02x] = type %s, range %2d, base %#jx, ",
 315                     PCIR_BAR(i), type, range, (uintmax_t)base);
 316                 printf("size %ju, %s\n", (uintmax_t)bar.pbi_length,
 317                     bar.pbi_enabled ? "enabled" : "disabled");
 318         }
 319 }
 320
 321 static void
 322 list_verbose(struct pci_conf *p)
 323 {
 324         struct pci_vendor_info  *vi;
 325         struct pci_device_info  *di;
 326         const char *dp;
 327
 328         TAILQ_FOREACH(vi, &pci_vendors, link) {
 329                 if (vi->id == p->pc_vendor) {
 330                         printf("    vendor     = '%s'\n", vi->desc);
 331                         break;
 332                 }
 333         }
 334         if (vi == NULL) {
 335                 di = NULL;
 336         } else {
 337                 TAILQ_FOREACH(di, &vi->devs, link) {
 338                         if (di->id == p->pc_device) {
 339                                 printf("    device     = '%s'\n", di->desc);
 340                                 break;
 341                         }
 342                 }
 343         }
 344         if ((dp = guess_class(p)) != NULL)
 345                 printf("    class      = %s\n", dp);
 346         if ((dp = guess_subclass(p)) != NULL)
 347                 printf("    subclass   = %s\n", dp);
 348 }
 349
 350 static void
 351 list_vpd(int fd, struct pci_conf *p)
 352 {
 353         struct pci_list_vpd_io list;
 354         struct pci_vpd_element *vpd, *end;
 355
 356         list.plvi_sel = p->pc_sel;
 357         list.plvi_len = 0;
 358         list.plvi_data = NULL;
 359         if (ioctl(fd, PCIOCLISTVPD, &list) < 0 || list.plvi_len == 0)
 360                 return;
 361
 362         list.plvi_data = malloc(list.plvi_len);
 363         if (ioctl(fd, PCIOCLISTVPD, &list) < 0) {
 364                 free(list.plvi_data);
 365                 return;
 366         }
 367
 368         vpd = list.plvi_data;
 369         end = (struct pci_vpd_element *)((char *)vpd + list.plvi_len);
 370         for (; vpd < end; vpd = PVE_NEXT(vpd)) {
 371                 if (vpd->pve_flags == PVE_FLAG_IDENT) {
 372                         printf("    VPD ident  = '%.*s'\n",
 373                             (int)vpd->pve_datalen, vpd->pve_data);
 374                         continue;
 375                 }
 376
 377                 /* Ignore the checksum keyword. */
 378                 if (!(vpd->pve_flags & PVE_FLAG_RW) &&
 379                     memcmp(vpd->pve_keyword, "RV", 2) == 0)
 380                         continue;
 381
 382                 /* Ignore remaining read-write space. */
 383                 if (vpd->pve_flags & PVE_FLAG_RW &&
 384                     memcmp(vpd->pve_keyword, "RW", 2) == 0)
 385                         continue;
 386
 387                 /* Handle extended capability keyword. */
 388                 if (!(vpd->pve_flags & PVE_FLAG_RW) &&
 389                     memcmp(vpd->pve_keyword, "CP", 2) == 0) {
 390                         printf("    VPD ro CP  = ID %02x in map 0x%x[0x%x]\n",
 391                             (unsigned int)vpd->pve_data[0],
 392                             PCIR_BAR((unsigned int)vpd->pve_data[1]),
 393                             (unsigned int)vpd->pve_data[3] << 8 |
 394                             (unsigned int)vpd->pve_data[2]);
 395                         continue;
 396                 }
 397
 398                 /* Remaining keywords should all have ASCII values. */
 399                 printf("    VPD %s %c%c  = '%.*s'\n",
 400                     vpd->pve_flags & PVE_FLAG_RW ? "rw" : "ro",
 401                     vpd->pve_keyword[0], vpd->pve_keyword[1],
 402                     (int)vpd->pve_datalen, vpd->pve_data);
 403         }
 404         free(list.plvi_data);
 405 }
 406
 407 /*
 408  * This is a direct cut-and-paste from the table in sys/dev/pci/pci.c.
 409  */
 410 static struct
 411 {
 412         int     class;
 413         int     subclass;
 414         const char *desc;
 415 } pci_nomatch_tab[] = {
 416         {PCIC_OLD,              -1,                     "old"},
 417         {PCIC_OLD,              PCIS_OLD_NONVGA,        "non-VGA display device"},
 418         {PCIC_OLD,              PCIS_OLD_VGA,           "VGA-compatible display device"},
 419         {PCIC_STORAGE,          -1,                     "mass storage"},
 420         {PCIC_STORAGE,          PCIS_STORAGE_SCSI,      "SCSI"},
 421         {PCIC_STORAGE,          PCIS_STORAGE_IDE,       "ATA"},
 422         {PCIC_STORAGE,          PCIS_STORAGE_FLOPPY,    "floppy disk"},
 423         {PCIC_STORAGE,          PCIS_STORAGE_IPI,       "IPI"},
 424         {PCIC_STORAGE,          PCIS_STORAGE_RAID,      "RAID"},
 425         {PCIC_STORAGE,          PCIS_STORAGE_ATA_ADMA,  "ATA (ADMA)"},
 426         {PCIC_STORAGE,          PCIS_STORAGE_SATA,      "SATA"},
 427         {PCIC_STORAGE,          PCIS_STORAGE_SAS,       "SAS"},
 428         {PCIC_STORAGE,          PCIS_STORAGE_NVM,       "NVM"},
 429         {PCIC_NETWORK,          -1,                     "network"},
 430         {PCIC_NETWORK,          PCIS_NETWORK_ETHERNET,  "ethernet"},
 431         {PCIC_NETWORK,          PCIS_NETWORK_TOKENRING, "token ring"},
 432         {PCIC_NETWORK,          PCIS_NETWORK_FDDI,      "fddi"},
 433         {PCIC_NETWORK,          PCIS_NETWORK_ATM,       "ATM"},
 434         {PCIC_NETWORK,          PCIS_NETWORK_ISDN,      "ISDN"},
 435         {PCIC_DISPLAY,          -1,                     "display"},
 436         {PCIC_DISPLAY,          PCIS_DISPLAY_VGA,       "VGA"},
 437         {PCIC_DISPLAY,          PCIS_DISPLAY_XGA,       "XGA"},
 438         {PCIC_DISPLAY,          PCIS_DISPLAY_3D,        "3D"},
 439         {PCIC_MULTIMEDIA,       -1,                     "multimedia"},
 440         {PCIC_MULTIMEDIA,       PCIS_MULTIMEDIA_VIDEO,  "video"},
 441         {PCIC_MULTIMEDIA,       PCIS_MULTIMEDIA_AUDIO,  "audio"},
 442         {PCIC_MULTIMEDIA,       PCIS_MULTIMEDIA_TELE,   "telephony"},
 443         {PCIC_MULTIMEDIA,       PCIS_MULTIMEDIA_HDA,    "HDA"},
 444         {PCIC_MEMORY,           -1,                     "memory"},
 445         {PCIC_MEMORY,           PCIS_MEMORY_RAM,        "RAM"},
 446         {PCIC_MEMORY,           PCIS_MEMORY_FLASH,      "flash"},
 447         {PCIC_BRIDGE,           -1,                     "bridge"},
 448         {PCIC_BRIDGE,           PCIS_BRIDGE_HOST,       "HOST-PCI"},
 449         {PCIC_BRIDGE,           PCIS_BRIDGE_ISA,        "PCI-ISA"},
 450         {PCIC_BRIDGE,           PCIS_BRIDGE_EISA,       "PCI-EISA"},
 451         {PCIC_BRIDGE,           PCIS_BRIDGE_MCA,        "PCI-MCA"},
 452         {PCIC_BRIDGE,           PCIS_BRIDGE_PCI,        "PCI-PCI"},
 453         {PCIC_BRIDGE,           PCIS_BRIDGE_PCMCIA,     "PCI-PCMCIA"},
 454         {PCIC_BRIDGE,           PCIS_BRIDGE_NUBUS,      "PCI-NuBus"},
 455         {PCIC_BRIDGE,           PCIS_BRIDGE_CARDBUS,    "PCI-CardBus"},
 456         {PCIC_BRIDGE,           PCIS_BRIDGE_RACEWAY,    "PCI-RACEway"},
 457         {PCIC_SIMPLECOMM,       -1,                     "simple comms"},
 458         {PCIC_SIMPLECOMM,       PCIS_SIMPLECOMM_UART,   "UART"},        /* could detect 16550 */
 459         {PCIC_SIMPLECOMM,       PCIS_SIMPLECOMM_PAR,    "parallel port"},
 460         {PCIC_SIMPLECOMM,       PCIS_SIMPLECOMM_MULSER, "multiport serial"},
 461         {PCIC_SIMPLECOMM,       PCIS_SIMPLECOMM_MODEM,  "generic modem"},
 462         {PCIC_BASEPERIPH,       -1,                     "base peripheral"},
 463         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_PIC,    "interrupt controller"},
 464         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_DMA,    "DMA controller"},
 465         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_TIMER,  "timer"},
 466         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_RTC,    "realtime clock"},
 467         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_PCIHOT, "PCI hot-plug controller"},
 468         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_SDHC,   "SD host controller"},
 469         {PCIC_BASEPERIPH,       PCIS_BASEPERIPH_IOMMU,  "IOMMU"},
 470         {PCIC_INPUTDEV,         -1,                     "input device"},
 471         {PCIC_INPUTDEV,         PCIS_INPUTDEV_KEYBOARD, "keyboard"},
 472         {PCIC_INPUTDEV,         PCIS_INPUTDEV_DIGITIZER,"digitizer"},
 473         {PCIC_INPUTDEV,         PCIS_INPUTDEV_MOUSE,    "mouse"},
 474         {PCIC_INPUTDEV,         PCIS_INPUTDEV_SCANNER,  "scanner"},
 475         {PCIC_INPUTDEV,         PCIS_INPUTDEV_GAMEPORT, "gameport"},
 476         {PCIC_DOCKING,          -1,                     "docking station"},
 477         {PCIC_PROCESSOR,        -1,                     "processor"},
 478         {PCIC_SERIALBUS,        -1,                     "serial bus"},
 479         {PCIC_SERIALBUS,        PCIS_SERIALBUS_FW,      "FireWire"},
 480         {PCIC_SERIALBUS,        PCIS_SERIALBUS_ACCESS,  "AccessBus"},
 481         {PCIC_SERIALBUS,        PCIS_SERIALBUS_SSA,     "SSA"},
 482         {PCIC_SERIALBUS,        PCIS_SERIALBUS_USB,     "USB"},
 483         {PCIC_SERIALBUS,        PCIS_SERIALBUS_FC,      "Fibre Channel"},
 484         {PCIC_SERIALBUS,        PCIS_SERIALBUS_SMBUS,   "SMBus"},
 485         {PCIC_WIRELESS,         -1,                     "wireless controller"},
 486         {PCIC_WIRELESS,         PCIS_WIRELESS_IRDA,     "iRDA"},
 487         {PCIC_WIRELESS,         PCIS_WIRELESS_IR,       "IR"},
 488         {PCIC_WIRELESS,         PCIS_WIRELESS_RF,       "RF"},
 489         {PCIC_INTELLIIO,        -1,                     "intelligent I/O controller"},
 490         {PCIC_INTELLIIO,        PCIS_INTELLIIO_I2O,     "I2O"},
 491         {PCIC_SATCOM,           -1,                     "satellite communication"},
 492         {PCIC_SATCOM,           PCIS_SATCOM_TV,         "sat TV"},
 493         {PCIC_SATCOM,           PCIS_SATCOM_AUDIO,      "sat audio"},
 494         {PCIC_SATCOM,           PCIS_SATCOM_VOICE,      "sat voice"},
 495         {PCIC_SATCOM,           PCIS_SATCOM_DATA,       "sat data"},
 496         {PCIC_CRYPTO,           -1,                     "encrypt/decrypt"},
 497         {PCIC_CRYPTO,           PCIS_CRYPTO_NETCOMP,    "network/computer crypto"},
 498         {PCIC_CRYPTO,           PCIS_CRYPTO_NETCOMP,    "entertainment crypto"},
 499         {PCIC_DASP,             -1,                     "dasp"},
 500         {PCIC_DASP,             PCIS_DASP_DPIO,         "DPIO module"},
 501         {0, 0,          NULL}
 502 };
 503
 504 static const char *
 505 guess_class(struct pci_conf *p)
 506 {
 507         int     i;
 508
 509         for (i = 0; pci_nomatch_tab[i].desc != NULL; i++) {
 510                 if (pci_nomatch_tab[i].class == p->pc_class)
 511                         return(pci_nomatch_tab[i].desc);
 512         }
 513         return(NULL);
 514 }
 515
 516 static const char *
 517 guess_subclass(struct pci_conf *p)
 518 {
 519         int     i;
 520
 521         for (i = 0; pci_nomatch_tab[i].desc != NULL; i++) {
 522                 if ((pci_nomatch_tab[i].class == p->pc_class) &&
 523                     (pci_nomatch_tab[i].subclass == p->pc_subclass))
 524                         return(pci_nomatch_tab[i].desc);
 525         }
 526         return(NULL);
 527 }
 528
 529 static int
 530 load_vendors(void)
 531 {
 532         const char *dbf;
 533         FILE *db;
 534         struct pci_vendor_info *cv;
 535         struct pci_device_info *cd;
 536         char buf[1024], str[1024];
 537         char *ch;
 538         int id, error;
 539
 540         /*
 541          * Locate the database and initialise.
 542          */
 543         TAILQ_INIT(&pci_vendors);
 544         if ((dbf = getenv("PCICONF_VENDOR_DATABASE")) == NULL)
 545                 dbf = _PATH_PCIVDB;
 546         if ((db = fopen(dbf, "r")) == NULL)
 547                 return(1);
 548         cv = NULL;
 549         cd = NULL;
 550         error = 0;
 551
 552         /*
 553          * Scan input lines from the database
 554          */
 555         for (;;) {
 556                 if (fgets(buf, sizeof(buf), db) == NULL)
 557                         break;
 558
 559                 if ((ch = strchr(buf, '#')) != NULL)
 560                         *ch = '\0';
 561                 ch = strchr(buf, '\0') - 1;
 562                 while (ch > buf && isspace(*ch))
 563                         *ch-- = '\0';
 564                 if (ch <= buf)
 565                         continue;
 566
 567                 /* Can't handle subvendor / subdevice entries yet */
 568                 if (buf[0] == '\t' && buf[1] == '\t')
 569                         continue;
 570
 571                 /* Check for vendor entry */
 572                 if (buf[0] != '\t' && sscanf(buf, "%04x %[^\n]", &id, str) == 2) {
 573                         if ((id == 0) || (strlen(str) < 1))
 574                                 continue;
 575                         if ((cv = malloc(sizeof(struct pci_vendor_info))) == NULL) {
 576                                 warn("allocating vendor entry");
 577                                 error = 1;
 578                                 break;
 579                         }
 580                         if ((cv->desc = strdup(str)) == NULL) {
 581                                 free(cv);
 582                                 warn("allocating vendor description");
 583                                 error = 1;
 584                                 break;
 585                         }
 586                         cv->id = id;
 587                         TAILQ_INIT(&cv->devs);
 588                         TAILQ_INSERT_TAIL(&pci_vendors, cv, link);
 589                         continue;
 590                 }
 591
 592                 /* Check for device entry */
 593                 if (buf[0] == '\t' && sscanf(buf + 1, "%04x %[^\n]", &id, str) == 2) {
 594                         if ((id == 0) || (strlen(str) < 1))
 595                                 continue;
 596                         if (cv == NULL) {
 597                                 warnx("device entry with no vendor!");
 598                                 continue;
 599                         }
 600                         if ((cd = malloc(sizeof(struct pci_device_info))) == NULL) {
 601                                 warn("allocating device entry");
 602                                 error = 1;
 603                                 break;
 604                         }
 605                         if ((cd->desc = strdup(str)) == NULL) {
 606                                 free(cd);
 607                                 warn("allocating device description");
 608                                 error = 1;
 609                                 break;
 610                         }
 611                         cd->id = id;
 612                         TAILQ_INSERT_TAIL(&cv->devs, cd, link);
 613                         continue;
 614                 }
 615
 616                 /* It's a comment or junk, ignore it */
 617         }
 618         if (ferror(db))
 619                 error = 1;
 620         fclose(db);
 621
 622         return(error);
 623 }
 624
 625 uint32_t
 626 read_config(int fd, struct pcisel *sel, long reg, int width)
 627 {
 628         struct pci_io pi;
 629
 630         pi.pi_sel = *sel;
 631         pi.pi_reg = reg;
 632         pi.pi_width = width;
 633
 634         if (ioctl(fd, PCIOCREAD, &pi) < 0)
 635                 err(1, "ioctl(PCIOCREAD)");
 636
 637         return (pi.pi_data);
 638 }
 639
 640 static struct pcisel
 641 getdevice(const char *name)
 642 {
 643         struct pci_conf_io pc;
 644         struct pci_conf conf[1];
 645         struct pci_match_conf patterns[1];
 646         char *cp;
 647         int fd;
 648
 649         fd = open(_PATH_DEVPCI, O_RDONLY, 0);
 650         if (fd < 0)
 651                 err(1, "%s", _PATH_DEVPCI);
 652
 653         bzero(&pc, sizeof(struct pci_conf_io));
 654         pc.match_buf_len = sizeof(conf);
 655         pc.matches = conf;
 656
 657         bzero(&patterns, sizeof(patterns));
 658
 659         /*
 660          * The pattern structure requires the unit to be split out from
 661          * the driver name.  Walk backwards from the end of the name to
 662          * find the start of the unit.
 663          */
 664         if (name[0] == '\0')
 665                 errx(1, "Empty device name");
 666         cp = strchr(name, '\0');
 667         assert(cp != NULL && cp != name);
 668         cp--;
 669         while (cp != name && isdigit(cp[-1]))
 670                 cp--;
 671         if (cp == name || !isdigit(*cp))
 672                 errx(1, "Invalid device name");
 673         if ((size_t)(cp - name) + 1 > sizeof(patterns[0].pd_name))
 674                 errx(1, "Device name is too long");
 675         memcpy(patterns[0].pd_name, name, cp - name);
 676         patterns[0].pd_unit = strtol(cp, &cp, 10);
 677         assert(*cp == '\0');
 678         patterns[0].flags = PCI_GETCONF_MATCH_NAME | PCI_GETCONF_MATCH_UNIT;
 679         pc.num_patterns = 1;
 680         pc.pat_buf_len = sizeof(patterns);
 681         pc.patterns = patterns;
 682
 683         if (ioctl(fd, PCIOCGETCONF, &pc) == -1)
 684                 err(1, "ioctl(PCIOCGETCONF)");
 685         if (pc.status != PCI_GETCONF_LAST_DEVICE &&
 686             pc.status != PCI_GETCONF_MORE_DEVS)
 687                 errx(1, "error returned from PCIOCGETCONF ioctl");
 688         close(fd);
 689         if (pc.num_matches == 0)
 690                 errx(1, "Device not found");
 691         return (conf[0].pc_sel);
 692 }
 693
 694 static struct pcisel
 695 parsesel(const char *str)
 696 {
 697         char *ep = strchr(str, '@');
 698         char *epbase;
 699         struct pcisel sel;
 700         unsigned long selarr[4];
 701         int i;
 702
 703         if (ep == NULL)
 704                 ep = (char *)str;
 705         else
 706                 ep++;
 707
 708         epbase = ep;
 709
 710         if (strncmp(ep, "pci", 3) == 0) {
 711                 ep += 3;
 712                 i = 0;
 713                 do {
 714                         selarr[i++] = strtoul(ep, &ep, 10);
 715                 } while ((*ep == ':' || *ep == '.') && *++ep != '\0' && i < 4);
 716
 717                 if (i > 2)
 718                         sel.pc_func = selarr[--i];
 719                 else
 720                         sel.pc_func = 0;
 721                 sel.pc_dev = selarr[--i];
 722                 sel.pc_bus = selarr[--i];
 723                 if (i > 0)
 724                         sel.pc_domain = selarr[--i];
 725                 else
 726                         sel.pc_domain = 0;
 727         }
 728         if (*ep != '\x0' || ep == epbase)
 729                 errx(1, "cannot parse selector %s", str);
 730         return sel;
 731 }
 732
 733 static struct pcisel
 734 getsel(const char *str)
 735 {
 736
 737         /*
 738          * No device names contain colons and selectors always contain
 739          * at least one colon.
 740          */
 741         if (strchr(str, ':') == NULL)
 742                 return (getdevice(str));
 743         else
 744                 return (parsesel(str));
 745 }
 746
 747 static void
 748 readone(int fd, struct pcisel *sel, long reg, int width)
 749 {
 750
 751         printf("%0*x", width*2, read_config(fd, sel, reg, width));
 752 }
 753
 754 static void
 755 readit(const char *name, const char *reg, int width)
 756 {
 757         long rstart;
 758         long rend;
 759         long r;
 760         char *end;
 761         int i;
 762         int fd;
 763         struct pcisel sel;
 764
 765         fd = open(_PATH_DEVPCI, O_RDWR, 0);
 766         if (fd < 0)
 767                 err(1, "%s", _PATH_DEVPCI);
 768
 769         rend = rstart = strtol(reg, &end, 0);
 770         if (end && *end == ':') {
 771                 end++;
 772                 rend = strtol(end, (char **) 0, 0);
 773         }
 774         sel = getsel(name);
 775         for (i = 1, r = rstart; r <= rend; i++, r += width) {
 776                 readone(fd, &sel, r, width);
 777                 if (i && !(i % 8))
 778                         putchar(' ');
 779                 putchar(i % (16/width) ? ' ' : '\n');
 780         }
 781         if (i % (16/width) != 1)
 782                 putchar('\n');
 783         close(fd);
 784 }
 785
 786 static void
 787 writeit(const char *name, const char *reg, const char *data, int width)
 788 {
 789         int fd;
 790         struct pci_io pi;
 791
 792         pi.pi_sel = getsel(name);
 793         pi.pi_reg = strtoul(reg, (char **)0, 0); /* XXX error check */
 794         pi.pi_width = width;
 795         pi.pi_data = strtoul(data, (char **)0, 0); /* XXX error check */
 796
 797         fd = open(_PATH_DEVPCI, O_RDWR, 0);
 798         if (fd < 0)
 799                 err(1, "%s", _PATH_DEVPCI);
 800
 801         if (ioctl(fd, PCIOCWRITE, &pi) < 0)
 802                 err(1, "ioctl(PCIOCWRITE)");
 803 }
 804
 805 static void
 806 chkattached(const char *name)
 807 {
 808         int fd;
 809         struct pci_io pi;
 810
 811         pi.pi_sel = getsel(name);
 812
 813         fd = open(_PATH_DEVPCI, O_RDWR, 0);
 814         if (fd < 0)
 815                 err(1, "%s", _PATH_DEVPCI);
 816
 817         if (ioctl(fd, PCIOCATTACHED, &pi) < 0)
 818                 err(1, "ioctl(PCIOCATTACHED)");
 819
 820         exitstatus = pi.pi_data ? 0 : 2; /* exit(2), if NOT attached */
 821         printf("%s: %s%s\n", name, pi.pi_data == 0 ? "not " : "", "attached");
 822 }