hw/pci_host.c

   1 /*
   2  * pci_host.c
   3  *
   4  * Copyright (c) 2009 Isaku Yamahata <yamahata at valinux co jp>
   5  *                    VA Linux Systems Japan K.K.
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16
  17  * You should have received a copy of the GNU General Public License along
  18  * with this program; if not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include "pci.h"
  22 #include "pci_host.h"
  23
  24 /* debug PCI */
  25 //#define DEBUG_PCI
  26
  27 #ifdef DEBUG_PCI
  28 #define PCI_DPRINTF(fmt, ...) \
  29 do { printf("pci_host_data: " fmt , ## __VA_ARGS__); } while (0)
  30 #else
  31 #define PCI_DPRINTF(fmt, ...)
  32 #endif
  33
  34 /*
  35  * PCI address
  36  * bit 16 - 24: bus number
  37  * bit  8 - 15: devfun number
  38  * bit  0 -  7: offset in configuration space of a given pci device
  39  */
  40
  41 /* the helper functio to get a PCIDeice* for a given pci address */
  42 static inline PCIDevice *pci_dev_find_by_addr(PCIBus *bus, uint32_t addr)
  43 {
  44     uint8_t bus_num = addr >> 16;
  45     uint8_t devfn = addr >> 8;
  46
  47     return pci_find_device(bus, bus_num, devfn);
  48 }
  49
  50 void pci_host_config_write_common(PCIDevice *pci_dev, uint32_t addr,
  51                                   uint32_t limit, uint32_t val, uint32_t len)
  52 {
  53     assert(len <= 4);
  54     pci_dev->config_write(pci_dev, addr, val, MIN(len, limit - addr));
  55 }
  56
  57 uint32_t pci_host_config_read_common(PCIDevice *pci_dev, uint32_t addr,
  58                                      uint32_t limit, uint32_t len)
  59 {
  60     assert(len <= 4);
  61     return pci_dev->config_read(pci_dev, addr, MIN(len, limit - addr));
  62 }
  63
  64 void pci_data_write(PCIBus *s, uint32_t addr, uint32_t val, int len)
  65 {
  66     PCIDevice *pci_dev = pci_dev_find_by_addr(s, addr);
  67     uint32_t config_addr = addr & (PCI_CONFIG_SPACE_SIZE - 1);
  68
  69     if (!pci_dev) {
  70         return;
  71     }
  72
  73     PCI_DPRINTF("%s: %s: addr=%02" PRIx32 " val=%08" PRIx32 " len=%d\n",
  74                 __func__, pci_dev->name, config_addr, val, len);
  75     pci_host_config_write_common(pci_dev, config_addr, PCI_CONFIG_SPACE_SIZE,
  76                                  val, len);
  77 }
  78
  79 uint32_t pci_data_read(PCIBus *s, uint32_t addr, int len)
  80 {
  81     PCIDevice *pci_dev = pci_dev_find_by_addr(s, addr);
  82     uint32_t config_addr = addr & (PCI_CONFIG_SPACE_SIZE - 1);
  83     uint32_t val;
  84
  85     if (!pci_dev) {
  86         return ~0x0;
  87     }
  88
  89     val = pci_host_config_read_common(pci_dev, config_addr,
  90                                       PCI_CONFIG_SPACE_SIZE, len);
  91     PCI_DPRINTF("%s: %s: addr=%02"PRIx32" val=%08"PRIx32" len=%d\n",
  92                 __func__, pci_dev->name, config_addr, val, len);
  93
  94     return val;
  95 }
  96
  97 static void pci_host_config_write(ReadWriteHandler *handler,
  98                                   pcibus_t addr, uint32_t val, int len)
  99 {
 100     PCIHostState *s = container_of(handler, PCIHostState, conf_handler);
 101
 102     PCI_DPRINTF("%s addr %" FMT_PCIBUS " %d val %"PRIx32"\n",
 103                 __func__, addr, len, val);
 104     s->config_reg = val;
 105 }
 106
 107 static uint32_t pci_host_config_read(ReadWriteHandler *handler,
 108                                      pcibus_t addr, int len)
 109 {
 110     PCIHostState *s = container_of(handler, PCIHostState, conf_handler);
 111     uint32_t val = s->config_reg;
 112
 113     PCI_DPRINTF("%s addr %" FMT_PCIBUS " len %d val %"PRIx32"\n",
 114                 __func__, addr, len, val);
 115     return val;
 116 }
 117
 118 static void pci_host_data_write(ReadWriteHandler *handler,
 119                                 pcibus_t addr, uint32_t val, int len)
 120 {
 121     PCIHostState *s = container_of(handler, PCIHostState, data_handler);
 122     PCI_DPRINTF("write addr %" FMT_PCIBUS " len %d val %x\n",
 123                 addr, len, val);
 124     if (s->config_reg & (1u << 31))
 125         pci_data_write(s->bus, s->config_reg | (addr & 3), val, len);
 126 }
 127
 128 static uint32_t pci_host_data_read(ReadWriteHandler *handler,
 129                                    pcibus_t addr, int len)
 130 {
 131     PCIHostState *s = container_of(handler, PCIHostState, data_handler);
 132     uint32_t val;
 133     if (!(s->config_reg & (1 << 31)))
 134         return 0xffffffff;
 135     val = pci_data_read(s->bus, s->config_reg | (addr & 3), len);
 136     PCI_DPRINTF("read addr %" FMT_PCIBUS " len %d val %x\n",
 137                 addr, len, val);
 138     return val;
 139 }
 140
 141 static void pci_host_init(PCIHostState *s)
 142 {
 143     s->conf_handler.write = pci_host_config_write;
 144     s->conf_handler.read = pci_host_config_read;
 145     s->data_handler.write = pci_host_data_write;
 146     s->data_handler.read = pci_host_data_read;
 147 }
 148
 149 int pci_host_conf_register_mmio(PCIHostState *s, int endian)
 150 {
 151     pci_host_init(s);
 152     return cpu_register_io_memory_simple(&s->conf_handler, endian);
 153 }
 154
 155 void pci_host_conf_register_ioport(pio_addr_t ioport, PCIHostState *s)
 156 {
 157     pci_host_init(s);
 158     register_ioport_simple(&s->conf_handler, ioport, 4, 4);
 159     sysbus_init_ioports(&s->busdev, ioport, 4);
 160 }
 161
 162 int pci_host_data_register_mmio(PCIHostState *s, int endian)
 163 {
 164     pci_host_init(s);
 165     return cpu_register_io_memory_simple(&s->data_handler, endian);
 166 }
 167
 168 void pci_host_data_register_ioport(pio_addr_t ioport, PCIHostState *s)
 169 {
 170     pci_host_init(s);
 171     register_ioport_simple(&s->data_handler, ioport, 4, 1);
 172     register_ioport_simple(&s->data_handler, ioport, 4, 2);
 173     register_ioport_simple(&s->data_handler, ioport, 4, 4);
 174     sysbus_init_ioports(&s->busdev, ioport, 4);
 175 }