src/southbridge/intel/i82801dbm/i82801dbm.c

   1 #include <console/console.h>
   2 #include <device/device.h>
   3 #include <device/pci.h>
   4 #include <device/pci_ids.h>
   5 #include "i82801dbm.h"
   6
   7 void i82801dbm_enable(device_t dev)
   8 {
   9         device_t lpc_dev;
  10         unsigned int index;
  11         uint16_t reg_old, reg;
  12
  13 //      all 82801dbm device ares in bus 0
  14         unsigned int devfn;
  15         devfn = PCI_DEVFN(0x1f, 0); // lpc
  16         lpc_dev = dev_find_slot(0, devfn); // 0
  17         if (!lpc_dev ) {
  18                 return;
  19         }
  20 #if 0
  21         if ((lpc_dev->vendor != PCI_VENDOR_ID_INTEL) ||
  22             (lpc_dev->device != PCI_DEVICE_ID_INTEL_82801DBM_1F0)) {
  23                 uint32_t id;
  24                 id = pci_read_config32(lpc_dev, PCI_VENDOR_ID);
  25                 if (id != (PCI_VENDOR_ID_INTEL | (PCI_DEVICE_ID_INTEL_82801DBM_1F0 << 16))) {
  26                         return;
  27                 }
  28         }
  29 #endif
  30
  31         index = (dev->path.u.pci.devfn & 7);
  32         if((dev->path.u.pci.devfn & ~0x7)==devfn) { // D=0x1f
  33                 if(index==0){   //1f0
  34                         index = 14;
  35                 }
  36         } else { // D=0x1d
  37                 index += 8;
  38         }
  39
  40         reg_old = pci_read_config16(lpc_dev, FUNC_DIS);
  41         reg = reg_old;
  42         reg &= ~(1<<index); // enable it
  43         if (!dev->enabled) {
  44                 reg |= (1<<index);  // disable it
  45         }
  46         if (reg != reg_old) {
  47                 pci_write_config16(lpc_dev, FUNC_DIS, reg);
  48         }
  49         reg = pci_read_config16(lpc_dev, FUNC_DIS);
  50
  51 }
  52
  53 struct chip_operations southbridge_intel_i82801dbm_control = {
  54         .name       = "Intel 82801dbm Southbridge",
  55         .enable_dev = i82801dbm_enable,
  56 };