setpci.c

   1 /*
   2  *      The PCI Utilities -- Manipulate PCI Configuration Registers
   3  *
   4  *      Copyright (c) 1998--2008 Martin Mares <mj@ucw.cz>
   5  *
   6  *      Can be freely distributed and used under the terms of the GNU GPL.
   7  */
   8
   9 #include <stdio.h>
  10 #include <string.h>
  11 #include <stdlib.h>
  12 #include <stdarg.h>
  13 #include <errno.h>
  14
  15 #define PCIUTILS_SETPCI
  16 #include "pciutils.h"
  17
  18 static int force;                       /* Don't complain if no devices match */
  19 static int verbose;                     /* Verbosity level */
  20 static int demo_mode;                   /* Only show */
  21
  22 const char program_name[] = "setpci";
  23
  24 static struct pci_access *pacc;
  25
  26 struct value {
  27   unsigned int value;
  28   unsigned int mask;
  29 };
  30
  31 struct op {
  32   struct op *next;
  33   struct pci_dev **dev_vector;
  34   u16 cap_type;                         /* PCI_CAP_xxx or 0 */
  35   u16 cap_id;
  36   unsigned int addr;
  37   unsigned int width;                   /* Byte width of the access */
  38   unsigned int num_values;              /* Number of values to write; 0=read */
  39   unsigned int number;                 /* The n-th capability of that id */
  40   struct value values[0];
  41 };
  42
  43 static struct op *first_op, **last_op = &first_op;
  44 static unsigned int max_values[] = { 0, 0xff, 0xffff, 0, 0xffffffff };
  45
  46 static struct pci_dev **
  47 select_devices(struct pci_filter *filt)
  48 {
  49   struct pci_dev *z, **a, **b;
  50   int cnt = 1;
  51
  52   for (z=pacc->devices; z; z=z->next)
  53     if (pci_filter_match(filt, z))
  54       cnt++;
  55   a = b = xmalloc(sizeof(struct device *) * cnt);
  56   for (z=pacc->devices; z; z=z->next)
  57     if (pci_filter_match(filt, z))
  58       *a++ = z;
  59   *a = NULL;
  60   return b;
  61 }
  62
  63 static void PCI_PRINTF(1,2)
  64 trace(const char *fmt, ...)
  65 {
  66   va_list args;
  67   va_start(args, fmt);
  68   if (verbose)
  69     vprintf(fmt, args);
  70   va_end(args);
  71 }
  72
  73 static void
  74 exec_op(struct op *op, struct pci_dev *dev)
  75 {
  76   const char * const formats[] = { NULL, " %02x", " %04x", NULL, " %08x" };
  77   const char * const mask_formats[] = { NULL, " %02x->(%02x:%02x)->%02x", " %04x->(%04x:%04x)->%04x", NULL, " %08x->(%08x:%08x)->%08x" };
  78   unsigned int i, x, y;
  79   int addr = 0;
  80   int width = op->width;
  81   char slot[16];
  82
  83   sprintf(slot, "%04x:%02x:%02x.%x", dev->domain, dev->bus, dev->dev, dev->func);
  84   trace("%s ", slot);
  85   if (op->cap_type)
  86     {
  87       struct pci_cap *cap;
  88       unsigned int cap_nr = op->number;
  89       cap = pci_find_cap_nr(dev, op->cap_id, op->cap_type, &cap_nr);
  90       if (cap)
  91         addr = cap->addr;
  92       else if (cap_nr == 0)
  93         die("%s: Instance #%d of %s %04x not found - there are no capabilities with that id.", slot,
  94             op->number, ((op->cap_type == PCI_CAP_NORMAL) ? "Capability" : "Extended capability"),
  95             op->cap_id);
  96       else
  97         die("%s: Instance #%d of %s %04x not found - there %s only %d %s with that id.", slot,
  98             op->number, ((op->cap_type == PCI_CAP_NORMAL) ? "Capability" : "Extended capability"),
  99             op->cap_id, ((cap_nr == 1) ? "is" : "are"), cap_nr,
 100             ((cap_nr == 1) ? "capability" : "capabilities"));
 101
 102       trace(((op->cap_type == PCI_CAP_NORMAL) ? "(cap %02x @%02x) " : "(ecap %04x @%03x) "), op->cap_id, addr);
 103     }
 104   addr += op->addr;
 105   trace("@%02x", addr);
 106
 107   /* We have already checked it when parsing, but addressing relative to capabilities can change the address. */
 108   if (addr & (width-1))
 109     die("%s: Unaligned access of width %d to register %04x", slot, width, addr);
 110   if (addr + width > 0x1000)
 111     die("%s: Access of width %d to register %04x out of range", slot, width, addr);
 112
 113   if (op->num_values)
 114     {
 115       for (i=0; i<op->num_values; i++)
 116         {
 117           if ((op->values[i].mask & max_values[width]) == max_values[width])
 118             {
 119               x = op->values[i].value;
 120               trace(formats[width], op->values[i].value);
 121             }
 122           else
 123             {
 124               switch (width)
 125                 {
 126                 case 1:
 127                   y = pci_read_byte(dev, addr);
 128                   break;
 129                 case 2:
 130                   y = pci_read_word(dev, addr);
 131                   break;
 132                 default:
 133                   y = pci_read_long(dev, addr);
 134                   break;
 135                 }
 136               x = (y & ~op->values[i].mask) | op->values[i].value;
 137               trace(mask_formats[width], y, op->values[i].value, op->values[i].mask, x);
 138             }
 139           if (!demo_mode)
 140             {
 141               switch (width)
 142                 {
 143                 case 1:
 144                   pci_write_byte(dev, addr, x);
 145                   break;
 146                 case 2:
 147                   pci_write_word(dev, addr, x);
 148                   break;
 149                 default:
 150                   pci_write_long(dev, addr, x);
 151                   break;
 152                 }
 153             }
 154           addr += width;
 155         }
 156       trace("\n");
 157     }
 158   else
 159     {
 160       trace(" = ");
 161       switch (width)
 162         {
 163         case 1:
 164           x = pci_read_byte(dev, addr);
 165           break;
 166         case 2:
 167           x = pci_read_word(dev, addr);
 168           break;
 169         default:
 170           x = pci_read_long(dev, addr);
 171           break;
 172         }
 173       printf(formats[width]+1, x);
 174       putchar('\n');
 175     }
 176 }
 177
 178 static void
 179 execute(struct op *op)
 180 {
 181   struct pci_dev **vec = NULL;
 182   struct pci_dev **pdev, *dev;
 183   struct op *oops;
 184
 185   while (op)
 186     {
 187       pdev = vec = op->dev_vector;
 188       while (dev = *pdev++)
 189         for (oops=op; oops && oops->dev_vector == vec; oops=oops->next)
 190           exec_op(oops, dev);
 191       while (op && op->dev_vector == vec)
 192         op = op->next;
 193     }
 194 }
 195
 196 static void
 197 scan_ops(struct op *op)
 198 {
 199   if (demo_mode)
 200     return;
 201   while (op)
 202     {
 203       if (op->num_values)
 204         pacc->writeable = 1;
 205       op = op->next;
 206     }
 207 }
 208
 209 struct reg_name {
 210   unsigned int cap;
 211   unsigned int offset;
 212   unsigned int width;
 213   const char *name;
 214 };
 215
 216 static const struct reg_name pci_reg_names[] = {
 217   {       0, 0x00, 2, "VENDOR_ID" },
 218   {       0, 0x02, 2, "DEVICE_ID" },
 219   {       0, 0x04, 2, "COMMAND" },
 220   {       0, 0x06, 2, "STATUS" },
 221   {       0, 0x08, 1, "REVISION" },
 222   {       0, 0x09, 1, "CLASS_PROG" },
 223   {       0, 0x0a, 2, "CLASS_DEVICE" },
 224   {       0, 0x0c, 1, "CACHE_LINE_SIZE" },
 225   {       0, 0x0d, 1, "LATENCY_TIMER" },
 226   {       0, 0x0e, 1, "HEADER_TYPE" },
 227   {       0, 0x0f, 1, "BIST" },
 228   {       0, 0x10, 4, "BASE_ADDRESS_0" },
 229   {       0, 0x14, 4, "BASE_ADDRESS_1" },
 230   {       0, 0x18, 4, "BASE_ADDRESS_2" },
 231   {       0, 0x1c, 4, "BASE_ADDRESS_3" },
 232   {       0, 0x20, 4, "BASE_ADDRESS_4" },
 233   {       0, 0x24, 4, "BASE_ADDRESS_5" },
 234   {       0, 0x28, 4, "CARDBUS_CIS" },
 235   {       0, 0x2c, 2, "SUBSYSTEM_VENDOR_ID" },
 236   {       0, 0x2e, 2, "SUBSYSTEM_ID" },
 237   {       0, 0x30, 4, "ROM_ADDRESS" },
 238   {       0, 0x3c, 1, "INTERRUPT_LINE" },
 239   {       0, 0x3d, 1, "INTERRUPT_PIN" },
 240   {       0, 0x3e, 1, "MIN_GNT" },
 241   {       0, 0x3f, 1, "MAX_LAT" },
 242   {       0, 0x18, 1, "PRIMARY_BUS" },
 243   {       0, 0x19, 1, "SECONDARY_BUS" },
 244   {       0, 0x1a, 1, "SUBORDINATE_BUS" },
 245   {       0, 0x1b, 1, "SEC_LATENCY_TIMER" },
 246   {       0, 0x1c, 1, "IO_BASE" },
 247   {       0, 0x1d, 1, "IO_LIMIT" },
 248   {       0, 0x1e, 2, "SEC_STATUS" },
 249   {       0, 0x20, 2, "MEMORY_BASE" },
 250   {       0, 0x22, 2, "MEMORY_LIMIT" },
 251   {       0, 0x24, 2, "PREF_MEMORY_BASE" },
 252   {       0, 0x26, 2, "PREF_MEMORY_LIMIT" },
 253   {       0, 0x28, 4, "PREF_BASE_UPPER32" },
 254   {       0, 0x2c, 4, "PREF_LIMIT_UPPER32" },
 255   {       0, 0x30, 2, "IO_BASE_UPPER16" },
 256   {       0, 0x32, 2, "IO_LIMIT_UPPER16" },
 257   {       0, 0x38, 4, "BRIDGE_ROM_ADDRESS" },
 258   {       0, 0x3e, 2, "BRIDGE_CONTROL" },
 259   {       0, 0x10, 4, "CB_CARDBUS_BASE" },
 260   {       0, 0x14, 2, "CB_CAPABILITIES" },
 261   {       0, 0x16, 2, "CB_SEC_STATUS" },
 262   {       0, 0x18, 1, "CB_BUS_NUMBER" },
 263   {       0, 0x19, 1, "CB_CARDBUS_NUMBER" },
 264   {       0, 0x1a, 1, "CB_SUBORDINATE_BUS" },
 265   {       0, 0x1b, 1, "CB_CARDBUS_LATENCY" },
 266   {       0, 0x1c, 4, "CB_MEMORY_BASE_0" },
 267   {       0, 0x20, 4, "CB_MEMORY_LIMIT_0" },
 268   {       0, 0x24, 4, "CB_MEMORY_BASE_1" },
 269   {       0, 0x28, 4, "CB_MEMORY_LIMIT_1" },
 270   {       0, 0x2c, 2, "CB_IO_BASE_0" },
 271   {       0, 0x2e, 2, "CB_IO_BASE_0_HI" },
 272   {       0, 0x30, 2, "CB_IO_LIMIT_0" },
 273   {       0, 0x32, 2, "CB_IO_LIMIT_0_HI" },
 274   {       0, 0x34, 2, "CB_IO_BASE_1" },
 275   {       0, 0x36, 2, "CB_IO_BASE_1_HI" },
 276   {       0, 0x38, 2, "CB_IO_LIMIT_1" },
 277   {       0, 0x3a, 2, "CB_IO_LIMIT_1_HI" },
 278   {       0, 0x40, 2, "CB_SUBSYSTEM_VENDOR_ID" },
 279   {       0, 0x42, 2, "CB_SUBSYSTEM_ID" },
 280   {       0, 0x44, 4, "CB_LEGACY_MODE_BASE" },
 281   { 0x10001,    0, 0, "CAP_PM" },
 282   { 0x10002,    0, 0, "CAP_AGP" },
 283   { 0x10003,    0, 0, "CAP_VPD" },
 284   { 0x10004,    0, 0, "CAP_SLOTID" },
 285   { 0x10005,    0, 0, "CAP_MSI" },
 286   { 0x10006,    0, 0, "CAP_CHSWP" },
 287   { 0x10007,    0, 0, "CAP_PCIX" },
 288   { 0x10008,    0, 0, "CAP_HT" },
 289   { 0x10009,    0, 0, "CAP_VNDR" },
 290   { 0x1000a,    0, 0, "CAP_DBG" },
 291   { 0x1000b,    0, 0, "CAP_CCRC" },
 292   { 0x1000c,    0, 0, "CAP_HOTPLUG" },
 293   { 0x1000d,    0, 0, "CAP_SSVID" },
 294   { 0x1000e,    0, 0, "CAP_AGP3" },
 295   { 0x1000f,    0, 0, "CAP_SECURE" },
 296   { 0x10010,    0, 0, "CAP_EXP" },
 297   { 0x10011,    0, 0, "CAP_MSIX" },
 298   { 0x10012,    0, 0, "CAP_SATA" },
 299   { 0x10013,    0, 0, "CAP_AF" },
 300   { 0x10014,    0, 0, "CAP_EA" },
 301   { 0x20001,    0, 0, "ECAP_AER" },
 302   { 0x20002,    0, 0, "ECAP_VC" },
 303   { 0x20003,    0, 0, "ECAP_DSN" },
 304   { 0x20004,    0, 0, "ECAP_PB" },
 305   { 0x20005,    0, 0, "ECAP_RCLINK" },
 306   { 0x20006,    0, 0, "ECAP_RCILINK" },
 307   { 0x20007,    0, 0, "ECAP_RCECOLL" },
 308   { 0x20008,    0, 0, "ECAP_MFVC" },
 309   { 0x20009,    0, 0, "ECAP_VC2" },
 310   { 0x2000a,    0, 0, "ECAP_RBCB" },
 311   { 0x2000b,    0, 0, "ECAP_VNDR" },
 312   { 0x2000d,    0, 0, "ECAP_ACS" },
 313   { 0x2000e,    0, 0, "ECAP_ARI" },
 314   { 0x2000f,    0, 0, "ECAP_ATS" },
 315   { 0x20010,    0, 0, "ECAP_SRIOV" },
 316   { 0x20011,    0, 0, "ECAP_MRIOV" },
 317   { 0x20012,    0, 0, "ECAP_MCAST" },
 318   { 0x20013,    0, 0, "ECAP_PRI" },
 319   { 0x20015,    0, 0, "ECAP_REBAR" },
 320   { 0x20016,    0, 0, "ECAP_DPA" },
 321   { 0x20017,    0, 0, "ECAP_TPH" },
 322   { 0x20018,    0, 0, "ECAP_LTR" },
 323   { 0x20019,    0, 0, "ECAP_SECPCI" },
 324   { 0x2001a,    0, 0, "ECAP_PMUX" },
 325   { 0x2001b,    0, 0, "ECAP_PASID" },
 326   { 0x2001c,    0, 0, "ECAP_LNR" },
 327   { 0x2001d,    0, 0, "ECAP_DPC" },
 328   { 0x2001e,    0, 0, "ECAP_L1PM" },
 329   { 0x2001f,    0, 0, "ECAP_PTM" },
 330   { 0x20020,    0, 0, "ECAP_M_PCIE" },
 331   { 0x20021,    0, 0, "ECAP_FRS" },
 332   { 0x20022,    0, 0, "ECAP_RTR" },
 333   { 0x20023,    0, 0, "ECAP_DVSEC" },
 334   { 0x20024,    0, 0, "ECAP_VF_REBAR" },
 335   { 0x20025,    0, 0, "ECAP_DLNK" },
 336   { 0x20026,    0, 0, "ECAP_16GT" },
 337   { 0x20027,    0, 0, "ECAP_LMR" },
 338   { 0x20028,    0, 0, "ECAP_HIER_ID" },
 339   { 0x20029,    0, 0, "ECAP_NPEM" },
 340   {       0,    0, 0, NULL }
 341 };
 342
 343 static void
 344 dump_registers(void)
 345 {
 346   const struct reg_name *r;
 347
 348   printf("cap pos w name\n");
 349   for (r = pci_reg_names; r->name; r++)
 350     {
 351       if (r->cap >= 0x20000)
 352         printf("%04x", r->cap - 0x20000);
 353       else if (r->cap)
 354         printf("  %02x", r->cap - 0x10000);
 355       else
 356         printf("    ");
 357       printf(" %02x %c %s\n", r->offset, "-BW?L"[r->width], r->name);
 358     }
 359 }
 360
 361 static void NONRET
 362 usage(void)
 363 {
 364   fprintf(stderr,
 365 "Usage: setpci [<options>] (<device>+ <reg>[=<values>]*)*\n"
 366 "\n"
 367 "General options:\n"
 368 "-f\t\tDon't complain if there's nothing to do\n"
 369 "-v\t\tBe verbose\n"
 370 "-D\t\tList changes, don't commit them\n"
 371 "--dumpregs\tDump all known register names and exit\n"
 372 "\n"
 373 "PCI access options:\n"
 374 GENERIC_HELP
 375 "\n"
 376 "Setting commands:\n"
 377 "<device>:\t-s [[[<domain>]:][<bus>]:][<slot>][.[<func>]]\n"
 378 "\t\t-d [<vendor>]:[<device>]\n"
 379 "<reg>:\t\t<base>[+<offset>][.(B|W|L)][@<number>]\n"
 380 "<base>:\t\t<address>\n"
 381 "\t\t<named-register>\n"
 382 "\t\t[E]CAP_<capability-name>\n"
 383 "\t\t[E]CAP<capability-number>\n"
 384 "<values>:\t<value>[,<value>...]\n"
 385 "<value>:\t<hex>\n"
 386 "\t\t<hex>:<mask>\n");
 387   exit(0);
 388 }
 389
 390 static void NONRET PCI_PRINTF(1,2)
 391 parse_err(const char *msg, ...)
 392 {
 393   va_list args;
 394   va_start(args, msg);
 395   fprintf(stderr, "setpci: ");
 396   vfprintf(stderr, msg, args);
 397   fprintf(stderr, ".\nTry `setpci --help' for more information.\n");
 398   exit(1);
 399 }
 400
 401 static int
 402 parse_options(int argc, char **argv)
 403 {
 404   const char opts[] = GENERIC_OPTIONS;
 405   int i=1;
 406
 407   if (argc == 2)
 408     {
 409       if (!strcmp(argv[1], "--help"))
 410         usage();
 411       if (!strcmp(argv[1], "--version"))
 412         {
 413           puts("setpci version " PCIUTILS_VERSION);
 414           exit(0);
 415         }
 416       if (!strcmp(argv[1], "--dumpregs"))
 417         {
 418           dump_registers();
 419           exit(0);
 420         }
 421     }
 422
 423   while (i < argc && argv[i][0] == '-')
 424     {
 425       char *c = argv[i++] + 1;
 426       char *d = c;
 427       char *e;
 428       while (*c)
 429         switch (*c)
 430           {
 431           case 0:
 432             break;
 433           case 'v':
 434             verbose++;
 435             c++;
 436             break;
 437           case 'f':
 438             force++;
 439             c++;
 440             break;
 441           case 'D':
 442             demo_mode++;
 443             c++;
 444             break;
 445           default:
 446             if (e = strchr(opts, *c))
 447               {
 448                 char *arg;
 449                 c++;
 450                 if (e[1] == ':')
 451                   {
 452                     if (*c)
 453                       arg = c;
 454                     else if (i < argc)
 455                       arg = argv[i++];
 456                     else
 457                       parse_err("Option -%c requires an argument", *e);
 458                     c = "";
 459                   }
 460                 else
 461                   arg = NULL;
 462                 if (!parse_generic_option(*e, pacc, arg))
 463                   parse_err("Unable to parse option -%c", *e);
 464               }
 465             else
 466               {
 467                 if (c != d)
 468                   parse_err("Invalid or misplaced option -%c", *c);
 469                 return i-1;
 470               }
 471           }
 472     }
 473
 474   return i;
 475 }
 476
 477 static int parse_filter(int argc, char **argv, int i, struct pci_filter *filter)
 478 {
 479   char *c = argv[i++];
 480   char *d;
 481
 482   if (!c[1] || !strchr("sd", c[1]))
 483     parse_err("Invalid option -%c", c[1]);
 484   if (c[2])
 485     d = (c[2] == '=') ? c+3 : c+2;
 486   else if (i < argc)
 487     d = argv[i++];
 488   else
 489     parse_err("Option -%c requires an argument", c[1]);
 490   switch (c[1])
 491     {
 492     case 's':
 493       if (d = pci_filter_parse_slot(filter, d))
 494         parse_err("Unable to parse filter -s %s", d);
 495       break;
 496     case 'd':
 497       if (d = pci_filter_parse_id(filter, d))
 498         parse_err("Unable to parse filter -d %s", d);
 499       break;
 500     default:
 501       parse_err("Unknown filter option -%c", c[1]);
 502     }
 503
 504   return i;
 505 }
 506
 507 static const struct reg_name *parse_reg_name(char *name)
 508 {
 509   const struct reg_name *r;
 510
 511   for (r = pci_reg_names; r->name; r++)
 512     if (!strcasecmp(r->name, name))
 513       return r;
 514   return NULL;
 515 }
 516
 517 static int parse_x32(char *c, char **stopp, unsigned int *resp)
 518 {
 519   char *stop;
 520   unsigned long int l;
 521
 522   if (!*c)
 523     return -1;
 524   errno = 0;
 525   l = strtoul(c, &stop, 16);
 526   if (errno)
 527     return -1;
 528   if ((l & ~0U) != l)
 529     return -1;
 530   *resp = l;
 531   if (*stop)
 532     {
 533       if (stopp)
 534         *stopp = stop;
 535       return 0;
 536     }
 537   else
 538     {
 539       if (stopp)
 540         *stopp = NULL;
 541       return 1;
 542     }
 543 }
 544
 545 static void parse_register(struct op *op, char *base)
 546 {
 547   const struct reg_name *r;
 548   unsigned int cap;
 549
 550   op->cap_type = op->cap_id = 0;
 551   if (parse_x32(base, NULL, &op->addr) > 0)
 552     return;
 553   else if (r = parse_reg_name(base))
 554     {
 555       switch (r->cap & 0xff0000)
 556         {
 557         case 0x10000:
 558           op->cap_type = PCI_CAP_NORMAL;
 559           break;
 560         case 0x20000:
 561           op->cap_type = PCI_CAP_EXTENDED;
 562           break;
 563         }
 564       op->cap_id = r->cap & 0xffff;
 565       op->addr = r->offset;
 566       if (r->width && !op->width)
 567         op->width = r->width;
 568       return;
 569     }
 570   else if (!strncasecmp(base, "CAP", 3))
 571     {
 572       if (parse_x32(base+3, NULL, &cap) > 0 && cap < 0x100)
 573         {
 574           op->cap_type = PCI_CAP_NORMAL;
 575           op->cap_id = cap;
 576           op->addr = 0;
 577           return;
 578         }
 579     }
 580   else if (!strncasecmp(base, "ECAP", 4))
 581     {
 582       if (parse_x32(base+4, NULL, &cap) > 0 && cap < 0x1000)
 583         {
 584           op->cap_type = PCI_CAP_EXTENDED;
 585           op->cap_id = cap;
 586           op->addr = 0;
 587           return;
 588         }
 589     }
 590   parse_err("Unknown register \"%s\"", base);
 591 }
 592
 593 static void parse_op(char *c, struct pci_dev **selected_devices)
 594 {
 595   char *base, *offset, *width, *value, *number;
 596   char *e, *f;
 597   int n, j;
 598   struct op *op;
 599
 600   /* Split the argument */
 601   base = xstrdup(c);
 602   if (value = strchr(base, '='))
 603     *value++ = 0;
 604   if (number = strchr(base, '@'))
 605     *number++ = 0;
 606   if (width = strchr(base, '.'))
 607     *width++ = 0;
 608   if (offset = strchr(base, '+'))
 609     *offset++ = 0;
 610
 611   /* Look for setting of values and count how many */
 612   n = 0;
 613   if (value)
 614     {
 615       if (!*value)
 616         parse_err("Missing value");
 617       n++;
 618       for (e=value; *e; e++)
 619         if (*e == ',')
 620           n++;
 621     }
 622
 623   /* Allocate the operation */
 624   op = xmalloc(sizeof(struct op) + n*sizeof(struct value));
 625   op->dev_vector = selected_devices;
 626   op->num_values = n;
 627
 628   /* What is the width suffix? */
 629   if (width)
 630     {
 631       if (width[1])
 632         parse_err("Invalid width \"%s\"", width);
 633       switch (*width & 0xdf)
 634         {
 635         case 'B':
 636           op->width = 1; break;
 637         case 'W':
 638           op->width = 2; break;
 639         case 'L':
 640           op->width = 4; break;
 641         default:
 642           parse_err("Invalid width \"%c\"", *width);
 643         }
 644     }
 645   else
 646     op->width = 0;
 647
 648   /* Check which n-th capability of the same id we want */
 649   if (number)
 650     {
 651       unsigned int num;
 652       if (parse_x32(number, NULL, &num) <= 0 || (int) num < 0)
 653           parse_err("Invalid number \"%s\"", number);
 654       op->number = num;
 655
 656     }
 657   else
 658       op->number = 0;
 659
 660   /* Find the register */
 661   parse_register(op, base);
 662   if (!op->width)
 663     parse_err("Missing width");
 664
 665   /* Add offset */
 666   if (offset)
 667     {
 668       unsigned int off;
 669       if (parse_x32(offset, NULL, &off) <= 0 || off >= 0x1000)
 670         parse_err("Invalid offset \"%s\"", offset);
 671       op->addr += off;
 672     }
 673
 674   /* Check range */
 675   if (op->addr >= 0x1000 || op->addr + op->width*(n ? n : 1) > 0x1000)
 676     parse_err("Register number %02x out of range", op->addr);
 677   if (op->addr & (op->width - 1))
 678     parse_err("Unaligned register address %02x", op->addr);
 679
 680   /* Parse the values */
 681   for (j=0; j<n; j++)
 682     {
 683       unsigned int ll, lim;
 684       e = strchr(value, ',');
 685       if (e)
 686         *e++ = 0;
 687       if (parse_x32(value, &f, &ll) < 0 || f && *f != ':')
 688         parse_err("Invalid value \"%s\"", value);
 689       lim = max_values[op->width];
 690       if (ll > lim && ll < ~0U - lim)
 691         parse_err("Value \"%s\" is out of range", value);
 692       op->values[j].value = ll;
 693       if (f && *f == ':')
 694         {
 695           if (parse_x32(f+1, NULL, &ll) <= 0)
 696             parse_err("Invalid mask \"%s\"", f+1);
 697           if (ll > lim && ll < ~0U - lim)
 698             parse_err("Mask \"%s\" is out of range", f+1);
 699           op->values[j].mask = ll;
 700           op->values[j].value &= ll;
 701         }
 702       else
 703         op->values[j].mask = ~0U;
 704       value = e;
 705     }
 706
 707   *last_op = op;
 708   last_op = &op->next;
 709   op->next = NULL;
 710 }
 711
 712 static void parse_ops(int argc, char **argv, int i)
 713 {
 714   enum { STATE_INIT, STATE_GOT_FILTER, STATE_GOT_OP } state = STATE_INIT;
 715   struct pci_filter filter;
 716   struct pci_dev **selected_devices = NULL;
 717
 718   while (i < argc)
 719     {
 720       char *c = argv[i++];
 721
 722       if (*c == '-')
 723         {
 724           if (state != STATE_GOT_FILTER)
 725             pci_filter_init(pacc, &filter);
 726           i = parse_filter(argc, argv, i-1, &filter);
 727           state = STATE_GOT_FILTER;
 728         }
 729       else
 730         {
 731           if (state == STATE_INIT)
 732             parse_err("Filter specification expected");
 733           if (state == STATE_GOT_FILTER)
 734             selected_devices = select_devices(&filter);
 735           if (!selected_devices[0] && !force)
 736             fprintf(stderr, "setpci: Warning: No devices selected for \"%s\".\n", c);
 737           parse_op(c, selected_devices);
 738           state = STATE_GOT_OP;
 739         }
 740     }
 741   if (state == STATE_INIT)
 742     parse_err("No operation specified");
 743 }
 744
 745 int
 746 main(int argc, char **argv)
 747 {
 748   int i;
 749
 750   pacc = pci_alloc();
 751   pacc->error = die;
 752   i = parse_options(argc, argv);
 753
 754   pci_init(pacc);
 755   pci_scan_bus(pacc);
 756
 757   parse_ops(argc, argv, i);
 758   scan_ops(first_op);
 759   execute(first_op);
 760
 761   return 0;
 762 }