18d7f2e76SPhilippe Mathieu-Daudé /*
28d7f2e76SPhilippe Mathieu-Daudé * QEMU System Emulator
38d7f2e76SPhilippe Mathieu-Daudé *
48d7f2e76SPhilippe Mathieu-Daudé * Copyright (c) 2003-2008 Fabrice Bellard
58d7f2e76SPhilippe Mathieu-Daudé *
68d7f2e76SPhilippe Mathieu-Daudé * Permission is hereby granted, free of charge, to any person obtaining a copy
78d7f2e76SPhilippe Mathieu-Daudé * of this software and associated documentation files (the "Software"), to deal
88d7f2e76SPhilippe Mathieu-Daudé * in the Software without restriction, including without limitation the rights
98d7f2e76SPhilippe Mathieu-Daudé * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
108d7f2e76SPhilippe Mathieu-Daudé * copies of the Software, and to permit persons to whom the Software is
118d7f2e76SPhilippe Mathieu-Daudé * furnished to do so, subject to the following conditions:
128d7f2e76SPhilippe Mathieu-Daudé *
138d7f2e76SPhilippe Mathieu-Daudé * The above copyright notice and this permission notice shall be included in
148d7f2e76SPhilippe Mathieu-Daudé * all copies or substantial portions of the Software.
158d7f2e76SPhilippe Mathieu-Daudé *
168d7f2e76SPhilippe Mathieu-Daudé * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
178d7f2e76SPhilippe Mathieu-Daudé * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
188d7f2e76SPhilippe Mathieu-Daudé * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
198d7f2e76SPhilippe Mathieu-Daudé * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
208d7f2e76SPhilippe Mathieu-Daudé * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
218d7f2e76SPhilippe Mathieu-Daudé * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
228d7f2e76SPhilippe Mathieu-Daudé * THE SOFTWARE.
238d7f2e76SPhilippe Mathieu-Daudé */
248d7f2e76SPhilippe Mathieu-Daudé /*
258d7f2e76SPhilippe Mathieu-Daudé * split out ioport related stuffs from vl.c.
268d7f2e76SPhilippe Mathieu-Daudé */
278d7f2e76SPhilippe Mathieu-Daudé
288d7f2e76SPhilippe Mathieu-Daudé #include "qemu/osdep.h"
298d7f2e76SPhilippe Mathieu-Daudé #include "cpu.h"
308d7f2e76SPhilippe Mathieu-Daudé #include "exec/ioport.h"
318d7f2e76SPhilippe Mathieu-Daudé #include "exec/memory.h"
328d7f2e76SPhilippe Mathieu-Daudé #include "exec/address-spaces.h"
338d7f2e76SPhilippe Mathieu-Daudé #include "trace.h"
348d7f2e76SPhilippe Mathieu-Daudé
358d7f2e76SPhilippe Mathieu-Daudé struct MemoryRegionPortioList {
368d7f2e76SPhilippe Mathieu-Daudé Object obj;
378d7f2e76SPhilippe Mathieu-Daudé
388d7f2e76SPhilippe Mathieu-Daudé MemoryRegion mr;
398d7f2e76SPhilippe Mathieu-Daudé void *portio_opaque;
408d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortio *ports;
418d7f2e76SPhilippe Mathieu-Daudé };
428d7f2e76SPhilippe Mathieu-Daudé
438d7f2e76SPhilippe Mathieu-Daudé #define TYPE_MEMORY_REGION_PORTIO_LIST "memory-region-portio-list"
OBJECT_DECLARE_SIMPLE_TYPE(MemoryRegionPortioList,MEMORY_REGION_PORTIO_LIST)448d7f2e76SPhilippe Mathieu-Daudé OBJECT_DECLARE_SIMPLE_TYPE(MemoryRegionPortioList, MEMORY_REGION_PORTIO_LIST)
458d7f2e76SPhilippe Mathieu-Daudé
468d7f2e76SPhilippe Mathieu-Daudé static uint64_t unassigned_io_read(void *opaque, hwaddr addr, unsigned size)
478d7f2e76SPhilippe Mathieu-Daudé {
488d7f2e76SPhilippe Mathieu-Daudé return -1ULL;
498d7f2e76SPhilippe Mathieu-Daudé }
508d7f2e76SPhilippe Mathieu-Daudé
unassigned_io_write(void * opaque,hwaddr addr,uint64_t val,unsigned size)518d7f2e76SPhilippe Mathieu-Daudé static void unassigned_io_write(void *opaque, hwaddr addr, uint64_t val,
528d7f2e76SPhilippe Mathieu-Daudé unsigned size)
538d7f2e76SPhilippe Mathieu-Daudé {
548d7f2e76SPhilippe Mathieu-Daudé }
558d7f2e76SPhilippe Mathieu-Daudé
568d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionOps unassigned_io_ops = {
578d7f2e76SPhilippe Mathieu-Daudé .read = unassigned_io_read,
588d7f2e76SPhilippe Mathieu-Daudé .write = unassigned_io_write,
598d7f2e76SPhilippe Mathieu-Daudé .endianness = DEVICE_NATIVE_ENDIAN,
608d7f2e76SPhilippe Mathieu-Daudé };
618d7f2e76SPhilippe Mathieu-Daudé
cpu_outb(uint32_t addr,uint8_t val)628d7f2e76SPhilippe Mathieu-Daudé void cpu_outb(uint32_t addr, uint8_t val)
638d7f2e76SPhilippe Mathieu-Daudé {
648d7f2e76SPhilippe Mathieu-Daudé trace_cpu_out(addr, 'b', val);
658d7f2e76SPhilippe Mathieu-Daudé address_space_write(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED,
668d7f2e76SPhilippe Mathieu-Daudé &val, 1);
678d7f2e76SPhilippe Mathieu-Daudé }
688d7f2e76SPhilippe Mathieu-Daudé
cpu_outw(uint32_t addr,uint16_t val)698d7f2e76SPhilippe Mathieu-Daudé void cpu_outw(uint32_t addr, uint16_t val)
708d7f2e76SPhilippe Mathieu-Daudé {
718d7f2e76SPhilippe Mathieu-Daudé uint8_t buf[2];
728d7f2e76SPhilippe Mathieu-Daudé
738d7f2e76SPhilippe Mathieu-Daudé trace_cpu_out(addr, 'w', val);
748d7f2e76SPhilippe Mathieu-Daudé stw_p(buf, val);
758d7f2e76SPhilippe Mathieu-Daudé address_space_write(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED,
768d7f2e76SPhilippe Mathieu-Daudé buf, 2);
778d7f2e76SPhilippe Mathieu-Daudé }
788d7f2e76SPhilippe Mathieu-Daudé
cpu_outl(uint32_t addr,uint32_t val)798d7f2e76SPhilippe Mathieu-Daudé void cpu_outl(uint32_t addr, uint32_t val)
808d7f2e76SPhilippe Mathieu-Daudé {
818d7f2e76SPhilippe Mathieu-Daudé uint8_t buf[4];
828d7f2e76SPhilippe Mathieu-Daudé
838d7f2e76SPhilippe Mathieu-Daudé trace_cpu_out(addr, 'l', val);
848d7f2e76SPhilippe Mathieu-Daudé stl_p(buf, val);
858d7f2e76SPhilippe Mathieu-Daudé address_space_write(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED,
868d7f2e76SPhilippe Mathieu-Daudé buf, 4);
878d7f2e76SPhilippe Mathieu-Daudé }
888d7f2e76SPhilippe Mathieu-Daudé
cpu_inb(uint32_t addr)898d7f2e76SPhilippe Mathieu-Daudé uint8_t cpu_inb(uint32_t addr)
908d7f2e76SPhilippe Mathieu-Daudé {
918d7f2e76SPhilippe Mathieu-Daudé uint8_t val;
928d7f2e76SPhilippe Mathieu-Daudé
938d7f2e76SPhilippe Mathieu-Daudé address_space_read(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED,
948d7f2e76SPhilippe Mathieu-Daudé &val, 1);
958d7f2e76SPhilippe Mathieu-Daudé trace_cpu_in(addr, 'b', val);
968d7f2e76SPhilippe Mathieu-Daudé return val;
978d7f2e76SPhilippe Mathieu-Daudé }
988d7f2e76SPhilippe Mathieu-Daudé
cpu_inw(uint32_t addr)998d7f2e76SPhilippe Mathieu-Daudé uint16_t cpu_inw(uint32_t addr)
1008d7f2e76SPhilippe Mathieu-Daudé {
1018d7f2e76SPhilippe Mathieu-Daudé uint8_t buf[2];
1028d7f2e76SPhilippe Mathieu-Daudé uint16_t val;
1038d7f2e76SPhilippe Mathieu-Daudé
1048d7f2e76SPhilippe Mathieu-Daudé address_space_read(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED, buf, 2);
1058d7f2e76SPhilippe Mathieu-Daudé val = lduw_p(buf);
1068d7f2e76SPhilippe Mathieu-Daudé trace_cpu_in(addr, 'w', val);
1078d7f2e76SPhilippe Mathieu-Daudé return val;
1088d7f2e76SPhilippe Mathieu-Daudé }
1098d7f2e76SPhilippe Mathieu-Daudé
cpu_inl(uint32_t addr)1108d7f2e76SPhilippe Mathieu-Daudé uint32_t cpu_inl(uint32_t addr)
1118d7f2e76SPhilippe Mathieu-Daudé {
1128d7f2e76SPhilippe Mathieu-Daudé uint8_t buf[4];
1138d7f2e76SPhilippe Mathieu-Daudé uint32_t val;
1148d7f2e76SPhilippe Mathieu-Daudé
1158d7f2e76SPhilippe Mathieu-Daudé address_space_read(&address_space_io, addr, MEMTXATTRS_UNSPECIFIED, buf, 4);
1168d7f2e76SPhilippe Mathieu-Daudé val = ldl_p(buf);
1178d7f2e76SPhilippe Mathieu-Daudé trace_cpu_in(addr, 'l', val);
1188d7f2e76SPhilippe Mathieu-Daudé return val;
1198d7f2e76SPhilippe Mathieu-Daudé }
1208d7f2e76SPhilippe Mathieu-Daudé
portio_list_init(PortioList * piolist,Object * owner,const MemoryRegionPortio * callbacks,void * opaque,const char * name)1218d7f2e76SPhilippe Mathieu-Daudé void portio_list_init(PortioList *piolist,
1228d7f2e76SPhilippe Mathieu-Daudé Object *owner,
1238d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *callbacks,
1248d7f2e76SPhilippe Mathieu-Daudé void *opaque, const char *name)
1258d7f2e76SPhilippe Mathieu-Daudé {
1268d7f2e76SPhilippe Mathieu-Daudé unsigned n = 0;
1278d7f2e76SPhilippe Mathieu-Daudé
1288d7f2e76SPhilippe Mathieu-Daudé while (callbacks[n].size) {
1298d7f2e76SPhilippe Mathieu-Daudé ++n;
1308d7f2e76SPhilippe Mathieu-Daudé }
1318d7f2e76SPhilippe Mathieu-Daudé
1328d7f2e76SPhilippe Mathieu-Daudé piolist->ports = callbacks;
1338d7f2e76SPhilippe Mathieu-Daudé piolist->nr = 0;
1348d7f2e76SPhilippe Mathieu-Daudé piolist->regions = g_new0(MemoryRegion *, n);
1358d7f2e76SPhilippe Mathieu-Daudé piolist->address_space = NULL;
136ad2b6523SBernhard Beschow piolist->addr = 0;
1378d7f2e76SPhilippe Mathieu-Daudé piolist->opaque = opaque;
1388d7f2e76SPhilippe Mathieu-Daudé piolist->owner = owner;
1398d7f2e76SPhilippe Mathieu-Daudé piolist->name = name;
1408d7f2e76SPhilippe Mathieu-Daudé piolist->flush_coalesced_mmio = false;
1418d7f2e76SPhilippe Mathieu-Daudé }
1428d7f2e76SPhilippe Mathieu-Daudé
portio_list_set_flush_coalesced(PortioList * piolist)1438d7f2e76SPhilippe Mathieu-Daudé void portio_list_set_flush_coalesced(PortioList *piolist)
1448d7f2e76SPhilippe Mathieu-Daudé {
1458d7f2e76SPhilippe Mathieu-Daudé piolist->flush_coalesced_mmio = true;
1468d7f2e76SPhilippe Mathieu-Daudé }
1478d7f2e76SPhilippe Mathieu-Daudé
portio_list_destroy(PortioList * piolist)1488d7f2e76SPhilippe Mathieu-Daudé void portio_list_destroy(PortioList *piolist)
1498d7f2e76SPhilippe Mathieu-Daudé {
1508d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio;
1518d7f2e76SPhilippe Mathieu-Daudé unsigned i;
1528d7f2e76SPhilippe Mathieu-Daudé
1538d7f2e76SPhilippe Mathieu-Daudé for (i = 0; i < piolist->nr; ++i) {
1548d7f2e76SPhilippe Mathieu-Daudé mrpio = container_of(piolist->regions[i], MemoryRegionPortioList, mr);
1558d7f2e76SPhilippe Mathieu-Daudé object_unparent(OBJECT(&mrpio->mr));
1568d7f2e76SPhilippe Mathieu-Daudé object_unref(mrpio);
1578d7f2e76SPhilippe Mathieu-Daudé }
1588d7f2e76SPhilippe Mathieu-Daudé g_free(piolist->regions);
1598d7f2e76SPhilippe Mathieu-Daudé }
1608d7f2e76SPhilippe Mathieu-Daudé
find_portio(MemoryRegionPortioList * mrpio,uint64_t offset,unsigned size,bool write)1618d7f2e76SPhilippe Mathieu-Daudé static const MemoryRegionPortio *find_portio(MemoryRegionPortioList *mrpio,
1628d7f2e76SPhilippe Mathieu-Daudé uint64_t offset, unsigned size,
1638d7f2e76SPhilippe Mathieu-Daudé bool write)
1648d7f2e76SPhilippe Mathieu-Daudé {
1658d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *mrp;
1668d7f2e76SPhilippe Mathieu-Daudé
1678d7f2e76SPhilippe Mathieu-Daudé for (mrp = mrpio->ports; mrp->size; ++mrp) {
1688d7f2e76SPhilippe Mathieu-Daudé if (offset >= mrp->offset && offset < mrp->offset + mrp->len &&
1698d7f2e76SPhilippe Mathieu-Daudé size == mrp->size &&
1708d7f2e76SPhilippe Mathieu-Daudé (write ? (bool)mrp->write : (bool)mrp->read)) {
1718d7f2e76SPhilippe Mathieu-Daudé return mrp;
1728d7f2e76SPhilippe Mathieu-Daudé }
1738d7f2e76SPhilippe Mathieu-Daudé }
1748d7f2e76SPhilippe Mathieu-Daudé return NULL;
1758d7f2e76SPhilippe Mathieu-Daudé }
1768d7f2e76SPhilippe Mathieu-Daudé
portio_read(void * opaque,hwaddr addr,unsigned size)1778d7f2e76SPhilippe Mathieu-Daudé static uint64_t portio_read(void *opaque, hwaddr addr, unsigned size)
1788d7f2e76SPhilippe Mathieu-Daudé {
1798d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio = opaque;
1808d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *mrp = find_portio(mrpio, addr, size, false);
1818d7f2e76SPhilippe Mathieu-Daudé uint64_t data;
1828d7f2e76SPhilippe Mathieu-Daudé
1838d7f2e76SPhilippe Mathieu-Daudé data = ((uint64_t)1 << (size * 8)) - 1;
1848d7f2e76SPhilippe Mathieu-Daudé if (mrp) {
1854edee342SBernhard Beschow data = mrp->read(mrpio->portio_opaque, mrpio->mr.addr + addr);
1868d7f2e76SPhilippe Mathieu-Daudé } else if (size == 2) {
1878d7f2e76SPhilippe Mathieu-Daudé mrp = find_portio(mrpio, addr, 1, false);
1888d7f2e76SPhilippe Mathieu-Daudé if (mrp) {
1894edee342SBernhard Beschow data = mrp->read(mrpio->portio_opaque, mrpio->mr.addr + addr);
1908d7f2e76SPhilippe Mathieu-Daudé if (addr + 1 < mrp->offset + mrp->len) {
1914edee342SBernhard Beschow data |= mrp->read(mrpio->portio_opaque, mrpio->mr.addr + addr + 1) << 8;
1928d7f2e76SPhilippe Mathieu-Daudé } else {
1938d7f2e76SPhilippe Mathieu-Daudé data |= 0xff00;
1948d7f2e76SPhilippe Mathieu-Daudé }
1958d7f2e76SPhilippe Mathieu-Daudé }
1968d7f2e76SPhilippe Mathieu-Daudé }
1978d7f2e76SPhilippe Mathieu-Daudé return data;
1988d7f2e76SPhilippe Mathieu-Daudé }
1998d7f2e76SPhilippe Mathieu-Daudé
portio_write(void * opaque,hwaddr addr,uint64_t data,unsigned size)2008d7f2e76SPhilippe Mathieu-Daudé static void portio_write(void *opaque, hwaddr addr, uint64_t data,
2018d7f2e76SPhilippe Mathieu-Daudé unsigned size)
2028d7f2e76SPhilippe Mathieu-Daudé {
2038d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio = opaque;
2048d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *mrp = find_portio(mrpio, addr, size, true);
2058d7f2e76SPhilippe Mathieu-Daudé
2068d7f2e76SPhilippe Mathieu-Daudé if (mrp) {
2074edee342SBernhard Beschow mrp->write(mrpio->portio_opaque, mrpio->mr.addr + addr, data);
2088d7f2e76SPhilippe Mathieu-Daudé } else if (size == 2) {
2098d7f2e76SPhilippe Mathieu-Daudé mrp = find_portio(mrpio, addr, 1, true);
2108d7f2e76SPhilippe Mathieu-Daudé if (mrp) {
2114edee342SBernhard Beschow mrp->write(mrpio->portio_opaque, mrpio->mr.addr + addr, data & 0xff);
2128d7f2e76SPhilippe Mathieu-Daudé if (addr + 1 < mrp->offset + mrp->len) {
2134edee342SBernhard Beschow mrp->write(mrpio->portio_opaque, mrpio->mr.addr + addr + 1, data >> 8);
2148d7f2e76SPhilippe Mathieu-Daudé }
2158d7f2e76SPhilippe Mathieu-Daudé }
2168d7f2e76SPhilippe Mathieu-Daudé }
2178d7f2e76SPhilippe Mathieu-Daudé }
2188d7f2e76SPhilippe Mathieu-Daudé
2198d7f2e76SPhilippe Mathieu-Daudé static const MemoryRegionOps portio_ops = {
2208d7f2e76SPhilippe Mathieu-Daudé .read = portio_read,
2218d7f2e76SPhilippe Mathieu-Daudé .write = portio_write,
2228d7f2e76SPhilippe Mathieu-Daudé .endianness = DEVICE_LITTLE_ENDIAN,
2238d7f2e76SPhilippe Mathieu-Daudé .valid.unaligned = true,
2248d7f2e76SPhilippe Mathieu-Daudé .impl.unaligned = true,
2258d7f2e76SPhilippe Mathieu-Daudé };
2268d7f2e76SPhilippe Mathieu-Daudé
portio_list_add_1(PortioList * piolist,const MemoryRegionPortio * pio_init,unsigned count,unsigned start,unsigned off_low,unsigned off_high)2278d7f2e76SPhilippe Mathieu-Daudé static void portio_list_add_1(PortioList *piolist,
2288d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *pio_init,
2298d7f2e76SPhilippe Mathieu-Daudé unsigned count, unsigned start,
2308d7f2e76SPhilippe Mathieu-Daudé unsigned off_low, unsigned off_high)
2318d7f2e76SPhilippe Mathieu-Daudé {
2328d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio;
2338d7f2e76SPhilippe Mathieu-Daudé Object *owner;
2348d7f2e76SPhilippe Mathieu-Daudé char *name;
2358d7f2e76SPhilippe Mathieu-Daudé unsigned i;
2368d7f2e76SPhilippe Mathieu-Daudé
2378d7f2e76SPhilippe Mathieu-Daudé /* Copy the sub-list and null-terminate it. */
2388d7f2e76SPhilippe Mathieu-Daudé mrpio = MEMORY_REGION_PORTIO_LIST(
2398d7f2e76SPhilippe Mathieu-Daudé object_new(TYPE_MEMORY_REGION_PORTIO_LIST));
2408d7f2e76SPhilippe Mathieu-Daudé mrpio->portio_opaque = piolist->opaque;
2418d7f2e76SPhilippe Mathieu-Daudé mrpio->ports = g_malloc0(sizeof(MemoryRegionPortio) * (count + 1));
2428d7f2e76SPhilippe Mathieu-Daudé memcpy(mrpio->ports, pio_init, sizeof(MemoryRegionPortio) * count);
2438d7f2e76SPhilippe Mathieu-Daudé memset(mrpio->ports + count, 0, sizeof(MemoryRegionPortio));
2448d7f2e76SPhilippe Mathieu-Daudé
2458d7f2e76SPhilippe Mathieu-Daudé /* Adjust the offsets to all be zero-based for the region. */
2468d7f2e76SPhilippe Mathieu-Daudé for (i = 0; i < count; ++i) {
2478d7f2e76SPhilippe Mathieu-Daudé mrpio->ports[i].offset -= off_low;
2488d7f2e76SPhilippe Mathieu-Daudé }
2498d7f2e76SPhilippe Mathieu-Daudé
2508d7f2e76SPhilippe Mathieu-Daudé /*
2518d7f2e76SPhilippe Mathieu-Daudé * The MemoryRegion owner is the MemoryRegionPortioList since that manages
2528d7f2e76SPhilippe Mathieu-Daudé * the lifecycle via the refcount
2538d7f2e76SPhilippe Mathieu-Daudé */
2548d7f2e76SPhilippe Mathieu-Daudé memory_region_init_io(&mrpio->mr, OBJECT(mrpio), &portio_ops, mrpio,
2558d7f2e76SPhilippe Mathieu-Daudé piolist->name, off_high - off_low);
2568d7f2e76SPhilippe Mathieu-Daudé
2578d7f2e76SPhilippe Mathieu-Daudé /* Reparent the MemoryRegion to the piolist owner */
2588d7f2e76SPhilippe Mathieu-Daudé object_ref(&mrpio->mr);
2598d7f2e76SPhilippe Mathieu-Daudé object_unparent(OBJECT(&mrpio->mr));
2608d7f2e76SPhilippe Mathieu-Daudé if (!piolist->owner) {
2618d7f2e76SPhilippe Mathieu-Daudé owner = container_get(qdev_get_machine(), "/unattached");
2628d7f2e76SPhilippe Mathieu-Daudé } else {
2638d7f2e76SPhilippe Mathieu-Daudé owner = piolist->owner;
2648d7f2e76SPhilippe Mathieu-Daudé }
2658d7f2e76SPhilippe Mathieu-Daudé name = g_strdup_printf("%s[*]", piolist->name);
2668d7f2e76SPhilippe Mathieu-Daudé object_property_add_child(owner, name, OBJECT(&mrpio->mr));
2678d7f2e76SPhilippe Mathieu-Daudé g_free(name);
2688d7f2e76SPhilippe Mathieu-Daudé
2698d7f2e76SPhilippe Mathieu-Daudé if (piolist->flush_coalesced_mmio) {
2708d7f2e76SPhilippe Mathieu-Daudé memory_region_set_flush_coalesced(&mrpio->mr);
2718d7f2e76SPhilippe Mathieu-Daudé }
2728d7f2e76SPhilippe Mathieu-Daudé memory_region_add_subregion(piolist->address_space,
2738d7f2e76SPhilippe Mathieu-Daudé start + off_low, &mrpio->mr);
2748d7f2e76SPhilippe Mathieu-Daudé piolist->regions[piolist->nr] = &mrpio->mr;
2758d7f2e76SPhilippe Mathieu-Daudé ++piolist->nr;
2768d7f2e76SPhilippe Mathieu-Daudé }
2778d7f2e76SPhilippe Mathieu-Daudé
portio_list_add(PortioList * piolist,MemoryRegion * address_space,uint32_t start)2788d7f2e76SPhilippe Mathieu-Daudé void portio_list_add(PortioList *piolist,
2798d7f2e76SPhilippe Mathieu-Daudé MemoryRegion *address_space,
2808d7f2e76SPhilippe Mathieu-Daudé uint32_t start)
2818d7f2e76SPhilippe Mathieu-Daudé {
2828d7f2e76SPhilippe Mathieu-Daudé const MemoryRegionPortio *pio, *pio_start = piolist->ports;
2838d7f2e76SPhilippe Mathieu-Daudé unsigned int off_low, off_high, off_last, count;
2848d7f2e76SPhilippe Mathieu-Daudé
2858d7f2e76SPhilippe Mathieu-Daudé piolist->address_space = address_space;
286ad2b6523SBernhard Beschow piolist->addr = start;
2878d7f2e76SPhilippe Mathieu-Daudé
2888d7f2e76SPhilippe Mathieu-Daudé /* Handle the first entry specially. */
2898d7f2e76SPhilippe Mathieu-Daudé off_last = off_low = pio_start->offset;
2908d7f2e76SPhilippe Mathieu-Daudé off_high = off_low + pio_start->len + pio_start->size - 1;
2918d7f2e76SPhilippe Mathieu-Daudé count = 1;
2928d7f2e76SPhilippe Mathieu-Daudé
2938d7f2e76SPhilippe Mathieu-Daudé for (pio = pio_start + 1; pio->size != 0; pio++, count++) {
2948d7f2e76SPhilippe Mathieu-Daudé /* All entries must be sorted by offset. */
2958d7f2e76SPhilippe Mathieu-Daudé assert(pio->offset >= off_last);
2968d7f2e76SPhilippe Mathieu-Daudé off_last = pio->offset;
2978d7f2e76SPhilippe Mathieu-Daudé
2988d7f2e76SPhilippe Mathieu-Daudé /* If we see a hole, break the region. */
2998d7f2e76SPhilippe Mathieu-Daudé if (off_last > off_high) {
3008d7f2e76SPhilippe Mathieu-Daudé portio_list_add_1(piolist, pio_start, count, start, off_low,
3018d7f2e76SPhilippe Mathieu-Daudé off_high);
3028d7f2e76SPhilippe Mathieu-Daudé /* ... and start collecting anew. */
3038d7f2e76SPhilippe Mathieu-Daudé pio_start = pio;
3048d7f2e76SPhilippe Mathieu-Daudé off_low = off_last;
3058d7f2e76SPhilippe Mathieu-Daudé off_high = off_low + pio->len + pio_start->size - 1;
3068d7f2e76SPhilippe Mathieu-Daudé count = 0;
3078d7f2e76SPhilippe Mathieu-Daudé } else if (off_last + pio->len > off_high) {
3088d7f2e76SPhilippe Mathieu-Daudé off_high = off_last + pio->len + pio_start->size - 1;
3098d7f2e76SPhilippe Mathieu-Daudé }
3108d7f2e76SPhilippe Mathieu-Daudé }
3118d7f2e76SPhilippe Mathieu-Daudé
3128d7f2e76SPhilippe Mathieu-Daudé /* There will always be an open sub-list. */
3138d7f2e76SPhilippe Mathieu-Daudé portio_list_add_1(piolist, pio_start, count, start, off_low, off_high);
3148d7f2e76SPhilippe Mathieu-Daudé }
3158d7f2e76SPhilippe Mathieu-Daudé
portio_list_del(PortioList * piolist)3168d7f2e76SPhilippe Mathieu-Daudé void portio_list_del(PortioList *piolist)
3178d7f2e76SPhilippe Mathieu-Daudé {
3188d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio;
3198d7f2e76SPhilippe Mathieu-Daudé unsigned i;
3208d7f2e76SPhilippe Mathieu-Daudé
3218d7f2e76SPhilippe Mathieu-Daudé for (i = 0; i < piolist->nr; ++i) {
3228d7f2e76SPhilippe Mathieu-Daudé mrpio = container_of(piolist->regions[i], MemoryRegionPortioList, mr);
3238d7f2e76SPhilippe Mathieu-Daudé memory_region_del_subregion(piolist->address_space, &mrpio->mr);
3248d7f2e76SPhilippe Mathieu-Daudé }
3258d7f2e76SPhilippe Mathieu-Daudé }
3268d7f2e76SPhilippe Mathieu-Daudé
portio_list_set_enabled(PortioList * piolist,bool enabled)327*f165cdf1SBernhard Beschow void portio_list_set_enabled(PortioList *piolist, bool enabled)
328*f165cdf1SBernhard Beschow {
329*f165cdf1SBernhard Beschow unsigned i;
330*f165cdf1SBernhard Beschow
331*f165cdf1SBernhard Beschow for (i = 0; i < piolist->nr; ++i) {
332*f165cdf1SBernhard Beschow memory_region_set_enabled(piolist->regions[i], enabled);
333*f165cdf1SBernhard Beschow }
334*f165cdf1SBernhard Beschow }
335*f165cdf1SBernhard Beschow
portio_list_set_address(PortioList * piolist,uint32_t addr)336ad2b6523SBernhard Beschow void portio_list_set_address(PortioList *piolist, uint32_t addr)
337ad2b6523SBernhard Beschow {
338ad2b6523SBernhard Beschow MemoryRegionPortioList *mrpio;
339ad2b6523SBernhard Beschow unsigned i, j;
340ad2b6523SBernhard Beschow
341ad2b6523SBernhard Beschow for (i = 0; i < piolist->nr; ++i) {
342ad2b6523SBernhard Beschow mrpio = container_of(piolist->regions[i], MemoryRegionPortioList, mr);
343ad2b6523SBernhard Beschow memory_region_set_address(&mrpio->mr,
344ad2b6523SBernhard Beschow mrpio->mr.addr - piolist->addr + addr);
345ad2b6523SBernhard Beschow for (j = 0; mrpio->ports[j].size; ++j) {
346ad2b6523SBernhard Beschow mrpio->ports[j].offset += addr - piolist->addr;
347ad2b6523SBernhard Beschow }
348ad2b6523SBernhard Beschow }
349ad2b6523SBernhard Beschow
350ad2b6523SBernhard Beschow piolist->addr = addr;
351ad2b6523SBernhard Beschow }
352ad2b6523SBernhard Beschow
memory_region_portio_list_finalize(Object * obj)3538d7f2e76SPhilippe Mathieu-Daudé static void memory_region_portio_list_finalize(Object *obj)
3548d7f2e76SPhilippe Mathieu-Daudé {
3558d7f2e76SPhilippe Mathieu-Daudé MemoryRegionPortioList *mrpio = MEMORY_REGION_PORTIO_LIST(obj);
3568d7f2e76SPhilippe Mathieu-Daudé
3578d7f2e76SPhilippe Mathieu-Daudé object_unref(&mrpio->mr);
3588d7f2e76SPhilippe Mathieu-Daudé g_free(mrpio->ports);
3598d7f2e76SPhilippe Mathieu-Daudé }
3608d7f2e76SPhilippe Mathieu-Daudé
3618d7f2e76SPhilippe Mathieu-Daudé static const TypeInfo memory_region_portio_list_info = {
3628d7f2e76SPhilippe Mathieu-Daudé .parent = TYPE_OBJECT,
3638d7f2e76SPhilippe Mathieu-Daudé .name = TYPE_MEMORY_REGION_PORTIO_LIST,
3648d7f2e76SPhilippe Mathieu-Daudé .instance_size = sizeof(MemoryRegionPortioList),
3658d7f2e76SPhilippe Mathieu-Daudé .instance_finalize = memory_region_portio_list_finalize,
3668d7f2e76SPhilippe Mathieu-Daudé };
3678d7f2e76SPhilippe Mathieu-Daudé
ioport_register_types(void)3688d7f2e76SPhilippe Mathieu-Daudé static void ioport_register_types(void)
3698d7f2e76SPhilippe Mathieu-Daudé {
3708d7f2e76SPhilippe Mathieu-Daudé type_register_static(&memory_region_portio_list_info);
3718d7f2e76SPhilippe Mathieu-Daudé }
3728d7f2e76SPhilippe Mathieu-Daudé
3738d7f2e76SPhilippe Mathieu-Daudé type_init(ioport_register_types)
374