com32/lib/pci/readx.c

   1 #include "pci/pci.h"
   2 #include <string.h>
   3
   4 TYPE BWL(pci_read) (pciaddr_t a)
   5 {
   6   TYPE r;
   7
   8   for (;;) {
   9     switch ( __pci_cfg_type ) {
  10     case PCI_CFG_AUTO:
  11       pci_set_config_type(PCI_CFG_AUTO);
  12       break;                    /* Try again */
  13
  14     case PCI_CFG_TYPE1:
  15       {
  16         uint32_t oldcf8;
  17         cli();
  18         oldcf8 = inl(0xcf8);
  19         outl(a, 0xcf8);
  20         r = BWL(in) (0xcfc + (a & 3));
  21         outl(oldcf8, 0xcf8);
  22         sti();
  23       }
  24       return r;
  25
  26     case PCI_CFG_TYPE2:
  27       {
  28         uint8_t oldcf8, oldcfa;
  29
  30         if ( a & (0x10 << 11) )
  31           return (TYPE)~0;      /* Device 16-31 not supported */
  32
  33         cli();
  34         oldcf8 = inb(0xcf8);
  35         oldcfa = inb(0xcfa);
  36         outb(0xf0 + ((a >> (8-1)) & 0x0e), 0xcf8);
  37         outb(a >> 16, 0xcfa);
  38         r = BWL(in) (0xc000 + ((a >> (11-8)) & 0xf00) + (a & 0xff));
  39         outb(oldcf8, 0xcf8);
  40         outb(oldcfa, 0xcfa);
  41         sti();
  42       }
  43       return r;
  44
  45     case PCI_CFG_BIOS:
  46       return (TYPE) __pci_read_bios(BIOSCALL, a);
  47
  48     default:
  49       return (TYPE)~0;
  50     }
  51   }
  52 }