1 /*- 2 * Copyright (c) 1997, Stefan Esser <se@kfreebsd.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice unmodified, this list of conditions, and the following 10 * disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 * 26 * $FreeBSD: src/sys/dev/pci/pci_user.c,v 1.22.2.4.2.1 2009/04/15 03:14:26 kensmith Exp $ 27 */ 28 29 #include <sys/param.h> 30 #include <sys/systm.h> 31 #include <sys/malloc.h> 32 #include <sys/module.h> 33 #include <sys/linker.h> 34 #include <sys/fcntl.h> 35 #include <sys/caps.h> 36 #include <sys/conf.h> 37 #include <sys/kernel.h> 38 #include <sys/proc.h> 39 #include <sys/queue.h> 40 #include <sys/types.h> 41 42 #include <vm/vm.h> 43 #include <vm/pmap.h> 44 #include <vm/vm_extern.h> 45 46 #include <sys/bus.h> 47 #include <sys/rman.h> 48 #include <sys/device.h> 49 #include <sys/pciio.h> 50 #include <bus/pci/pcireg.h> 51 #include <bus/pci/pcivar.h> 52 53 #include "pcib_if.h" 54 #include "pci_if.h" 55 56 /* 57 * This is the user interface to PCI configuration space. 58 */ 59 static struct lwkt_token pci_token = LWKT_TOKEN_INITIALIZER(pci_token); 60 61 static d_open_t pci_open; 62 static d_close_t pci_close; 63 static int pci_conf_match(struct pci_match_conf *matches, int num_matches, 64 struct pci_conf *match_buf); 65 static d_ioctl_t pci_ioctl; 66 67 struct dev_ops pci_ops = { 68 { "pci", 0, D_MPSAFE }, 69 .d_open = pci_open, 70 .d_close = pci_close, 71 .d_ioctl = pci_ioctl, 72 }; 73 74 static int 75 pci_open(struct dev_open_args *ap) 76 { 77 int oflags = ap->a_oflags; 78 79 /* 80 * Disallow access to disk volumes if RESTRICTEDROOT 81 */ 82 if (caps_priv_check_self(SYSCAP_RESTRICTEDROOT)) 83 return (EPERM); 84 85 if (oflags & FWRITE) { 86 if (securelevel > 0) 87 return (EPERM); 88 } 89 90 return (0); 91 } 92 93 static int 94 pci_close(struct dev_close_args *ap) 95 { 96 return 0; 97 } 98 99 /* 100 * Match a single pci_conf structure against an array of pci_match_conf 101 * structures. The first argument, 'matches', is an array of num_matches 102 * pci_match_conf structures. match_buf is a pointer to the pci_conf 103 * structure that will be compared to every entry in the matches array. 104 * This function returns 1 on failure, 0 on success. 105 */ 106 static int 107 pci_conf_match(struct pci_match_conf *matches, int num_matches, 108 struct pci_conf *match_buf) 109 { 110 int i; 111 112 if ((matches == NULL) || (match_buf == NULL) || (num_matches <= 0)) 113 return(1); 114 115 for (i = 0; i < num_matches; i++) { 116 /* 117 * I'm not sure why someone would do this...but... 118 */ 119 if (matches[i].flags == PCI_GETCONF_NO_MATCH) 120 continue; 121 122 /* 123 * Look at each of the match flags. If it's set, do the 124 * comparison. If the comparison fails, we don't have a 125 * match, go on to the next item if there is one. 126 */ 127 if (((matches[i].flags & PCI_GETCONF_MATCH_DOMAIN) != 0) 128 && (match_buf->pc_sel.pc_domain != 129 matches[i].pc_sel.pc_domain)) 130 continue; 131 132 if (((matches[i].flags & PCI_GETCONF_MATCH_BUS) != 0) 133 && (match_buf->pc_sel.pc_bus != matches[i].pc_sel.pc_bus)) 134 continue; 135 136 if (((matches[i].flags & PCI_GETCONF_MATCH_DEV) != 0) 137 && (match_buf->pc_sel.pc_dev != matches[i].pc_sel.pc_dev)) 138 continue; 139 140 if (((matches[i].flags & PCI_GETCONF_MATCH_FUNC) != 0) 141 && (match_buf->pc_sel.pc_func != matches[i].pc_sel.pc_func)) 142 continue; 143 144 if (((matches[i].flags & PCI_GETCONF_MATCH_VENDOR) != 0) 145 && (match_buf->pc_vendor != matches[i].pc_vendor)) 146 continue; 147 148 if (((matches[i].flags & PCI_GETCONF_MATCH_DEVICE) != 0) 149 && (match_buf->pc_device != matches[i].pc_device)) 150 continue; 151 152 if (((matches[i].flags & PCI_GETCONF_MATCH_CLASS) != 0) 153 && (match_buf->pc_class != matches[i].pc_class)) 154 continue; 155 156 if (((matches[i].flags & PCI_GETCONF_MATCH_UNIT) != 0) 157 && (match_buf->pd_unit != matches[i].pd_unit)) 158 continue; 159 160 if (((matches[i].flags & PCI_GETCONF_MATCH_NAME) != 0) 161 && (strncmp(matches[i].pd_name, match_buf->pd_name, 162 sizeof(match_buf->pd_name)) != 0)) 163 continue; 164 165 return(0); 166 } 167 168 return(1); 169 } 170 171 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \ 172 defined(COMPAT_FREEBSD6) || defined(__DragonFly__) 173 #define PRE7_COMPAT 174 175 typedef enum { 176 PCI_GETCONF_NO_MATCH_OLD = 0x00, 177 PCI_GETCONF_MATCH_BUS_OLD = 0x01, 178 PCI_GETCONF_MATCH_DEV_OLD = 0x02, 179 PCI_GETCONF_MATCH_FUNC_OLD = 0x04, 180 PCI_GETCONF_MATCH_NAME_OLD = 0x08, 181 PCI_GETCONF_MATCH_UNIT_OLD = 0x10, 182 PCI_GETCONF_MATCH_VENDOR_OLD = 0x20, 183 PCI_GETCONF_MATCH_DEVICE_OLD = 0x40, 184 PCI_GETCONF_MATCH_CLASS_OLD = 0x80 185 } pci_getconf_flags_old; 186 187 struct pcisel_old { 188 u_int8_t pc_bus; /* bus number */ 189 u_int8_t pc_dev; /* device on this bus */ 190 u_int8_t pc_func; /* function on this device */ 191 }; 192 193 struct pci_conf_old { 194 struct pcisel_old pc_sel; /* bus+slot+function */ 195 u_int8_t pc_hdr; /* PCI header type */ 196 u_int16_t pc_subvendor; /* card vendor ID */ 197 u_int16_t pc_subdevice; /* card device ID, assigned by 198 card vendor */ 199 u_int16_t pc_vendor; /* chip vendor ID */ 200 u_int16_t pc_device; /* chip device ID, assigned by 201 chip vendor */ 202 u_int8_t pc_class; /* chip PCI class */ 203 u_int8_t pc_subclass; /* chip PCI subclass */ 204 u_int8_t pc_progif; /* chip PCI programming interface */ 205 u_int8_t pc_revid; /* chip revision ID */ 206 char pd_name[PCI_MAXNAMELEN + 1]; /* device name */ 207 u_long pd_unit; /* device unit number */ 208 }; 209 210 struct pci_match_conf_old { 211 struct pcisel_old pc_sel; /* bus+slot+function */ 212 char pd_name[PCI_MAXNAMELEN + 1]; /* device name */ 213 u_long pd_unit; /* Unit number */ 214 u_int16_t pc_vendor; /* PCI Vendor ID */ 215 u_int16_t pc_device; /* PCI Device ID */ 216 u_int8_t pc_class; /* PCI class */ 217 pci_getconf_flags_old flags; /* Matching expression */ 218 }; 219 220 struct pci_io_old { 221 struct pcisel_old pi_sel; /* device to operate on */ 222 int pi_reg; /* configuration register to examine */ 223 int pi_width; /* width (in bytes) of read or write */ 224 u_int32_t pi_data; /* data to write or result of read */ 225 }; 226 227 #define PCIOCGETCONF_OLD _IOWR('p', 1, struct pci_conf_io) 228 #define PCIOCREAD_OLD _IOWR('p', 2, struct pci_io_old) 229 #define PCIOCWRITE_OLD _IOWR('p', 3, struct pci_io_old) 230 231 static int pci_conf_match_old(struct pci_match_conf_old *matches, 232 int num_matches, struct pci_conf *match_buf); 233 234 static int 235 pci_conf_match_old(struct pci_match_conf_old *matches, int num_matches, 236 struct pci_conf *match_buf) 237 { 238 int i; 239 240 if ((matches == NULL) || (match_buf == NULL) || (num_matches <= 0)) 241 return(1); 242 243 for (i = 0; i < num_matches; i++) { 244 if (match_buf->pc_sel.pc_domain != 0) 245 continue; 246 247 /* 248 * I'm not sure why someone would do this...but... 249 */ 250 if (matches[i].flags == PCI_GETCONF_NO_MATCH_OLD) 251 continue; 252 253 /* 254 * Look at each of the match flags. If it's set, do the 255 * comparison. If the comparison fails, we don't have a 256 * match, go on to the next item if there is one. 257 */ 258 if (((matches[i].flags & PCI_GETCONF_MATCH_BUS_OLD) != 0) 259 && (match_buf->pc_sel.pc_bus != matches[i].pc_sel.pc_bus)) 260 continue; 261 262 if (((matches[i].flags & PCI_GETCONF_MATCH_DEV_OLD) != 0) 263 && (match_buf->pc_sel.pc_dev != matches[i].pc_sel.pc_dev)) 264 continue; 265 266 if (((matches[i].flags & PCI_GETCONF_MATCH_FUNC_OLD) != 0) 267 && (match_buf->pc_sel.pc_func != matches[i].pc_sel.pc_func)) 268 continue; 269 270 if (((matches[i].flags & PCI_GETCONF_MATCH_VENDOR_OLD) != 0) 271 && (match_buf->pc_vendor != matches[i].pc_vendor)) 272 continue; 273 274 if (((matches[i].flags & PCI_GETCONF_MATCH_DEVICE_OLD) != 0) 275 && (match_buf->pc_device != matches[i].pc_device)) 276 continue; 277 278 if (((matches[i].flags & PCI_GETCONF_MATCH_CLASS_OLD) != 0) 279 && (match_buf->pc_class != matches[i].pc_class)) 280 continue; 281 282 if (((matches[i].flags & PCI_GETCONF_MATCH_UNIT_OLD) != 0) 283 && (match_buf->pd_unit != matches[i].pd_unit)) 284 continue; 285 286 if (((matches[i].flags & PCI_GETCONF_MATCH_NAME_OLD) != 0) 287 && (strncmp(matches[i].pd_name, match_buf->pd_name, 288 sizeof(match_buf->pd_name)) != 0)) 289 continue; 290 291 return(0); 292 } 293 294 return(1); 295 } 296 297 #endif 298 299 static int 300 pci_ioctl(struct dev_ioctl_args *ap) 301 { 302 device_t pcidev, brdev; 303 void *confdata; 304 const char *name; 305 struct devlist *devlist_head; 306 struct pci_conf_io *cio; 307 struct pci_devinfo *dinfo; 308 struct pci_io *io; 309 struct pci_bar_io *bio; 310 struct pci_match_conf *pattern_buf; 311 struct resource_list_entry *rle; 312 uint32_t value; 313 size_t confsz, iolen, pbufsz; 314 int error, ionum, i, num_patterns; 315 #ifdef PRE7_COMPAT 316 struct pci_conf_old conf_old; 317 struct pci_io iodata; 318 struct pci_io_old *io_old; 319 struct pci_match_conf_old *pattern_buf_old; 320 321 io_old = NULL; 322 pattern_buf_old = NULL; 323 324 if (!(ap->a_fflag & FWRITE) && ap->a_cmd != PCIOCGETBAR && 325 ap->a_cmd != PCIOCGETCONF && ap->a_cmd != PCIOCGETCONF_OLD) 326 return EPERM; 327 #else 328 if (!(ap->a_fflag & FWRITE) && ap->a_cmd != PCIOCGETBAR && ap->a_cmd != PCIOCGETCONF) 329 return EPERM; 330 #endif 331 332 lwkt_gettoken(&pci_token); 333 334 switch(ap->a_cmd) { 335 #ifdef PRE7_COMPAT 336 case PCIOCGETCONF_OLD: 337 /* FALLTHROUGH */ 338 #endif 339 case PCIOCGETCONF: 340 cio = (struct pci_conf_io *)ap->a_data; 341 342 pattern_buf = NULL; 343 num_patterns = 0; 344 dinfo = NULL; 345 346 cio->num_matches = 0; 347 348 /* 349 * If the user specified an offset into the device list, 350 * but the list has changed since they last called this 351 * ioctl, tell them that the list has changed. They will 352 * have to get the list from the beginning. 353 */ 354 if ((cio->offset != 0) 355 && (cio->generation != pci_generation)){ 356 cio->status = PCI_GETCONF_LIST_CHANGED; 357 error = 0; 358 break; 359 } 360 361 /* 362 * Check to see whether the user has asked for an offset 363 * past the end of our list. 364 */ 365 if (cio->offset >= pci_numdevs) { 366 cio->status = PCI_GETCONF_LAST_DEVICE; 367 error = 0; 368 break; 369 } 370 371 /* get the head of the device queue */ 372 devlist_head = &pci_devq; 373 374 /* 375 * Determine how much room we have for pci_conf structures. 376 * Round the user's buffer size down to the nearest 377 * multiple of sizeof(struct pci_conf) in case the user 378 * didn't specify a multiple of that size. 379 */ 380 #ifdef PRE7_COMPAT 381 if (ap->a_cmd == PCIOCGETCONF_OLD) 382 confsz = sizeof(struct pci_conf_old); 383 else 384 #endif 385 confsz = sizeof(struct pci_conf); 386 iolen = min(cio->match_buf_len - (cio->match_buf_len % confsz), 387 pci_numdevs * confsz); 388 389 /* 390 * Since we know that iolen is a multiple of the size of 391 * the pciconf union, it's okay to do this. 392 */ 393 ionum = iolen / confsz; 394 395 /* 396 * If this test is true, the user wants the pci_conf 397 * structures returned to match the supplied entries. 398 */ 399 if ((cio->num_patterns > 0) && (cio->num_patterns < pci_numdevs) 400 && (cio->pat_buf_len > 0)) { 401 /* 402 * pat_buf_len needs to be: 403 * num_patterns * sizeof(struct pci_match_conf) 404 * While it is certainly possible the user just 405 * allocated a large buffer, but set the number of 406 * matches correctly, it is far more likely that 407 * their kernel doesn't match the userland utility 408 * they're using. It's also possible that the user 409 * forgot to initialize some variables. Yes, this 410 * may be overly picky, but I hazard to guess that 411 * it's far more likely to just catch folks that 412 * updated their kernel but not their userland. 413 */ 414 #ifdef PRE7_COMPAT 415 if (ap->a_cmd == PCIOCGETCONF_OLD) 416 pbufsz = sizeof(struct pci_match_conf_old); 417 else 418 #endif 419 pbufsz = sizeof(struct pci_match_conf); 420 if (cio->num_patterns * pbufsz != cio->pat_buf_len) { 421 /* The user made a mistake, return an error. */ 422 cio->status = PCI_GETCONF_ERROR; 423 error = EINVAL; 424 break; 425 } 426 427 /* 428 * Allocate a buffer to hold the patterns. 429 */ 430 #ifdef PRE7_COMPAT 431 if (ap->a_cmd == PCIOCGETCONF_OLD) { 432 pattern_buf_old = kmalloc(cio->pat_buf_len, 433 M_TEMP, M_WAITOK); 434 error = copyin(cio->patterns, 435 pattern_buf_old, cio->pat_buf_len); 436 } else 437 #endif 438 { 439 pattern_buf = kmalloc(cio->pat_buf_len, M_TEMP, 440 M_WAITOK); 441 error = copyin(cio->patterns, pattern_buf, 442 cio->pat_buf_len); 443 } 444 if (error != 0) { 445 error = EINVAL; 446 goto getconfexit; 447 } 448 num_patterns = cio->num_patterns; 449 } else if ((cio->num_patterns > 0) 450 || (cio->pat_buf_len > 0)) { 451 /* 452 * The user made a mistake, spit out an error. 453 */ 454 cio->status = PCI_GETCONF_ERROR; 455 error = EINVAL; 456 break; 457 } 458 459 /* 460 * Go through the list of devices and copy out the devices 461 * that match the user's criteria. 462 */ 463 for (cio->num_matches = 0, error = 0, i = 0, 464 dinfo = STAILQ_FIRST(devlist_head); 465 (dinfo != NULL) && (cio->num_matches < ionum) 466 && (error == 0) && (i < pci_numdevs) && (dinfo != NULL); 467 dinfo = STAILQ_NEXT(dinfo, pci_links), i++) { 468 469 if (i < cio->offset) 470 continue; 471 472 /* Populate pd_name and pd_unit */ 473 name = NULL; 474 if (dinfo->cfg.dev) 475 name = device_get_name(dinfo->cfg.dev); 476 if (name) { 477 strncpy(dinfo->conf.pd_name, name, 478 sizeof(dinfo->conf.pd_name)); 479 dinfo->conf.pd_name[PCI_MAXNAMELEN] = 0; 480 dinfo->conf.pd_unit = 481 device_get_unit(dinfo->cfg.dev); 482 } else { 483 dinfo->conf.pd_name[0] = '\0'; 484 dinfo->conf.pd_unit = 0; 485 } 486 487 #ifdef PRE7_COMPAT 488 if ((ap->a_cmd == PCIOCGETCONF_OLD && 489 (pattern_buf_old == NULL || 490 pci_conf_match_old(pattern_buf_old, num_patterns, 491 &dinfo->conf) == 0)) || 492 (ap->a_cmd == PCIOCGETCONF && 493 (pattern_buf == NULL || 494 pci_conf_match(pattern_buf, num_patterns, 495 &dinfo->conf) == 0))) { 496 #else 497 if (pattern_buf == NULL || 498 pci_conf_match(pattern_buf, num_patterns, 499 &dinfo->conf) == 0) { 500 #endif 501 /* 502 * If we've filled up the user's buffer, 503 * break out at this point. Since we've 504 * got a match here, we'll pick right back 505 * up at the matching entry. We can also 506 * tell the user that there are more matches 507 * left. 508 */ 509 if (cio->num_matches >= ionum) 510 break; 511 512 #ifdef PRE7_COMPAT 513 if (ap->a_cmd == PCIOCGETCONF_OLD) { 514 conf_old.pc_sel.pc_bus = 515 dinfo->conf.pc_sel.pc_bus; 516 conf_old.pc_sel.pc_dev = 517 dinfo->conf.pc_sel.pc_dev; 518 conf_old.pc_sel.pc_func = 519 dinfo->conf.pc_sel.pc_func; 520 conf_old.pc_hdr = dinfo->conf.pc_hdr; 521 conf_old.pc_subvendor = 522 dinfo->conf.pc_subvendor; 523 conf_old.pc_subdevice = 524 dinfo->conf.pc_subdevice; 525 conf_old.pc_vendor = 526 dinfo->conf.pc_vendor; 527 conf_old.pc_device = 528 dinfo->conf.pc_device; 529 conf_old.pc_class = 530 dinfo->conf.pc_class; 531 conf_old.pc_subclass = 532 dinfo->conf.pc_subclass; 533 conf_old.pc_progif = 534 dinfo->conf.pc_progif; 535 conf_old.pc_revid = 536 dinfo->conf.pc_revid; 537 strncpy(conf_old.pd_name, 538 dinfo->conf.pd_name, 539 sizeof(conf_old.pd_name)); 540 conf_old.pd_name[PCI_MAXNAMELEN] = 0; 541 conf_old.pd_unit = 542 dinfo->conf.pd_unit; 543 confdata = &conf_old; 544 } else 545 #endif 546 confdata = &dinfo->conf; 547 /* Only if we can copy it out do we count it. */ 548 if (!(error = copyout(confdata, 549 (caddr_t)cio->matches + 550 confsz * cio->num_matches, confsz))) 551 cio->num_matches++; 552 } 553 } 554 555 /* 556 * Set the pointer into the list, so if the user is getting 557 * n records at a time, where n < pci_numdevs, 558 */ 559 cio->offset = i; 560 561 /* 562 * Set the generation, the user will need this if they make 563 * another ioctl call with offset != 0. 564 */ 565 cio->generation = pci_generation; 566 567 /* 568 * If this is the last device, inform the user so he won't 569 * bother asking for more devices. If dinfo isn't NULL, we 570 * know that there are more matches in the list because of 571 * the way the traversal is done. 572 */ 573 if (dinfo == NULL) 574 cio->status = PCI_GETCONF_LAST_DEVICE; 575 else 576 cio->status = PCI_GETCONF_MORE_DEVS; 577 578 getconfexit: 579 if (pattern_buf != NULL) 580 kfree(pattern_buf, M_TEMP); 581 #ifdef PRE7_COMPAT 582 if (pattern_buf_old != NULL) 583 kfree(pattern_buf_old, M_TEMP); 584 #endif 585 586 break; 587 588 #ifdef PRE7_COMPAT 589 case PCIOCREAD_OLD: 590 case PCIOCWRITE_OLD: 591 io_old = (struct pci_io_old *)ap->a_data; 592 iodata.pi_sel.pc_domain = 0; 593 iodata.pi_sel.pc_bus = io_old->pi_sel.pc_bus; 594 iodata.pi_sel.pc_dev = io_old->pi_sel.pc_dev; 595 iodata.pi_sel.pc_func = io_old->pi_sel.pc_func; 596 iodata.pi_reg = io_old->pi_reg; 597 iodata.pi_width = io_old->pi_width; 598 iodata.pi_data = io_old->pi_data; 599 ap->a_data = (caddr_t)&iodata; 600 /* FALLTHROUGH */ 601 #endif 602 case PCIOCREAD: 603 case PCIOCWRITE: 604 io = (struct pci_io *)ap->a_data; 605 switch(io->pi_width) { 606 case 4: 607 case 2: 608 case 1: 609 /* Make sure register is not negative and aligned. */ 610 if (io->pi_reg < 0 || 611 io->pi_reg & (io->pi_width - 1)) { 612 error = EINVAL; 613 break; 614 } 615 /* 616 * Assume that the user-level bus number is 617 * in fact the physical PCI bus number. 618 * Look up the grandparent, i.e. the bridge device, 619 * so that we can issue configuration space cycles. 620 */ 621 pcidev = pci_find_dbsf(io->pi_sel.pc_domain, 622 io->pi_sel.pc_bus, io->pi_sel.pc_dev, 623 io->pi_sel.pc_func); 624 if (pcidev) { 625 brdev = device_get_parent( 626 device_get_parent(pcidev)); 627 628 #ifdef PRE7_COMPAT 629 if (ap->a_cmd == PCIOCWRITE || ap->a_cmd == PCIOCWRITE_OLD) 630 #else 631 if (ap->a_cmd == PCIOCWRITE) 632 #endif 633 PCIB_WRITE_CONFIG(brdev, 634 io->pi_sel.pc_bus, 635 io->pi_sel.pc_dev, 636 io->pi_sel.pc_func, 637 io->pi_reg, 638 io->pi_data, 639 io->pi_width); 640 #ifdef PRE7_COMPAT 641 else if (ap->a_cmd == PCIOCREAD_OLD) 642 io_old->pi_data = 643 PCIB_READ_CONFIG(brdev, 644 io->pi_sel.pc_bus, 645 io->pi_sel.pc_dev, 646 io->pi_sel.pc_func, 647 io->pi_reg, 648 io->pi_width); 649 #endif 650 else 651 io->pi_data = 652 PCIB_READ_CONFIG(brdev, 653 io->pi_sel.pc_bus, 654 io->pi_sel.pc_dev, 655 io->pi_sel.pc_func, 656 io->pi_reg, 657 io->pi_width); 658 error = 0; 659 } else { 660 #ifdef COMPAT_FREEBSD4 661 if (cmd == PCIOCREAD_OLD) { 662 io_old->pi_data = -1; 663 error = 0; 664 } else 665 #endif 666 error = ENODEV; 667 } 668 break; 669 default: 670 error = EINVAL; 671 break; 672 } 673 break; 674 675 case PCIOCGETBAR: 676 bio = (struct pci_bar_io *)ap->a_data; 677 678 /* 679 * Assume that the user-level bus number is 680 * in fact the physical PCI bus number. 681 */ 682 pcidev = pci_find_dbsf(bio->pbi_sel.pc_domain, 683 bio->pbi_sel.pc_bus, bio->pbi_sel.pc_dev, 684 bio->pbi_sel.pc_func); 685 if (pcidev == NULL) { 686 error = ENODEV; 687 break; 688 } 689 dinfo = device_get_ivars(pcidev); 690 691 /* 692 * Look for a resource list entry matching the requested BAR. 693 * 694 * XXX: This will not find BARs that are not initialized, but 695 * maybe that is ok? 696 */ 697 rle = resource_list_find(&dinfo->resources, SYS_RES_MEMORY, 698 bio->pbi_reg); 699 if (rle == NULL) 700 rle = resource_list_find(&dinfo->resources, 701 SYS_RES_IOPORT, bio->pbi_reg); 702 if (rle == NULL || rle->res == NULL) { 703 error = EINVAL; 704 break; 705 } 706 707 /* 708 * Ok, we have a resource for this BAR. Read the lower 709 * 32 bits to get any flags. 710 */ 711 value = pci_read_config(pcidev, bio->pbi_reg, 4); 712 if (PCI_BAR_MEM(value)) { 713 if (rle->type != SYS_RES_MEMORY) { 714 error = EINVAL; 715 break; 716 } 717 value &= ~PCIM_BAR_MEM_BASE; 718 } else { 719 if (rle->type != SYS_RES_IOPORT) { 720 error = EINVAL; 721 break; 722 } 723 value &= ~PCIM_BAR_IO_BASE; 724 } 725 bio->pbi_base = rman_get_start(rle->res) | value; 726 bio->pbi_length = rman_get_size(rle->res); 727 728 /* 729 * Check the command register to determine if this BAR 730 * is enabled. 731 */ 732 value = pci_read_config(pcidev, PCIR_COMMAND, 2); 733 if (rle->type == SYS_RES_MEMORY) 734 bio->pbi_enabled = (value & PCIM_CMD_MEMEN) != 0; 735 else 736 bio->pbi_enabled = (value & PCIM_CMD_PORTEN) != 0; 737 error = 0; 738 break; 739 case PCIOCATTACHED: 740 error = 0; 741 io = (struct pci_io *)ap->a_data; 742 pcidev = pci_find_dbsf(io->pi_sel.pc_domain, io->pi_sel.pc_bus, 743 io->pi_sel.pc_dev, io->pi_sel.pc_func); 744 if (pcidev != NULL) 745 io->pi_data = device_is_attached(pcidev); 746 else 747 error = ENODEV; 748 break; 749 default: 750 error = ENOTTY; 751 break; 752 } 753 lwkt_reltoken(&pci_token); 754 755 return (error); 756 } 757