src/southbridge/intel/i82801ix/usb_ehci.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <console/console.h>
   4 #include <device/device.h>
   5 #include <device/pci.h>
   6 #include <device/pci_ops.h>
   7 #include <device/pci_ids.h>
   8 #include "i82801ix.h"
   9 #include <device/pci_ehci.h>
  10
  11 static void usb_ehci_init(struct device *dev)
  12 {
  13         printk(BIOS_DEBUG, "EHCI: Setting up controller.. ");
  14         pci_or_config16(dev, PCI_COMMAND, PCI_COMMAND_MASTER);
  15
  16         printk(BIOS_DEBUG, "done.\n");
  17 }
  18
  19 static void usb_ehci_set_subsystem(struct device *dev, unsigned int vendor,
  20                                    unsigned int device)
  21 {
  22         u8 access_cntl;
  23
  24         access_cntl = pci_read_config8(dev, 0x80);
  25
  26         /* Enable writes to protected registers. */
  27         pci_write_config8(dev, 0x80, access_cntl | 1);
  28
  29         pci_dev_set_subsystem(dev, vendor, device);
  30
  31         /* Restore protection. */
  32         pci_write_config8(dev, 0x80, access_cntl);
  33 }
  34
  35 static const unsigned short pci_device_ids[] = {
  36         PCI_DID_INTEL_82801IB_EHCI1,
  37         PCI_DID_INTEL_82801IB_EHCI2,
  38         0
  39 };
  40
  41 static struct pci_operations lops_pci = {
  42         .set_subsystem  = &usb_ehci_set_subsystem,
  43 };
  44
  45 static struct device_operations usb_ehci_ops = {
  46         .read_resources         = pci_ehci_read_resources,
  47         .set_resources          = pci_dev_set_resources,
  48         .enable_resources       = pci_dev_enable_resources,
  49         .init                   = usb_ehci_init,
  50         .ops_pci                = &lops_pci,
  51 };
  52
  53 static const struct pci_driver pch_usb_ehci1 __pci_driver = {
  54         .ops    = &usb_ehci_ops,
  55         .vendor = PCI_VID_INTEL,
  56         .devices = pci_device_ids,
  57 };