memory.c 51.9 KB
Newer Older
A
Avi Kivity 已提交
1 2 3 4 5 6 7 8 9 10 11
/*
 * Physical memory management
 *
 * Copyright 2011 Red Hat, Inc. and/or its affiliates
 *
 * Authors:
 *  Avi Kivity <avi@redhat.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 *
12 13
 * Contributions after 2012-01-13 are licensed under the terms of the
 * GNU GPL, version 2 or (at your option) any later version.
A
Avi Kivity 已提交
14 15 16
 */

#include "memory.h"
A
Avi Kivity 已提交
17
#include "exec-memory.h"
A
Avi Kivity 已提交
18
#include "ioport.h"
19
#include "bitops.h"
A
Avi Kivity 已提交
20
#include "kvm.h"
A
Avi Kivity 已提交
21 22
#include <assert.h>

A
Avi Kivity 已提交
23
#include "memory-internal.h"
24

A
Avi Kivity 已提交
25
unsigned memory_region_transaction_depth = 0;
26 27
static bool global_dirty_log = false;

28 29
static QTAILQ_HEAD(memory_listeners, MemoryListener) memory_listeners
    = QTAILQ_HEAD_INITIALIZER(memory_listeners);
A
Avi Kivity 已提交
30

31 32 33
static QTAILQ_HEAD(, AddressSpace) address_spaces
    = QTAILQ_HEAD_INITIALIZER(address_spaces);

A
Avi Kivity 已提交
34 35
typedef struct AddrRange AddrRange;

A
Avi Kivity 已提交
36 37 38 39 40
/*
 * Note using signed integers limits us to physical addresses at most
 * 63 bits wide.  They are needed for negative offsetting in aliases
 * (large MemoryRegion::alias_offset).
 */
A
Avi Kivity 已提交
41
struct AddrRange {
42 43
    Int128 start;
    Int128 size;
A
Avi Kivity 已提交
44 45
};

46
static AddrRange addrrange_make(Int128 start, Int128 size)
A
Avi Kivity 已提交
47 48 49 50 51 52
{
    return (AddrRange) { start, size };
}

static bool addrrange_equal(AddrRange r1, AddrRange r2)
{
53
    return int128_eq(r1.start, r2.start) && int128_eq(r1.size, r2.size);
A
Avi Kivity 已提交
54 55
}

56
static Int128 addrrange_end(AddrRange r)
A
Avi Kivity 已提交
57
{
58
    return int128_add(r.start, r.size);
A
Avi Kivity 已提交
59 60
}

61
static AddrRange addrrange_shift(AddrRange range, Int128 delta)
A
Avi Kivity 已提交
62
{
63
    int128_addto(&range.start, delta);
A
Avi Kivity 已提交
64 65 66
    return range;
}

67 68 69 70 71 72
static bool addrrange_contains(AddrRange range, Int128 addr)
{
    return int128_ge(addr, range.start)
        && int128_lt(addr, addrrange_end(range));
}

A
Avi Kivity 已提交
73 74
static bool addrrange_intersects(AddrRange r1, AddrRange r2)
{
75 76
    return addrrange_contains(r1, r2.start)
        || addrrange_contains(r2, r1.start);
A
Avi Kivity 已提交
77 78 79 80
}

static AddrRange addrrange_intersection(AddrRange r1, AddrRange r2)
{
81 82 83
    Int128 start = int128_max(r1.start, r2.start);
    Int128 end = int128_min(addrrange_end(r1), addrrange_end(r2));
    return addrrange_make(start, int128_sub(end, start));
A
Avi Kivity 已提交
84 85
}

86 87
enum ListenerDirection { Forward, Reverse };

88 89 90 91 92 93 94 95
static bool memory_listener_match(MemoryListener *listener,
                                  MemoryRegionSection *section)
{
    return !listener->address_space_filter
        || listener->address_space_filter == section->address_space;
}

#define MEMORY_LISTENER_CALL_GLOBAL(_callback, _direction, _args...)    \
96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115
    do {                                                                \
        MemoryListener *_listener;                                      \
                                                                        \
        switch (_direction) {                                           \
        case Forward:                                                   \
            QTAILQ_FOREACH(_listener, &memory_listeners, link) {        \
                _listener->_callback(_listener, ##_args);               \
            }                                                           \
            break;                                                      \
        case Reverse:                                                   \
            QTAILQ_FOREACH_REVERSE(_listener, &memory_listeners,        \
                                   memory_listeners, link) {            \
                _listener->_callback(_listener, ##_args);               \
            }                                                           \
            break;                                                      \
        default:                                                        \
            abort();                                                    \
        }                                                               \
    } while (0)

116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
#define MEMORY_LISTENER_CALL(_callback, _direction, _section, _args...) \
    do {                                                                \
        MemoryListener *_listener;                                      \
                                                                        \
        switch (_direction) {                                           \
        case Forward:                                                   \
            QTAILQ_FOREACH(_listener, &memory_listeners, link) {        \
                if (memory_listener_match(_listener, _section)) {       \
                    _listener->_callback(_listener, _section, ##_args); \
                }                                                       \
            }                                                           \
            break;                                                      \
        case Reverse:                                                   \
            QTAILQ_FOREACH_REVERSE(_listener, &memory_listeners,        \
                                   memory_listeners, link) {            \
                if (memory_listener_match(_listener, _section)) {       \
                    _listener->_callback(_listener, _section, ##_args); \
                }                                                       \
            }                                                           \
            break;                                                      \
        default:                                                        \
            abort();                                                    \
        }                                                               \
    } while (0)

141
#define MEMORY_LISTENER_UPDATE_REGION(fr, as, dir, callback)            \
142
    MEMORY_LISTENER_CALL(callback, dir, (&(MemoryRegionSection) {       \
143 144 145 146 147
        .mr = (fr)->mr,                                                 \
        .address_space = (as)->root,                                    \
        .offset_within_region = (fr)->offset_in_region,                 \
        .size = int128_get64((fr)->addr.size),                          \
        .offset_within_address_space = int128_get64((fr)->addr.start),  \
148
        .readonly = (fr)->readonly,                                     \
149
              }))
150

A
Avi Kivity 已提交
151 152 153 154 155
struct CoalescedMemoryRange {
    AddrRange addr;
    QTAILQ_ENTRY(CoalescedMemoryRange) link;
};

A
Avi Kivity 已提交
156 157 158 159
struct MemoryRegionIoeventfd {
    AddrRange addr;
    bool match_data;
    uint64_t data;
160
    EventNotifier *e;
A
Avi Kivity 已提交
161 162 163 164 165
};

static bool memory_region_ioeventfd_before(MemoryRegionIoeventfd a,
                                           MemoryRegionIoeventfd b)
{
166
    if (int128_lt(a.addr.start, b.addr.start)) {
A
Avi Kivity 已提交
167
        return true;
168
    } else if (int128_gt(a.addr.start, b.addr.start)) {
A
Avi Kivity 已提交
169
        return false;
170
    } else if (int128_lt(a.addr.size, b.addr.size)) {
A
Avi Kivity 已提交
171
        return true;
172
    } else if (int128_gt(a.addr.size, b.addr.size)) {
A
Avi Kivity 已提交
173 174 175 176 177 178 179 180 181 182 183 184
        return false;
    } else if (a.match_data < b.match_data) {
        return true;
    } else  if (a.match_data > b.match_data) {
        return false;
    } else if (a.match_data) {
        if (a.data < b.data) {
            return true;
        } else if (a.data > b.data) {
            return false;
        }
    }
185
    if (a.e < b.e) {
A
Avi Kivity 已提交
186
        return true;
187
    } else if (a.e > b.e) {
A
Avi Kivity 已提交
188 189 190 191 192 193 194 195 196 197 198 199
        return false;
    }
    return false;
}

static bool memory_region_ioeventfd_equal(MemoryRegionIoeventfd a,
                                          MemoryRegionIoeventfd b)
{
    return !memory_region_ioeventfd_before(a, b)
        && !memory_region_ioeventfd_before(b, a);
}

A
Avi Kivity 已提交
200 201 202 203 204 205 206 207
typedef struct FlatRange FlatRange;
typedef struct FlatView FlatView;

/* Range of memory in the global map.  Addresses are absolute. */
struct FlatRange {
    MemoryRegion *mr;
    target_phys_addr_t offset_in_region;
    AddrRange addr;
A
Avi Kivity 已提交
208
    uint8_t dirty_log_mask;
209
    bool readable;
210
    bool readonly;
A
Avi Kivity 已提交
211 212 213 214 215 216 217 218 219 220 221
};

/* Flattened global view of current active memory hierarchy.  Kept in sorted
 * order.
 */
struct FlatView {
    FlatRange *ranges;
    unsigned nr;
    unsigned nr_allocated;
};

222 223
typedef struct AddressSpaceOps AddressSpaceOps;

A
Avi Kivity 已提交
224 225 226 227 228 229 230
#define FOR_EACH_FLAT_RANGE(var, view)          \
    for (var = (view)->ranges; var < (view)->ranges + (view)->nr; ++var)

static bool flatrange_equal(FlatRange *a, FlatRange *b)
{
    return a->mr == b->mr
        && addrrange_equal(a->addr, b->addr)
231
        && a->offset_in_region == b->offset_in_region
232 233
        && a->readable == b->readable
        && a->readonly == b->readonly;
A
Avi Kivity 已提交
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
}

static void flatview_init(FlatView *view)
{
    view->ranges = NULL;
    view->nr = 0;
    view->nr_allocated = 0;
}

/* Insert a range into a given position.  Caller is responsible for maintaining
 * sorting order.
 */
static void flatview_insert(FlatView *view, unsigned pos, FlatRange *range)
{
    if (view->nr == view->nr_allocated) {
        view->nr_allocated = MAX(2 * view->nr, 10);
250
        view->ranges = g_realloc(view->ranges,
A
Avi Kivity 已提交
251 252 253 254 255 256 257 258 259 260
                                    view->nr_allocated * sizeof(*view->ranges));
    }
    memmove(view->ranges + pos + 1, view->ranges + pos,
            (view->nr - pos) * sizeof(FlatRange));
    view->ranges[pos] = *range;
    ++view->nr;
}

static void flatview_destroy(FlatView *view)
{
261
    g_free(view->ranges);
A
Avi Kivity 已提交
262 263
}

264 265
static bool can_merge(FlatRange *r1, FlatRange *r2)
{
266
    return int128_eq(addrrange_end(r1->addr), r2->addr.start)
267
        && r1->mr == r2->mr
268 269 270
        && int128_eq(int128_add(int128_make64(r1->offset_in_region),
                                r1->addr.size),
                     int128_make64(r2->offset_in_region))
271
        && r1->dirty_log_mask == r2->dirty_log_mask
272 273
        && r1->readable == r2->readable
        && r1->readonly == r2->readonly;
274 275 276 277 278 279 280 281 282 283 284 285
}

/* Attempt to simplify a view by merging ajacent ranges */
static void flatview_simplify(FlatView *view)
{
    unsigned i, j;

    i = 0;
    while (i < view->nr) {
        j = i + 1;
        while (j < view->nr
               && can_merge(&view->ranges[j-1], &view->ranges[j])) {
286
            int128_addto(&view->ranges[i].addr.size, view->ranges[j].addr.size);
287 288 289 290 291 292 293 294 295
            ++j;
        }
        ++i;
        memmove(&view->ranges[i], &view->ranges[j],
                (view->nr - j) * sizeof(view->ranges[j]));
        view->nr -= j - i;
    }
}

296 297 298 299 300 301 302 303 304 305
static void memory_region_read_accessor(void *opaque,
                                        target_phys_addr_t addr,
                                        uint64_t *value,
                                        unsigned size,
                                        unsigned shift,
                                        uint64_t mask)
{
    MemoryRegion *mr = opaque;
    uint64_t tmp;

306 307 308
    if (mr->flush_coalesced_mmio) {
        qemu_flush_coalesced_mmio_buffer();
    }
309 310 311 312 313 314 315 316 317 318 319 320 321 322
    tmp = mr->ops->read(mr->opaque, addr, size);
    *value |= (tmp & mask) << shift;
}

static void memory_region_write_accessor(void *opaque,
                                         target_phys_addr_t addr,
                                         uint64_t *value,
                                         unsigned size,
                                         unsigned shift,
                                         uint64_t mask)
{
    MemoryRegion *mr = opaque;
    uint64_t tmp;

323 324 325
    if (mr->flush_coalesced_mmio) {
        qemu_flush_coalesced_mmio_buffer();
    }
326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360
    tmp = (*value >> shift) & mask;
    mr->ops->write(mr->opaque, addr, tmp, size);
}

static void access_with_adjusted_size(target_phys_addr_t addr,
                                      uint64_t *value,
                                      unsigned size,
                                      unsigned access_size_min,
                                      unsigned access_size_max,
                                      void (*access)(void *opaque,
                                                     target_phys_addr_t addr,
                                                     uint64_t *value,
                                                     unsigned size,
                                                     unsigned shift,
                                                     uint64_t mask),
                                      void *opaque)
{
    uint64_t access_mask;
    unsigned access_size;
    unsigned i;

    if (!access_size_min) {
        access_size_min = 1;
    }
    if (!access_size_max) {
        access_size_max = 4;
    }
    access_size = MAX(MIN(size, access_size_max), access_size_min);
    access_mask = -1ULL >> (64 - access_size * 8);
    for (i = 0; i < size; i += access_size) {
        /* FIXME: big-endian support */
        access(opaque, addr + i, value, access_size, i * 8, access_mask);
    }
}

A
Avi Kivity 已提交
361
static AddressSpace address_space_memory;
362

363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
static const MemoryRegionPortio *find_portio(MemoryRegion *mr, uint64_t offset,
                                             unsigned width, bool write)
{
    const MemoryRegionPortio *mrp;

    for (mrp = mr->ops->old_portio; mrp->size; ++mrp) {
        if (offset >= mrp->offset && offset < mrp->offset + mrp->len
            && width == mrp->size
            && (write ? (bool)mrp->write : (bool)mrp->read)) {
            return mrp;
        }
    }
    return NULL;
}

A
Avi Kivity 已提交
378 379 380 381 382
static void memory_region_iorange_read(IORange *iorange,
                                       uint64_t offset,
                                       unsigned width,
                                       uint64_t *data)
{
A
Avi Kivity 已提交
383 384 385
    MemoryRegionIORange *mrio
        = container_of(iorange, MemoryRegionIORange, iorange);
    MemoryRegion *mr = mrio->mr;
A
Avi Kivity 已提交
386

A
Avi Kivity 已提交
387
    offset += mrio->offset;
388
    if (mr->ops->old_portio) {
A
Avi Kivity 已提交
389 390
        const MemoryRegionPortio *mrp = find_portio(mr, offset - mrio->offset,
                                                    width, false);
391 392 393

        *data = ((uint64_t)1 << (width * 8)) - 1;
        if (mrp) {
394
            *data = mrp->read(mr->opaque, offset);
J
Jan Kiszka 已提交
395
        } else if (width == 2) {
A
Avi Kivity 已提交
396
            mrp = find_portio(mr, offset - mrio->offset, 1, false);
J
Jan Kiszka 已提交
397
            assert(mrp);
398 399
            *data = mrp->read(mr->opaque, offset) |
                    (mrp->read(mr->opaque, offset + 1) << 8);
400 401 402
        }
        return;
    }
403
    *data = 0;
404
    access_with_adjusted_size(offset, data, width,
405 406 407
                              mr->ops->impl.min_access_size,
                              mr->ops->impl.max_access_size,
                              memory_region_read_accessor, mr);
A
Avi Kivity 已提交
408 409 410 411 412 413 414
}

static void memory_region_iorange_write(IORange *iorange,
                                        uint64_t offset,
                                        unsigned width,
                                        uint64_t data)
{
A
Avi Kivity 已提交
415 416 417
    MemoryRegionIORange *mrio
        = container_of(iorange, MemoryRegionIORange, iorange);
    MemoryRegion *mr = mrio->mr;
A
Avi Kivity 已提交
418

A
Avi Kivity 已提交
419
    offset += mrio->offset;
420
    if (mr->ops->old_portio) {
A
Avi Kivity 已提交
421 422
        const MemoryRegionPortio *mrp = find_portio(mr, offset - mrio->offset,
                                                    width, true);
423 424

        if (mrp) {
425
            mrp->write(mr->opaque, offset, data);
J
Jan Kiszka 已提交
426
        } else if (width == 2) {
427
            mrp = find_portio(mr, offset - mrio->offset, 1, true);
J
Jan Kiszka 已提交
428
            assert(mrp);
429 430
            mrp->write(mr->opaque, offset, data & 0xff);
            mrp->write(mr->opaque, offset + 1, data >> 8);
431 432 433
        }
        return;
    }
434
    access_with_adjusted_size(offset, &data, width,
435 436 437
                              mr->ops->impl.min_access_size,
                              mr->ops->impl.max_access_size,
                              memory_region_write_accessor, mr);
A
Avi Kivity 已提交
438 439
}

A
Avi Kivity 已提交
440 441 442 443 444
static void memory_region_iorange_destructor(IORange *iorange)
{
    g_free(container_of(iorange, MemoryRegionIORange, iorange));
}

445
const IORangeOps memory_region_iorange_ops = {
A
Avi Kivity 已提交
446 447
    .read = memory_region_iorange_read,
    .write = memory_region_iorange_write,
A
Avi Kivity 已提交
448
    .destructor = memory_region_iorange_destructor,
A
Avi Kivity 已提交
449 450
};

A
Avi Kivity 已提交
451
static AddressSpace address_space_io;
A
Avi Kivity 已提交
452

453 454
static AddressSpace *memory_region_to_address_space(MemoryRegion *mr)
{
455 456
    AddressSpace *as;

457 458 459
    while (mr->parent) {
        mr = mr->parent;
    }
460 461 462 463
    QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
        if (mr == as->root) {
            return as;
        }
464 465 466 467
    }
    abort();
}

A
Avi Kivity 已提交
468 469 470 471 472
/* Render a memory region into the global view.  Ranges in @view obscure
 * ranges in @mr.
 */
static void render_memory_region(FlatView *view,
                                 MemoryRegion *mr,
473
                                 Int128 base,
474 475
                                 AddrRange clip,
                                 bool readonly)
A
Avi Kivity 已提交
476 477 478 479
{
    MemoryRegion *subregion;
    unsigned i;
    target_phys_addr_t offset_in_region;
480 481
    Int128 remain;
    Int128 now;
A
Avi Kivity 已提交
482 483 484
    FlatRange fr;
    AddrRange tmp;

485 486 487 488
    if (!mr->enabled) {
        return;
    }

489
    int128_addto(&base, int128_make64(mr->addr));
490
    readonly |= mr->readonly;
A
Avi Kivity 已提交
491 492 493 494 495 496 497 498 499 500

    tmp = addrrange_make(base, mr->size);

    if (!addrrange_intersects(tmp, clip)) {
        return;
    }

    clip = addrrange_intersection(tmp, clip);

    if (mr->alias) {
501 502
        int128_subfrom(&base, int128_make64(mr->alias->addr));
        int128_subfrom(&base, int128_make64(mr->alias_offset));
503
        render_memory_region(view, mr->alias, base, clip, readonly);
A
Avi Kivity 已提交
504 505 506 507 508
        return;
    }

    /* Render subregions in priority order. */
    QTAILQ_FOREACH(subregion, &mr->subregions, subregions_link) {
509
        render_memory_region(view, subregion, base, clip, readonly);
A
Avi Kivity 已提交
510 511
    }

512
    if (!mr->terminates) {
A
Avi Kivity 已提交
513 514 515
        return;
    }

516
    offset_in_region = int128_get64(int128_sub(clip.start, base));
A
Avi Kivity 已提交
517 518 519 520
    base = clip.start;
    remain = clip.size;

    /* Render the region itself into any gaps left by the current view. */
521 522
    for (i = 0; i < view->nr && int128_nz(remain); ++i) {
        if (int128_ge(base, addrrange_end(view->ranges[i].addr))) {
A
Avi Kivity 已提交
523 524
            continue;
        }
525 526 527
        if (int128_lt(base, view->ranges[i].addr.start)) {
            now = int128_min(remain,
                             int128_sub(view->ranges[i].addr.start, base));
A
Avi Kivity 已提交
528 529 530
            fr.mr = mr;
            fr.offset_in_region = offset_in_region;
            fr.addr = addrrange_make(base, now);
A
Avi Kivity 已提交
531
            fr.dirty_log_mask = mr->dirty_log_mask;
532
            fr.readable = mr->readable;
533
            fr.readonly = readonly;
A
Avi Kivity 已提交
534 535
            flatview_insert(view, i, &fr);
            ++i;
536 537 538
            int128_addto(&base, now);
            offset_in_region += int128_get64(now);
            int128_subfrom(&remain, now);
A
Avi Kivity 已提交
539
        }
540 541 542 543 544
        if (int128_eq(base, view->ranges[i].addr.start)) {
            now = int128_min(remain, view->ranges[i].addr.size);
            int128_addto(&base, now);
            offset_in_region += int128_get64(now);
            int128_subfrom(&remain, now);
A
Avi Kivity 已提交
545 546
        }
    }
547
    if (int128_nz(remain)) {
A
Avi Kivity 已提交
548 549 550
        fr.mr = mr;
        fr.offset_in_region = offset_in_region;
        fr.addr = addrrange_make(base, remain);
A
Avi Kivity 已提交
551
        fr.dirty_log_mask = mr->dirty_log_mask;
552
        fr.readable = mr->readable;
553
        fr.readonly = readonly;
A
Avi Kivity 已提交
554 555 556 557 558 559 560 561 562 563 564
        flatview_insert(view, i, &fr);
    }
}

/* Render a memory topology into a list of disjoint absolute ranges. */
static FlatView generate_memory_topology(MemoryRegion *mr)
{
    FlatView view;

    flatview_init(&view);

565 566
    render_memory_region(&view, mr, int128_zero(),
                         addrrange_make(int128_zero(), int128_2_64()), false);
567
    flatview_simplify(&view);
A
Avi Kivity 已提交
568 569 570 571

    return view;
}

A
Avi Kivity 已提交
572 573 574 575 576 577 578
static void address_space_add_del_ioeventfds(AddressSpace *as,
                                             MemoryRegionIoeventfd *fds_new,
                                             unsigned fds_new_nb,
                                             MemoryRegionIoeventfd *fds_old,
                                             unsigned fds_old_nb)
{
    unsigned iold, inew;
579 580
    MemoryRegionIoeventfd *fd;
    MemoryRegionSection section;
A
Avi Kivity 已提交
581 582 583 584 585 586 587 588 589 590 591

    /* Generate a symmetric difference of the old and new fd sets, adding
     * and deleting as necessary.
     */

    iold = inew = 0;
    while (iold < fds_old_nb || inew < fds_new_nb) {
        if (iold < fds_old_nb
            && (inew == fds_new_nb
                || memory_region_ioeventfd_before(fds_old[iold],
                                                  fds_new[inew]))) {
592 593 594 595 596 597 598
            fd = &fds_old[iold];
            section = (MemoryRegionSection) {
                .address_space = as->root,
                .offset_within_address_space = int128_get64(fd->addr.start),
                .size = int128_get64(fd->addr.size),
            };
            MEMORY_LISTENER_CALL(eventfd_del, Forward, &section,
599
                                 fd->match_data, fd->data, fd->e);
A
Avi Kivity 已提交
600 601 602 603 604
            ++iold;
        } else if (inew < fds_new_nb
                   && (iold == fds_old_nb
                       || memory_region_ioeventfd_before(fds_new[inew],
                                                         fds_old[iold]))) {
605 606 607 608 609 610 611
            fd = &fds_new[inew];
            section = (MemoryRegionSection) {
                .address_space = as->root,
                .offset_within_address_space = int128_get64(fd->addr.start),
                .size = int128_get64(fd->addr.size),
            };
            MEMORY_LISTENER_CALL(eventfd_add, Reverse, &section,
612
                                 fd->match_data, fd->data, fd->e);
A
Avi Kivity 已提交
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628
            ++inew;
        } else {
            ++iold;
            ++inew;
        }
    }
}

static void address_space_update_ioeventfds(AddressSpace *as)
{
    FlatRange *fr;
    unsigned ioeventfd_nb = 0;
    MemoryRegionIoeventfd *ioeventfds = NULL;
    AddrRange tmp;
    unsigned i;

629
    FOR_EACH_FLAT_RANGE(fr, as->current_map) {
A
Avi Kivity 已提交
630 631
        for (i = 0; i < fr->mr->ioeventfd_nb; ++i) {
            tmp = addrrange_shift(fr->mr->ioeventfds[i].addr,
632 633
                                  int128_sub(fr->addr.start,
                                             int128_make64(fr->offset_in_region)));
A
Avi Kivity 已提交
634 635
            if (addrrange_intersects(fr->addr, tmp)) {
                ++ioeventfd_nb;
636
                ioeventfds = g_realloc(ioeventfds,
A
Avi Kivity 已提交
637 638 639 640 641 642 643 644 645 646
                                          ioeventfd_nb * sizeof(*ioeventfds));
                ioeventfds[ioeventfd_nb-1] = fr->mr->ioeventfds[i];
                ioeventfds[ioeventfd_nb-1].addr = tmp;
            }
        }
    }

    address_space_add_del_ioeventfds(as, ioeventfds, ioeventfd_nb,
                                     as->ioeventfds, as->ioeventfd_nb);

647
    g_free(as->ioeventfds);
A
Avi Kivity 已提交
648 649 650 651
    as->ioeventfds = ioeventfds;
    as->ioeventfd_nb = ioeventfd_nb;
}

652 653 654 655
static void address_space_update_topology_pass(AddressSpace *as,
                                               FlatView old_view,
                                               FlatView new_view,
                                               bool adding)
A
Avi Kivity 已提交
656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
{
    unsigned iold, inew;
    FlatRange *frold, *frnew;

    /* Generate a symmetric difference of the old and new memory maps.
     * Kill ranges in the old map, and instantiate ranges in the new map.
     */
    iold = inew = 0;
    while (iold < old_view.nr || inew < new_view.nr) {
        if (iold < old_view.nr) {
            frold = &old_view.ranges[iold];
        } else {
            frold = NULL;
        }
        if (inew < new_view.nr) {
            frnew = &new_view.ranges[inew];
        } else {
            frnew = NULL;
        }

        if (frold
            && (!frnew
678 679
                || int128_lt(frold->addr.start, frnew->addr.start)
                || (int128_eq(frold->addr.start, frnew->addr.start)
A
Avi Kivity 已提交
680 681 682
                    && !flatrange_equal(frold, frnew)))) {
            /* In old, but (not in new, or in new but attributes changed). */

683
            if (!adding) {
684
                MEMORY_LISTENER_UPDATE_REGION(frold, as, Reverse, region_del);
685 686
            }

A
Avi Kivity 已提交
687 688 689 690
            ++iold;
        } else if (frold && frnew && flatrange_equal(frold, frnew)) {
            /* In both (logging may have changed) */

691
            if (adding) {
692
                MEMORY_LISTENER_UPDATE_REGION(frnew, as, Forward, region_nop);
693
                if (frold->dirty_log_mask && !frnew->dirty_log_mask) {
694
                    MEMORY_LISTENER_UPDATE_REGION(frnew, as, Reverse, log_stop);
695
                } else if (frnew->dirty_log_mask && !frold->dirty_log_mask) {
696
                    MEMORY_LISTENER_UPDATE_REGION(frnew, as, Forward, log_start);
697
                }
A
Avi Kivity 已提交
698 699
            }

A
Avi Kivity 已提交
700 701 702 703 704
            ++iold;
            ++inew;
        } else {
            /* In new */

705
            if (adding) {
706
                MEMORY_LISTENER_UPDATE_REGION(frnew, as, Forward, region_add);
707 708
            }

A
Avi Kivity 已提交
709 710 711
            ++inew;
        }
    }
712 713 714 715 716
}


static void address_space_update_topology(AddressSpace *as)
{
717
    FlatView old_view = *as->current_map;
718 719 720 721 722
    FlatView new_view = generate_memory_topology(as->root);

    address_space_update_topology_pass(as, old_view, new_view, false);
    address_space_update_topology_pass(as, old_view, new_view, true);

723
    *as->current_map = new_view;
A
Avi Kivity 已提交
724
    flatview_destroy(&old_view);
A
Avi Kivity 已提交
725
    address_space_update_ioeventfds(as);
A
Avi Kivity 已提交
726 727
}

A
Avi Kivity 已提交
728 729
void memory_region_transaction_begin(void)
{
730
    qemu_flush_coalesced_mmio_buffer();
A
Avi Kivity 已提交
731 732 733 734 735
    ++memory_region_transaction_depth;
}

void memory_region_transaction_commit(void)
{
736 737
    AddressSpace *as;

A
Avi Kivity 已提交
738 739
    assert(memory_region_transaction_depth);
    --memory_region_transaction_depth;
740 741 742
    if (!memory_region_transaction_depth) {
        MEMORY_LISTENER_CALL_GLOBAL(begin, Forward);

743 744
        QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
            address_space_update_topology(as);
745 746 747
        }

        MEMORY_LISTENER_CALL_GLOBAL(commit, Forward);
748
    }
A
Avi Kivity 已提交
749 750
}

751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768
static void memory_region_destructor_none(MemoryRegion *mr)
{
}

static void memory_region_destructor_ram(MemoryRegion *mr)
{
    qemu_ram_free(mr->ram_addr);
}

static void memory_region_destructor_ram_from_ptr(MemoryRegion *mr)
{
    qemu_ram_free_from_ptr(mr->ram_addr);
}

static void memory_region_destructor_iomem(MemoryRegion *mr)
{
}

769 770 771 772 773
static void memory_region_destructor_rom_device(MemoryRegion *mr)
{
    qemu_ram_free(mr->ram_addr & TARGET_PAGE_MASK);
}

774 775
static bool memory_region_wrong_endianness(MemoryRegion *mr)
{
776
#ifdef TARGET_WORDS_BIGENDIAN
777 778 779 780 781 782
    return mr->ops->endianness == DEVICE_LITTLE_ENDIAN;
#else
    return mr->ops->endianness == DEVICE_BIG_ENDIAN;
#endif
}

A
Avi Kivity 已提交
783 784 785 786 787 788
void memory_region_init(MemoryRegion *mr,
                        const char *name,
                        uint64_t size)
{
    mr->ops = NULL;
    mr->parent = NULL;
789 790 791 792
    mr->size = int128_make64(size);
    if (size == UINT64_MAX) {
        mr->size = int128_2_64();
    }
A
Avi Kivity 已提交
793
    mr->addr = 0;
A
Avi Kivity 已提交
794
    mr->subpage = false;
795
    mr->enabled = true;
796
    mr->terminates = false;
A
Avi Kivity 已提交
797
    mr->ram = false;
798
    mr->readable = true;
799
    mr->readonly = false;
A
Avi Kivity 已提交
800
    mr->rom_device = false;
801
    mr->destructor = memory_region_destructor_none;
A
Avi Kivity 已提交
802 803 804 805 806 807
    mr->priority = 0;
    mr->may_overlap = false;
    mr->alias = NULL;
    QTAILQ_INIT(&mr->subregions);
    memset(&mr->subregions_link, 0, sizeof mr->subregions_link);
    QTAILQ_INIT(&mr->coalesced);
808
    mr->name = g_strdup(name);
A
Avi Kivity 已提交
809
    mr->dirty_log_mask = 0;
A
Avi Kivity 已提交
810 811
    mr->ioeventfd_nb = 0;
    mr->ioeventfds = NULL;
812
    mr->flush_coalesced_mmio = false;
A
Avi Kivity 已提交
813 814 815 816
}

static bool memory_region_access_valid(MemoryRegion *mr,
                                       target_phys_addr_t addr,
817 818
                                       unsigned size,
                                       bool is_write)
A
Avi Kivity 已提交
819
{
820 821 822 823 824
    if (mr->ops->valid.accepts
        && !mr->ops->valid.accepts(mr->opaque, addr, size, is_write)) {
        return false;
    }

A
Avi Kivity 已提交
825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
    if (!mr->ops->valid.unaligned && (addr & (size - 1))) {
        return false;
    }

    /* Treat zero as compatibility all valid */
    if (!mr->ops->valid.max_access_size) {
        return true;
    }

    if (size > mr->ops->valid.max_access_size
        || size < mr->ops->valid.min_access_size) {
        return false;
    }
    return true;
}

841 842 843
static uint64_t memory_region_dispatch_read1(MemoryRegion *mr,
                                             target_phys_addr_t addr,
                                             unsigned size)
A
Avi Kivity 已提交
844
{
845
    uint64_t data = 0;
A
Avi Kivity 已提交
846

847
    if (!memory_region_access_valid(mr, addr, size, false)) {
A
Avi Kivity 已提交
848 849 850
        return -1U; /* FIXME: better signalling */
    }

851 852 853 854
    if (!mr->ops->read) {
        return mr->ops->old_mmio.read[bitops_ffsl(size)](mr->opaque, addr);
    }

A
Avi Kivity 已提交
855
    /* FIXME: support unaligned access */
856
    access_with_adjusted_size(addr, &data, size,
857 858 859
                              mr->ops->impl.min_access_size,
                              mr->ops->impl.max_access_size,
                              memory_region_read_accessor, mr);
A
Avi Kivity 已提交
860 861 862 863

    return data;
}

864
static void adjust_endianness(MemoryRegion *mr, uint64_t *data, unsigned size)
A
Avi Kivity 已提交
865
{
866 867 868 869 870 871 872 873 874
    if (memory_region_wrong_endianness(mr)) {
        switch (size) {
        case 1:
            break;
        case 2:
            *data = bswap16(*data);
            break;
        case 4:
            *data = bswap32(*data);
875
            break;
876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891
        default:
            abort();
        }
    }
}

static uint64_t memory_region_dispatch_read(MemoryRegion *mr,
                                            target_phys_addr_t addr,
                                            unsigned size)
{
    uint64_t ret;

    ret = memory_region_dispatch_read1(mr, addr, size);
    adjust_endianness(mr, &ret, size);
    return ret;
}
A
Avi Kivity 已提交
892

893 894 895 896 897
static void memory_region_dispatch_write(MemoryRegion *mr,
                                         target_phys_addr_t addr,
                                         uint64_t data,
                                         unsigned size)
{
898
    if (!memory_region_access_valid(mr, addr, size, true)) {
A
Avi Kivity 已提交
899 900 901
        return; /* FIXME: better signalling */
    }

902 903
    adjust_endianness(mr, &data, size);

904 905 906 907 908
    if (!mr->ops->write) {
        mr->ops->old_mmio.write[bitops_ffsl(size)](mr->opaque, addr, data);
        return;
    }

A
Avi Kivity 已提交
909
    /* FIXME: support unaligned access */
910
    access_with_adjusted_size(addr, &data, size,
911 912 913
                              mr->ops->impl.min_access_size,
                              mr->ops->impl.max_access_size,
                              memory_region_write_accessor, mr);
A
Avi Kivity 已提交
914 915 916 917 918 919 920 921 922 923 924
}

void memory_region_init_io(MemoryRegion *mr,
                           const MemoryRegionOps *ops,
                           void *opaque,
                           const char *name,
                           uint64_t size)
{
    memory_region_init(mr, name, size);
    mr->ops = ops;
    mr->opaque = opaque;
925
    mr->terminates = true;
926
    mr->destructor = memory_region_destructor_iomem;
927
    mr->ram_addr = ~(ram_addr_t)0;
A
Avi Kivity 已提交
928 929 930 931 932 933 934
}

void memory_region_init_ram(MemoryRegion *mr,
                            const char *name,
                            uint64_t size)
{
    memory_region_init(mr, name, size);
A
Avi Kivity 已提交
935
    mr->ram = true;
936
    mr->terminates = true;
937
    mr->destructor = memory_region_destructor_ram;
938
    mr->ram_addr = qemu_ram_alloc(size, mr);
A
Avi Kivity 已提交
939 940 941 942 943 944 945 946
}

void memory_region_init_ram_ptr(MemoryRegion *mr,
                                const char *name,
                                uint64_t size,
                                void *ptr)
{
    memory_region_init(mr, name, size);
A
Avi Kivity 已提交
947
    mr->ram = true;
948
    mr->terminates = true;
949
    mr->destructor = memory_region_destructor_ram_from_ptr;
950
    mr->ram_addr = qemu_ram_alloc_from_ptr(size, ptr, mr);
A
Avi Kivity 已提交
951 952 953 954 955 956 957 958 959 960 961 962 963
}

void memory_region_init_alias(MemoryRegion *mr,
                              const char *name,
                              MemoryRegion *orig,
                              target_phys_addr_t offset,
                              uint64_t size)
{
    memory_region_init(mr, name, size);
    mr->alias = orig;
    mr->alias_offset = offset;
}

964 965
void memory_region_init_rom_device(MemoryRegion *mr,
                                   const MemoryRegionOps *ops,
966
                                   void *opaque,
967 968 969 970
                                   const char *name,
                                   uint64_t size)
{
    memory_region_init(mr, name, size);
971
    mr->ops = ops;
972
    mr->opaque = opaque;
973
    mr->terminates = true;
A
Avi Kivity 已提交
974
    mr->rom_device = true;
975
    mr->destructor = memory_region_destructor_rom_device;
976
    mr->ram_addr = qemu_ram_alloc(size, mr);
977 978
}

979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
static uint64_t invalid_read(void *opaque, target_phys_addr_t addr,
                             unsigned size)
{
    MemoryRegion *mr = opaque;

    if (!mr->warning_printed) {
        fprintf(stderr, "Invalid read from memory region %s\n", mr->name);
        mr->warning_printed = true;
    }
    return -1U;
}

static void invalid_write(void *opaque, target_phys_addr_t addr, uint64_t data,
                          unsigned size)
{
    MemoryRegion *mr = opaque;

    if (!mr->warning_printed) {
        fprintf(stderr, "Invalid write to memory region %s\n", mr->name);
        mr->warning_printed = true;
    }
}

static const MemoryRegionOps reservation_ops = {
    .read = invalid_read,
    .write = invalid_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
};

void memory_region_init_reservation(MemoryRegion *mr,
                                    const char *name,
                                    uint64_t size)
{
    memory_region_init_io(mr, &reservation_ops, mr, name, size);
}

A
Avi Kivity 已提交
1015 1016 1017
void memory_region_destroy(MemoryRegion *mr)
{
    assert(QTAILQ_EMPTY(&mr->subregions));
1018
    mr->destructor(mr);
A
Avi Kivity 已提交
1019
    memory_region_clear_coalescing(mr);
1020 1021
    g_free((char *)mr->name);
    g_free(mr->ioeventfds);
A
Avi Kivity 已提交
1022 1023 1024 1025
}

uint64_t memory_region_size(MemoryRegion *mr)
{
1026 1027 1028 1029
    if (int128_eq(mr->size, int128_2_64())) {
        return UINT64_MAX;
    }
    return int128_get64(mr->size);
A
Avi Kivity 已提交
1030 1031
}

1032 1033 1034 1035 1036
const char *memory_region_name(MemoryRegion *mr)
{
    return mr->name;
}

A
Avi Kivity 已提交
1037 1038 1039 1040 1041
bool memory_region_is_ram(MemoryRegion *mr)
{
    return mr->ram;
}

1042 1043 1044 1045 1046
bool memory_region_is_logging(MemoryRegion *mr)
{
    return mr->dirty_log_mask;
}

A
Avi Kivity 已提交
1047 1048 1049 1050 1051
bool memory_region_is_rom(MemoryRegion *mr)
{
    return mr->ram && mr->readonly;
}

A
Avi Kivity 已提交
1052 1053
void memory_region_set_log(MemoryRegion *mr, bool log, unsigned client)
{
A
Avi Kivity 已提交
1054 1055
    uint8_t mask = 1 << client;

1056
    memory_region_transaction_begin();
A
Avi Kivity 已提交
1057
    mr->dirty_log_mask = (mr->dirty_log_mask & ~mask) | (log * mask);
1058
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1059 1060 1061
}

bool memory_region_get_dirty(MemoryRegion *mr, target_phys_addr_t addr,
1062
                             target_phys_addr_t size, unsigned client)
A
Avi Kivity 已提交
1063
{
1064
    assert(mr->terminates);
1065 1066
    return cpu_physical_memory_get_dirty(mr->ram_addr + addr, size,
                                         1 << client);
A
Avi Kivity 已提交
1067 1068
}

1069 1070
void memory_region_set_dirty(MemoryRegion *mr, target_phys_addr_t addr,
                             target_phys_addr_t size)
A
Avi Kivity 已提交
1071
{
1072
    assert(mr->terminates);
1073
    return cpu_physical_memory_set_dirty_range(mr->ram_addr + addr, size, -1);
A
Avi Kivity 已提交
1074 1075 1076 1077
}

void memory_region_sync_dirty_bitmap(MemoryRegion *mr)
{
1078
    AddressSpace *as;
A
Avi Kivity 已提交
1079 1080
    FlatRange *fr;

1081 1082 1083 1084 1085
    QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
        FOR_EACH_FLAT_RANGE(fr, as->current_map) {
            if (fr->mr == mr) {
                MEMORY_LISTENER_UPDATE_REGION(fr, as, Forward, log_sync);
            }
A
Avi Kivity 已提交
1086 1087
        }
    }
A
Avi Kivity 已提交
1088 1089 1090 1091
}

void memory_region_set_readonly(MemoryRegion *mr, bool readonly)
{
1092
    if (mr->readonly != readonly) {
1093
        memory_region_transaction_begin();
1094
        mr->readonly = readonly;
1095
        memory_region_transaction_commit();
1096
    }
A
Avi Kivity 已提交
1097 1098
}

1099 1100 1101
void memory_region_rom_device_set_readable(MemoryRegion *mr, bool readable)
{
    if (mr->readable != readable) {
1102
        memory_region_transaction_begin();
1103
        mr->readable = readable;
1104
        memory_region_transaction_commit();
1105 1106 1107
    }
}

A
Avi Kivity 已提交
1108 1109 1110
void memory_region_reset_dirty(MemoryRegion *mr, target_phys_addr_t addr,
                               target_phys_addr_t size, unsigned client)
{
1111
    assert(mr->terminates);
A
Avi Kivity 已提交
1112 1113 1114
    cpu_physical_memory_reset_dirty(mr->ram_addr + addr,
                                    mr->ram_addr + addr + size,
                                    1 << client);
A
Avi Kivity 已提交
1115 1116 1117 1118 1119 1120 1121 1122
}

void *memory_region_get_ram_ptr(MemoryRegion *mr)
{
    if (mr->alias) {
        return memory_region_get_ram_ptr(mr->alias) + mr->alias_offset;
    }

1123
    assert(mr->terminates);
A
Avi Kivity 已提交
1124

1125
    return qemu_get_ram_ptr(mr->ram_addr & TARGET_PAGE_MASK);
A
Avi Kivity 已提交
1126 1127
}

1128
static void memory_region_update_coalesced_range_as(MemoryRegion *mr, AddressSpace *as)
A
Avi Kivity 已提交
1129 1130 1131 1132 1133
{
    FlatRange *fr;
    CoalescedMemoryRange *cmr;
    AddrRange tmp;

1134
    FOR_EACH_FLAT_RANGE(fr, as->current_map) {
A
Avi Kivity 已提交
1135
        if (fr->mr == mr) {
1136 1137
            qemu_unregister_coalesced_mmio(int128_get64(fr->addr.start),
                                           int128_get64(fr->addr.size));
A
Avi Kivity 已提交
1138 1139
            QTAILQ_FOREACH(cmr, &mr->coalesced, link) {
                tmp = addrrange_shift(cmr->addr,
1140 1141
                                      int128_sub(fr->addr.start,
                                                 int128_make64(fr->offset_in_region)));
A
Avi Kivity 已提交
1142 1143 1144 1145
                if (!addrrange_intersects(tmp, fr->addr)) {
                    continue;
                }
                tmp = addrrange_intersection(tmp, fr->addr);
1146 1147
                qemu_register_coalesced_mmio(int128_get64(tmp.start),
                                             int128_get64(tmp.size));
A
Avi Kivity 已提交
1148 1149 1150 1151 1152
            }
        }
    }
}

1153 1154 1155 1156 1157 1158 1159 1160 1161
static void memory_region_update_coalesced_range(MemoryRegion *mr)
{
    AddressSpace *as;

    QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
        memory_region_update_coalesced_range_as(mr, as);
    }
}

A
Avi Kivity 已提交
1162 1163 1164
void memory_region_set_coalescing(MemoryRegion *mr)
{
    memory_region_clear_coalescing(mr);
1165
    memory_region_add_coalescing(mr, 0, int128_get64(mr->size));
A
Avi Kivity 已提交
1166 1167 1168 1169 1170 1171
}

void memory_region_add_coalescing(MemoryRegion *mr,
                                  target_phys_addr_t offset,
                                  uint64_t size)
{
1172
    CoalescedMemoryRange *cmr = g_malloc(sizeof(*cmr));
A
Avi Kivity 已提交
1173

1174
    cmr->addr = addrrange_make(int128_make64(offset), int128_make64(size));
A
Avi Kivity 已提交
1175 1176
    QTAILQ_INSERT_TAIL(&mr->coalesced, cmr, link);
    memory_region_update_coalesced_range(mr);
1177
    memory_region_set_flush_coalesced(mr);
A
Avi Kivity 已提交
1178 1179 1180 1181 1182 1183
}

void memory_region_clear_coalescing(MemoryRegion *mr)
{
    CoalescedMemoryRange *cmr;

1184 1185 1186
    qemu_flush_coalesced_mmio_buffer();
    mr->flush_coalesced_mmio = false;

A
Avi Kivity 已提交
1187 1188 1189
    while (!QTAILQ_EMPTY(&mr->coalesced)) {
        cmr = QTAILQ_FIRST(&mr->coalesced);
        QTAILQ_REMOVE(&mr->coalesced, cmr, link);
1190
        g_free(cmr);
A
Avi Kivity 已提交
1191 1192 1193 1194
    }
    memory_region_update_coalesced_range(mr);
}

1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
void memory_region_set_flush_coalesced(MemoryRegion *mr)
{
    mr->flush_coalesced_mmio = true;
}

void memory_region_clear_flush_coalesced(MemoryRegion *mr)
{
    qemu_flush_coalesced_mmio_buffer();
    if (QTAILQ_EMPTY(&mr->coalesced)) {
        mr->flush_coalesced_mmio = false;
    }
}

A
Avi Kivity 已提交
1208 1209 1210 1211 1212
void memory_region_add_eventfd(MemoryRegion *mr,
                               target_phys_addr_t addr,
                               unsigned size,
                               bool match_data,
                               uint64_t data,
1213
                               EventNotifier *e)
A
Avi Kivity 已提交
1214 1215
{
    MemoryRegionIoeventfd mrfd = {
1216 1217
        .addr.start = int128_make64(addr),
        .addr.size = int128_make64(size),
A
Avi Kivity 已提交
1218 1219
        .match_data = match_data,
        .data = data,
1220
        .e = e,
A
Avi Kivity 已提交
1221 1222 1223
    };
    unsigned i;

1224
    memory_region_transaction_begin();
A
Avi Kivity 已提交
1225 1226 1227 1228 1229 1230
    for (i = 0; i < mr->ioeventfd_nb; ++i) {
        if (memory_region_ioeventfd_before(mrfd, mr->ioeventfds[i])) {
            break;
        }
    }
    ++mr->ioeventfd_nb;
1231
    mr->ioeventfds = g_realloc(mr->ioeventfds,
A
Avi Kivity 已提交
1232 1233 1234 1235
                                  sizeof(*mr->ioeventfds) * mr->ioeventfd_nb);
    memmove(&mr->ioeventfds[i+1], &mr->ioeventfds[i],
            sizeof(*mr->ioeventfds) * (mr->ioeventfd_nb-1 - i));
    mr->ioeventfds[i] = mrfd;
1236
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1237 1238 1239 1240 1241 1242 1243
}

void memory_region_del_eventfd(MemoryRegion *mr,
                               target_phys_addr_t addr,
                               unsigned size,
                               bool match_data,
                               uint64_t data,
1244
                               EventNotifier *e)
A
Avi Kivity 已提交
1245 1246
{
    MemoryRegionIoeventfd mrfd = {
1247 1248
        .addr.start = int128_make64(addr),
        .addr.size = int128_make64(size),
A
Avi Kivity 已提交
1249 1250
        .match_data = match_data,
        .data = data,
1251
        .e = e,
A
Avi Kivity 已提交
1252 1253 1254
    };
    unsigned i;

1255
    memory_region_transaction_begin();
A
Avi Kivity 已提交
1256 1257 1258 1259 1260 1261 1262 1263 1264
    for (i = 0; i < mr->ioeventfd_nb; ++i) {
        if (memory_region_ioeventfd_equal(mrfd, mr->ioeventfds[i])) {
            break;
        }
    }
    assert(i != mr->ioeventfd_nb);
    memmove(&mr->ioeventfds[i], &mr->ioeventfds[i+1],
            sizeof(*mr->ioeventfds) * (mr->ioeventfd_nb - (i+1)));
    --mr->ioeventfd_nb;
1265
    mr->ioeventfds = g_realloc(mr->ioeventfds,
A
Avi Kivity 已提交
1266
                                  sizeof(*mr->ioeventfds)*mr->ioeventfd_nb + 1);
1267
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1268 1269
}

A
Avi Kivity 已提交
1270 1271 1272 1273 1274 1275
static void memory_region_add_subregion_common(MemoryRegion *mr,
                                               target_phys_addr_t offset,
                                               MemoryRegion *subregion)
{
    MemoryRegion *other;

1276 1277
    memory_region_transaction_begin();

A
Avi Kivity 已提交
1278 1279 1280 1281 1282 1283 1284
    assert(!subregion->parent);
    subregion->parent = mr;
    subregion->addr = offset;
    QTAILQ_FOREACH(other, &mr->subregions, subregions_link) {
        if (subregion->may_overlap || other->may_overlap) {
            continue;
        }
1285 1286 1287 1288
        if (int128_gt(int128_make64(offset),
                      int128_add(int128_make64(other->addr), other->size))
            || int128_le(int128_add(int128_make64(offset), subregion->size),
                         int128_make64(other->addr))) {
A
Avi Kivity 已提交
1289 1290
            continue;
        }
1291
#if 0
1292 1293
        printf("warning: subregion collision %llx/%llx (%s) "
               "vs %llx/%llx (%s)\n",
A
Avi Kivity 已提交
1294
               (unsigned long long)offset,
1295
               (unsigned long long)int128_get64(subregion->size),
1296 1297
               subregion->name,
               (unsigned long long)other->addr,
1298
               (unsigned long long)int128_get64(other->size),
1299
               other->name);
1300
#endif
A
Avi Kivity 已提交
1301 1302 1303 1304 1305 1306 1307 1308 1309
    }
    QTAILQ_FOREACH(other, &mr->subregions, subregions_link) {
        if (subregion->priority >= other->priority) {
            QTAILQ_INSERT_BEFORE(other, subregion, subregions_link);
            goto done;
        }
    }
    QTAILQ_INSERT_TAIL(&mr->subregions, subregion, subregions_link);
done:
1310
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335
}


void memory_region_add_subregion(MemoryRegion *mr,
                                 target_phys_addr_t offset,
                                 MemoryRegion *subregion)
{
    subregion->may_overlap = false;
    subregion->priority = 0;
    memory_region_add_subregion_common(mr, offset, subregion);
}

void memory_region_add_subregion_overlap(MemoryRegion *mr,
                                         target_phys_addr_t offset,
                                         MemoryRegion *subregion,
                                         unsigned priority)
{
    subregion->may_overlap = true;
    subregion->priority = priority;
    memory_region_add_subregion_common(mr, offset, subregion);
}

void memory_region_del_subregion(MemoryRegion *mr,
                                 MemoryRegion *subregion)
{
1336
    memory_region_transaction_begin();
A
Avi Kivity 已提交
1337 1338 1339
    assert(subregion->parent == mr);
    subregion->parent = NULL;
    QTAILQ_REMOVE(&mr->subregions, subregion, subregions_link);
1340
    memory_region_transaction_commit();
1341 1342 1343 1344 1345 1346 1347
}

void memory_region_set_enabled(MemoryRegion *mr, bool enabled)
{
    if (enabled == mr->enabled) {
        return;
    }
1348
    memory_region_transaction_begin();
1349
    mr->enabled = enabled;
1350
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1351
}
A
Avi Kivity 已提交
1352

1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
void memory_region_set_address(MemoryRegion *mr, target_phys_addr_t addr)
{
    MemoryRegion *parent = mr->parent;
    unsigned priority = mr->priority;
    bool may_overlap = mr->may_overlap;

    if (addr == mr->addr || !parent) {
        mr->addr = addr;
        return;
    }

    memory_region_transaction_begin();
    memory_region_del_subregion(parent, mr);
    if (may_overlap) {
        memory_region_add_subregion_overlap(parent, addr, mr, priority);
    } else {
        memory_region_add_subregion(parent, addr, mr);
    }
    memory_region_transaction_commit();
}

1374 1375 1376 1377
void memory_region_set_alias_offset(MemoryRegion *mr, target_phys_addr_t offset)
{
    assert(mr->alias);

1378
    if (offset == mr->alias_offset) {
1379 1380 1381
        return;
    }

1382 1383 1384
    memory_region_transaction_begin();
    mr->alias_offset = offset;
    memory_region_transaction_commit();
1385 1386
}

1387 1388 1389 1390 1391
ram_addr_t memory_region_get_ram_addr(MemoryRegion *mr)
{
    return mr->ram_addr;
}

1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406
static int cmp_flatrange_addr(const void *addr_, const void *fr_)
{
    const AddrRange *addr = addr_;
    const FlatRange *fr = fr_;

    if (int128_le(addrrange_end(*addr), fr->addr.start)) {
        return -1;
    } else if (int128_ge(addr->start, addrrange_end(fr->addr))) {
        return 1;
    }
    return 0;
}

static FlatRange *address_space_lookup(AddressSpace *as, AddrRange addr)
{
1407
    return bsearch(&addr, as->current_map->ranges, as->current_map->nr,
1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
                   sizeof(FlatRange), cmp_flatrange_addr);
}

MemoryRegionSection memory_region_find(MemoryRegion *address_space,
                                       target_phys_addr_t addr, uint64_t size)
{
    AddressSpace *as = memory_region_to_address_space(address_space);
    AddrRange range = addrrange_make(int128_make64(addr),
                                     int128_make64(size));
    FlatRange *fr = address_space_lookup(as, range);
    MemoryRegionSection ret = { .mr = NULL, .size = 0 };

    if (!fr) {
        return ret;
    }

1424
    while (fr > as->current_map->ranges
1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435
           && addrrange_intersects(fr[-1].addr, range)) {
        --fr;
    }

    ret.mr = fr->mr;
    range = addrrange_intersection(range, fr->addr);
    ret.offset_within_region = fr->offset_in_region;
    ret.offset_within_region += int128_get64(int128_sub(range.start,
                                                        fr->addr.start));
    ret.size = int128_get64(range.size);
    ret.offset_within_address_space = int128_get64(range.start);
1436
    ret.readonly = fr->readonly;
1437 1438 1439
    return ret;
}

1440 1441
void memory_global_sync_dirty_bitmap(MemoryRegion *address_space)
{
1442 1443 1444
    AddressSpace *as = memory_region_to_address_space(address_space);
    FlatRange *fr;

1445
    FOR_EACH_FLAT_RANGE(fr, as->current_map) {
1446
        MEMORY_LISTENER_UPDATE_REGION(fr, as, Forward, log_sync);
1447 1448 1449 1450 1451 1452
    }
}

void memory_global_dirty_log_start(void)
{
    global_dirty_log = true;
1453
    MEMORY_LISTENER_CALL_GLOBAL(log_global_start, Forward);
1454 1455 1456 1457 1458
}

void memory_global_dirty_log_stop(void)
{
    global_dirty_log = false;
1459
    MEMORY_LISTENER_CALL_GLOBAL(log_global_stop, Reverse);
1460 1461 1462 1463 1464 1465 1466
}

static void listener_add_address_space(MemoryListener *listener,
                                       AddressSpace *as)
{
    FlatRange *fr;

1467 1468 1469 1470 1471
    if (listener->address_space_filter
        && listener->address_space_filter != as->root) {
        return;
    }

1472 1473 1474
    if (global_dirty_log) {
        listener->log_global_start(listener);
    }
1475
    FOR_EACH_FLAT_RANGE(fr, as->current_map) {
1476 1477 1478 1479 1480 1481
        MemoryRegionSection section = {
            .mr = fr->mr,
            .address_space = as->root,
            .offset_within_region = fr->offset_in_region,
            .size = int128_get64(fr->addr.size),
            .offset_within_address_space = int128_get64(fr->addr.start),
1482
            .readonly = fr->readonly,
1483 1484 1485 1486 1487
        };
        listener->region_add(listener, &section);
    }
}

1488
void memory_listener_register(MemoryListener *listener, MemoryRegion *filter)
1489
{
1490
    MemoryListener *other = NULL;
1491
    AddressSpace *as;
1492

1493
    listener->address_space_filter = filter;
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
    if (QTAILQ_EMPTY(&memory_listeners)
        || listener->priority >= QTAILQ_LAST(&memory_listeners,
                                             memory_listeners)->priority) {
        QTAILQ_INSERT_TAIL(&memory_listeners, listener, link);
    } else {
        QTAILQ_FOREACH(other, &memory_listeners, link) {
            if (listener->priority < other->priority) {
                break;
            }
        }
        QTAILQ_INSERT_BEFORE(other, listener, link);
    }
1506 1507 1508 1509

    QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
        listener_add_address_space(listener, as);
    }
1510 1511 1512 1513
}

void memory_listener_unregister(MemoryListener *listener)
{
1514
    QTAILQ_REMOVE(&memory_listeners, listener, link);
1515
}
1516

A
Avi Kivity 已提交
1517
void address_space_init(AddressSpace *as, MemoryRegion *root)
A
Avi Kivity 已提交
1518
{
1519
    memory_region_transaction_begin();
1520 1521 1522
    as->root = root;
    as->current_map = g_new(FlatView, 1);
    flatview_init(as->current_map);
1523 1524
    QTAILQ_INSERT_TAIL(&address_spaces, as, address_spaces_link);
    as->name = NULL;
1525
    memory_region_transaction_commit();
A
Avi Kivity 已提交
1526
}
A
Avi Kivity 已提交
1527

1528 1529 1530
void set_system_memory_map(MemoryRegion *mr)
{
    address_space_init(&address_space_memory, mr);
1531
    address_space_memory.name = "memory";
1532 1533
}

A
Avi Kivity 已提交
1534 1535
void set_system_io_map(MemoryRegion *mr)
{
1536
    address_space_init(&address_space_io, mr);
1537
    address_space_io.name = "I/O";
A
Avi Kivity 已提交
1538
}
B
Blue Swirl 已提交
1539

1540
uint64_t io_mem_read(MemoryRegion *mr, target_phys_addr_t addr, unsigned size)
1541
{
1542
    return memory_region_dispatch_read(mr, addr, size);
1543 1544
}

1545
void io_mem_write(MemoryRegion *mr, target_phys_addr_t addr,
1546 1547
                  uint64_t val, unsigned size)
{
1548
    memory_region_dispatch_write(mr, addr, val, size);
1549 1550
}

B
Blue Swirl 已提交
1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
typedef struct MemoryRegionList MemoryRegionList;

struct MemoryRegionList {
    const MemoryRegion *mr;
    bool printed;
    QTAILQ_ENTRY(MemoryRegionList) queue;
};

typedef QTAILQ_HEAD(queue, MemoryRegionList) MemoryRegionListHead;

static void mtree_print_mr(fprintf_function mon_printf, void *f,
                           const MemoryRegion *mr, unsigned int level,
                           target_phys_addr_t base,
1564
                           MemoryRegionListHead *alias_print_queue)
B
Blue Swirl 已提交
1565
{
1566 1567
    MemoryRegionList *new_ml, *ml, *next_ml;
    MemoryRegionListHead submr_print_queue;
B
Blue Swirl 已提交
1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
    const MemoryRegion *submr;
    unsigned int i;

    if (!mr) {
        return;
    }

    for (i = 0; i < level; i++) {
        mon_printf(f, "  ");
    }

    if (mr->alias) {
        MemoryRegionList *ml;
        bool found = false;

        /* check if the alias is already in the queue */
1584
        QTAILQ_FOREACH(ml, alias_print_queue, queue) {
B
Blue Swirl 已提交
1585 1586 1587 1588 1589 1590 1591 1592 1593
            if (ml->mr == mr->alias && !ml->printed) {
                found = true;
            }
        }

        if (!found) {
            ml = g_new(MemoryRegionList, 1);
            ml->mr = mr->alias;
            ml->printed = false;
1594
            QTAILQ_INSERT_TAIL(alias_print_queue, ml, queue);
B
Blue Swirl 已提交
1595
        }
1596 1597 1598
        mon_printf(f, TARGET_FMT_plx "-" TARGET_FMT_plx
                   " (prio %d, %c%c): alias %s @%s " TARGET_FMT_plx
                   "-" TARGET_FMT_plx "\n",
B
Blue Swirl 已提交
1599
                   base + mr->addr,
1600 1601
                   base + mr->addr
                   + (target_phys_addr_t)int128_get64(mr->size) - 1,
J
Jan Kiszka 已提交
1602
                   mr->priority,
1603 1604 1605
                   mr->readable ? 'R' : '-',
                   !mr->readonly && !(mr->rom_device && mr->readable) ? 'W'
                                                                      : '-',
B
Blue Swirl 已提交
1606 1607 1608
                   mr->name,
                   mr->alias->name,
                   mr->alias_offset,
1609 1610
                   mr->alias_offset
                   + (target_phys_addr_t)int128_get64(mr->size) - 1);
B
Blue Swirl 已提交
1611
    } else {
1612 1613
        mon_printf(f,
                   TARGET_FMT_plx "-" TARGET_FMT_plx " (prio %d, %c%c): %s\n",
B
Blue Swirl 已提交
1614
                   base + mr->addr,
1615 1616
                   base + mr->addr
                   + (target_phys_addr_t)int128_get64(mr->size) - 1,
J
Jan Kiszka 已提交
1617
                   mr->priority,
1618 1619 1620
                   mr->readable ? 'R' : '-',
                   !mr->readonly && !(mr->rom_device && mr->readable) ? 'W'
                                                                      : '-',
B
Blue Swirl 已提交
1621 1622
                   mr->name);
    }
1623 1624 1625

    QTAILQ_INIT(&submr_print_queue);

B
Blue Swirl 已提交
1626
    QTAILQ_FOREACH(submr, &mr->subregions, subregions_link) {
1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
        new_ml = g_new(MemoryRegionList, 1);
        new_ml->mr = submr;
        QTAILQ_FOREACH(ml, &submr_print_queue, queue) {
            if (new_ml->mr->addr < ml->mr->addr ||
                (new_ml->mr->addr == ml->mr->addr &&
                 new_ml->mr->priority > ml->mr->priority)) {
                QTAILQ_INSERT_BEFORE(ml, new_ml, queue);
                new_ml = NULL;
                break;
            }
        }
        if (new_ml) {
            QTAILQ_INSERT_TAIL(&submr_print_queue, new_ml, queue);
        }
    }

    QTAILQ_FOREACH(ml, &submr_print_queue, queue) {
        mtree_print_mr(mon_printf, f, ml->mr, level + 1, base + mr->addr,
                       alias_print_queue);
    }

A
Avi Kivity 已提交
1648
    QTAILQ_FOREACH_SAFE(ml, &submr_print_queue, queue, next_ml) {
1649
        g_free(ml);
B
Blue Swirl 已提交
1650 1651 1652 1653 1654 1655 1656
    }
}

void mtree_info(fprintf_function mon_printf, void *f)
{
    MemoryRegionListHead ml_head;
    MemoryRegionList *ml, *ml2;
1657
    AddressSpace *as;
B
Blue Swirl 已提交
1658 1659 1660

    QTAILQ_INIT(&ml_head);

1661 1662 1663 1664 1665 1666
    QTAILQ_FOREACH(as, &address_spaces, address_spaces_link) {
        if (!as->name) {
            continue;
        }
        mon_printf(f, "%s\n", as->name);
        mtree_print_mr(mon_printf, f, as->root, 0, 0, &ml_head);
1667 1668 1669
    }

    mon_printf(f, "aliases\n");
B
Blue Swirl 已提交
1670 1671 1672 1673 1674 1675 1676 1677 1678
    /* print aliased regions */
    QTAILQ_FOREACH(ml, &ml_head, queue) {
        if (!ml->printed) {
            mon_printf(f, "%s\n", ml->mr->name);
            mtree_print_mr(mon_printf, f, ml->mr, 0, 0, &ml_head);
        }
    }

    QTAILQ_FOREACH_SAFE(ml, &ml_head, queue, ml2) {
A
Avi Kivity 已提交
1679
        g_free(ml);
B
Blue Swirl 已提交
1680 1681
    }
}