exec.c 76.4 KB
Newer Older
B
bellard 已提交
1
/*
2
 *  Virtual page mapping
3
 *
B
bellard 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16
 *  Copyright (c) 2003 Fabrice Bellard
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
17
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
B
bellard 已提交
18
 */
B
bellard 已提交
19
#include "config.h"
20
#ifndef _WIN32
B
bellard 已提交
21
#include <sys/types.h>
B
bellard 已提交
22 23
#include <sys/mman.h>
#endif
B
bellard 已提交
24

25
#include "qemu-common.h"
B
bellard 已提交
26
#include "cpu.h"
B
bellard 已提交
27
#include "tcg.h"
28
#include "hw/hw.h"
29
#include "hw/qdev.h"
30
#include "qemu/osdep.h"
31
#include "sysemu/kvm.h"
32
#include "sysemu/sysemu.h"
P
Paolo Bonzini 已提交
33
#include "hw/xen/xen.h"
34 35
#include "qemu/timer.h"
#include "qemu/config-file.h"
36
#include "qemu/error-report.h"
37
#include "exec/memory.h"
38
#include "sysemu/dma.h"
39
#include "exec/address-spaces.h"
40 41
#if defined(CONFIG_USER_ONLY)
#include <qemu.h>
J
Jun Nakajima 已提交
42
#else /* !CONFIG_USER_ONLY */
43
#include "sysemu/xen-mapcache.h"
44
#include "trace.h"
45
#endif
46
#include "exec/cpu-all.h"
B
bellard 已提交
47

48
#include "exec/cputlb.h"
49
#include "translate-all.h"
50

51
#include "exec/memory-internal.h"
52
#include "exec/ram_addr.h"
53
#include "qemu/cache-utils.h"
54

55 56
#include "qemu/range.h"

57
//#define DEBUG_SUBPAGE
T
ths 已提交
58

59
#if !defined(CONFIG_USER_ONLY)
60
static bool in_migration;
P
pbrook 已提交
61

P
Paolo Bonzini 已提交
62
RAMList ram_list = { .blocks = QTAILQ_HEAD_INITIALIZER(ram_list.blocks) };
A
Avi Kivity 已提交
63 64

static MemoryRegion *system_memory;
65
static MemoryRegion *system_io;
A
Avi Kivity 已提交
66

67 68
AddressSpace address_space_io;
AddressSpace address_space_memory;
69

70
MemoryRegion io_mem_rom, io_mem_notdirty;
71
static MemoryRegion io_mem_unassigned;
72

73
#endif
74

A
Andreas Färber 已提交
75
struct CPUTailQ cpus = QTAILQ_HEAD_INITIALIZER(cpus);
B
bellard 已提交
76 77
/* current CPU in the current thread. It is only valid inside
   cpu_exec() */
78
DEFINE_TLS(CPUState *, current_cpu);
P
pbrook 已提交
79
/* 0 = Do not count executed instructions.
T
ths 已提交
80
   1 = Precise instruction counting.
P
pbrook 已提交
81
   2 = Adaptive rate instruction counting.  */
82
int use_icount;
B
bellard 已提交
83

84
#if !defined(CONFIG_USER_ONLY)
85

86 87 88
typedef struct PhysPageEntry PhysPageEntry;

struct PhysPageEntry {
M
Michael S. Tsirkin 已提交
89
    /* How many bits skip to next level (in units of L2_SIZE). 0 for a leaf. */
90
    uint32_t skip : 6;
M
Michael S. Tsirkin 已提交
91
     /* index into phys_sections (!skip) or phys_map_nodes (skip) */
92
    uint32_t ptr : 26;
93 94
};

95 96
#define PHYS_MAP_NODE_NIL (((uint32_t)~0) >> 6)

97
/* Size of the L2 (and L3, etc) page tables.  */
98
#define ADDR_SPACE_BITS 64
99

M
Michael S. Tsirkin 已提交
100
#define P_L2_BITS 9
101 102 103 104 105
#define P_L2_SIZE (1 << P_L2_BITS)

#define P_L2_LEVELS (((ADDR_SPACE_BITS - TARGET_PAGE_BITS - 1) / P_L2_BITS) + 1)

typedef PhysPageEntry Node[P_L2_SIZE];
106

107 108 109 110 111 112 113 114 115
typedef struct PhysPageMap {
    unsigned sections_nb;
    unsigned sections_nb_alloc;
    unsigned nodes_nb;
    unsigned nodes_nb_alloc;
    Node *nodes;
    MemoryRegionSection *sections;
} PhysPageMap;

116 117 118 119 120
struct AddressSpaceDispatch {
    /* This is a multi-level map on the physical address space.
     * The bottom level has pointers to MemoryRegionSections.
     */
    PhysPageEntry phys_map;
121
    PhysPageMap map;
122
    AddressSpace *as;
123 124
};

125 126 127
#define SUBPAGE_IDX(addr) ((addr) & ~TARGET_PAGE_MASK)
typedef struct subpage_t {
    MemoryRegion iomem;
128
    AddressSpace *as;
129 130 131 132
    hwaddr base;
    uint16_t sub_section[TARGET_PAGE_SIZE];
} subpage_t;

133 134 135 136
#define PHYS_SECTION_UNASSIGNED 0
#define PHYS_SECTION_NOTDIRTY 1
#define PHYS_SECTION_ROM 2
#define PHYS_SECTION_WATCH 3
137

138
static void io_mem_init(void);
A
Avi Kivity 已提交
139
static void memory_map_init(void);
140
static void tcg_commit(MemoryListener *listener);
141

142
static MemoryRegion io_mem_watch;
143
#endif
B
bellard 已提交
144

145
#if !defined(CONFIG_USER_ONLY)
146

147
static void phys_map_node_reserve(PhysPageMap *map, unsigned nodes)
148
{
149 150 151 152
    if (map->nodes_nb + nodes > map->nodes_nb_alloc) {
        map->nodes_nb_alloc = MAX(map->nodes_nb_alloc * 2, 16);
        map->nodes_nb_alloc = MAX(map->nodes_nb_alloc, map->nodes_nb + nodes);
        map->nodes = g_renew(Node, map->nodes, map->nodes_nb_alloc);
153
    }
154 155
}

156
static uint32_t phys_map_node_alloc(PhysPageMap *map)
157 158
{
    unsigned i;
159
    uint32_t ret;
160

161
    ret = map->nodes_nb++;
162
    assert(ret != PHYS_MAP_NODE_NIL);
163
    assert(ret != map->nodes_nb_alloc);
164
    for (i = 0; i < P_L2_SIZE; ++i) {
165 166
        map->nodes[ret][i].skip = 1;
        map->nodes[ret][i].ptr = PHYS_MAP_NODE_NIL;
167
    }
168
    return ret;
169 170
}

171 172
static void phys_page_set_level(PhysPageMap *map, PhysPageEntry *lp,
                                hwaddr *index, hwaddr *nb, uint16_t leaf,
173
                                int level)
174 175 176
{
    PhysPageEntry *p;
    int i;
177
    hwaddr step = (hwaddr)1 << (level * P_L2_BITS);
178

M
Michael S. Tsirkin 已提交
179
    if (lp->skip && lp->ptr == PHYS_MAP_NODE_NIL) {
180 181
        lp->ptr = phys_map_node_alloc(map);
        p = map->nodes[lp->ptr];
182
        if (level == 0) {
183
            for (i = 0; i < P_L2_SIZE; i++) {
M
Michael S. Tsirkin 已提交
184
                p[i].skip = 0;
185
                p[i].ptr = PHYS_SECTION_UNASSIGNED;
186
            }
P
pbrook 已提交
187
        }
188
    } else {
189
        p = map->nodes[lp->ptr];
B
bellard 已提交
190
    }
191
    lp = &p[(*index >> (level * P_L2_BITS)) & (P_L2_SIZE - 1)];
192

193
    while (*nb && lp < &p[P_L2_SIZE]) {
194
        if ((*index & (step - 1)) == 0 && *nb >= step) {
M
Michael S. Tsirkin 已提交
195
            lp->skip = 0;
196
            lp->ptr = leaf;
197 198
            *index += step;
            *nb -= step;
199
        } else {
200
            phys_page_set_level(map, lp, index, nb, leaf, level - 1);
201 202
        }
        ++lp;
203 204 205
    }
}

A
Avi Kivity 已提交
206
static void phys_page_set(AddressSpaceDispatch *d,
A
Avi Kivity 已提交
207
                          hwaddr index, hwaddr nb,
208
                          uint16_t leaf)
209
{
210
    /* Wildly overreserve - it doesn't matter much. */
211
    phys_map_node_reserve(&d->map, 3 * P_L2_LEVELS);
212

213
    phys_page_set_level(&d->map, &d->phys_map, &index, &nb, leaf, P_L2_LEVELS - 1);
B
bellard 已提交
214 215
}

216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273
/* Compact a non leaf page entry. Simply detect that the entry has a single child,
 * and update our entry so we can skip it and go directly to the destination.
 */
static void phys_page_compact(PhysPageEntry *lp, Node *nodes, unsigned long *compacted)
{
    unsigned valid_ptr = P_L2_SIZE;
    int valid = 0;
    PhysPageEntry *p;
    int i;

    if (lp->ptr == PHYS_MAP_NODE_NIL) {
        return;
    }

    p = nodes[lp->ptr];
    for (i = 0; i < P_L2_SIZE; i++) {
        if (p[i].ptr == PHYS_MAP_NODE_NIL) {
            continue;
        }

        valid_ptr = i;
        valid++;
        if (p[i].skip) {
            phys_page_compact(&p[i], nodes, compacted);
        }
    }

    /* We can only compress if there's only one child. */
    if (valid != 1) {
        return;
    }

    assert(valid_ptr < P_L2_SIZE);

    /* Don't compress if it won't fit in the # of bits we have. */
    if (lp->skip + p[valid_ptr].skip >= (1 << 3)) {
        return;
    }

    lp->ptr = p[valid_ptr].ptr;
    if (!p[valid_ptr].skip) {
        /* If our only child is a leaf, make this a leaf. */
        /* By design, we should have made this node a leaf to begin with so we
         * should never reach here.
         * But since it's so simple to handle this, let's do it just in case we
         * change this rule.
         */
        lp->skip = 0;
    } else {
        lp->skip += p[valid_ptr].skip;
    }
}

static void phys_page_compact_all(AddressSpaceDispatch *d, int nodes_nb)
{
    DECLARE_BITMAP(compacted, nodes_nb);

    if (d->phys_map.skip) {
274
        phys_page_compact(&d->phys_map, d->map.nodes, compacted);
275 276 277
    }
}

278
static MemoryRegionSection *phys_page_find(PhysPageEntry lp, hwaddr addr,
279
                                           Node *nodes, MemoryRegionSection *sections)
B
bellard 已提交
280
{
281
    PhysPageEntry *p;
282
    hwaddr index = addr >> TARGET_PAGE_BITS;
283
    int i;
284

M
Michael S. Tsirkin 已提交
285
    for (i = P_L2_LEVELS; lp.skip && (i -= lp.skip) >= 0;) {
286
        if (lp.ptr == PHYS_MAP_NODE_NIL) {
287
            return &sections[PHYS_SECTION_UNASSIGNED];
288
        }
289
        p = nodes[lp.ptr];
290
        lp = p[(index >> (i * P_L2_BITS)) & (P_L2_SIZE - 1)];
291
    }
292 293 294 295 296 297 298 299

    if (sections[lp.ptr].size.hi ||
        range_covers_byte(sections[lp.ptr].offset_within_address_space,
                          sections[lp.ptr].size.lo, addr)) {
        return &sections[lp.ptr];
    } else {
        return &sections[PHYS_SECTION_UNASSIGNED];
    }
300 301
}

B
Blue Swirl 已提交
302 303
bool memory_region_is_unassigned(MemoryRegion *mr)
{
P
Paolo Bonzini 已提交
304
    return mr != &io_mem_rom && mr != &io_mem_notdirty && !mr->rom_device
305
        && mr != &io_mem_watch;
B
bellard 已提交
306
}
307

308
static MemoryRegionSection *address_space_lookup_region(AddressSpaceDispatch *d,
309 310
                                                        hwaddr addr,
                                                        bool resolve_subpage)
311
{
312 313 314
    MemoryRegionSection *section;
    subpage_t *subpage;

315
    section = phys_page_find(d->phys_map, addr, d->map.nodes, d->map.sections);
316 317
    if (resolve_subpage && section->mr->subpage) {
        subpage = container_of(section->mr, subpage_t, iomem);
318
        section = &d->map.sections[subpage->sub_section[SUBPAGE_IDX(addr)]];
319 320
    }
    return section;
321 322
}

323
static MemoryRegionSection *
324
address_space_translate_internal(AddressSpaceDispatch *d, hwaddr addr, hwaddr *xlat,
325
                                 hwaddr *plen, bool resolve_subpage)
326 327
{
    MemoryRegionSection *section;
328
    Int128 diff;
329

330
    section = address_space_lookup_region(d, addr, resolve_subpage);
331 332 333 334 335 336 337
    /* Compute offset within MemoryRegionSection */
    addr -= section->offset_within_address_space;

    /* Compute offset within MemoryRegion */
    *xlat = addr + section->offset_within_region;

    diff = int128_sub(section->mr->size, int128_make64(addr));
338
    *plen = int128_get64(int128_min(diff, int128_make64(*plen)));
339 340
    return section;
}
341

342 343 344 345 346 347 348 349 350 351 352 353
static inline bool memory_access_is_direct(MemoryRegion *mr, bool is_write)
{
    if (memory_region_is_ram(mr)) {
        return !(is_write && mr->readonly);
    }
    if (memory_region_is_romd(mr)) {
        return !is_write;
    }

    return false;
}

354 355 356
MemoryRegion *address_space_translate(AddressSpace *as, hwaddr addr,
                                      hwaddr *xlat, hwaddr *plen,
                                      bool is_write)
357
{
A
Avi Kivity 已提交
358 359 360 361 362 363
    IOMMUTLBEntry iotlb;
    MemoryRegionSection *section;
    MemoryRegion *mr;
    hwaddr len = *plen;

    for (;;) {
364
        section = address_space_translate_internal(as->dispatch, addr, &addr, plen, true);
A
Avi Kivity 已提交
365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382
        mr = section->mr;

        if (!mr->iommu_ops) {
            break;
        }

        iotlb = mr->iommu_ops->translate(mr, addr);
        addr = ((iotlb.translated_addr & ~iotlb.addr_mask)
                | (addr & iotlb.addr_mask));
        len = MIN(len, (addr | iotlb.addr_mask) - addr + 1);
        if (!(iotlb.perm & (1 << is_write))) {
            mr = &io_mem_unassigned;
            break;
        }

        as = iotlb.target_as;
    }

383 384 385 386 387
    if (memory_access_is_direct(mr, is_write)) {
        hwaddr page = ((addr & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE) - addr;
        len = MIN(page, len);
    }

A
Avi Kivity 已提交
388 389 390
    *plen = len;
    *xlat = addr;
    return mr;
391 392 393 394 395 396
}

MemoryRegionSection *
address_space_translate_for_iotlb(AddressSpace *as, hwaddr addr, hwaddr *xlat,
                                  hwaddr *plen)
{
A
Avi Kivity 已提交
397
    MemoryRegionSection *section;
398
    section = address_space_translate_internal(as->dispatch, addr, xlat, plen, false);
A
Avi Kivity 已提交
399 400 401

    assert(!section->mr->iommu_ops);
    return section;
402
}
403
#endif
B
bellard 已提交
404

405
void cpu_exec_init_all(void)
406
{
407
#if !defined(CONFIG_USER_ONLY)
408
    qemu_mutex_init(&ram_list.mutex);
409 410
    memory_map_init();
    io_mem_init();
411
#endif
412
}
413

414
#if !defined(CONFIG_USER_ONLY)
415 416

static int cpu_common_post_load(void *opaque, int version_id)
B
bellard 已提交
417
{
418
    CPUState *cpu = opaque;
B
bellard 已提交
419

420 421
    /* 0x01 was CPU_INTERRUPT_EXIT. This line can be removed when the
       version_id is increased. */
422 423
    cpu->interrupt_request &= ~0x01;
    tlb_flush(cpu->env_ptr, 1);
424 425

    return 0;
B
bellard 已提交
426
}
B
bellard 已提交
427

428
const VMStateDescription vmstate_cpu_common = {
429 430 431 432 433 434
    .name = "cpu_common",
    .version_id = 1,
    .minimum_version_id = 1,
    .minimum_version_id_old = 1,
    .post_load = cpu_common_post_load,
    .fields      = (VMStateField []) {
435 436
        VMSTATE_UINT32(halted, CPUState),
        VMSTATE_UINT32(interrupt_request, CPUState),
437 438 439
        VMSTATE_END_OF_LIST()
    }
};
440

441
#endif
B
bellard 已提交
442

443
CPUState *qemu_get_cpu(int index)
B
bellard 已提交
444
{
A
Andreas Färber 已提交
445
    CPUState *cpu;
B
bellard 已提交
446

A
Andreas Färber 已提交
447
    CPU_FOREACH(cpu) {
448
        if (cpu->cpu_index == index) {
A
Andreas Färber 已提交
449
            return cpu;
450
        }
B
bellard 已提交
451
    }
452

A
Andreas Färber 已提交
453
    return NULL;
B
bellard 已提交
454 455
}

456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
#if !defined(CONFIG_USER_ONLY)
void tcg_cpu_address_space_init(CPUState *cpu, AddressSpace *as)
{
    /* We only support one address space per cpu at the moment.  */
    assert(cpu->as == as);

    if (cpu->tcg_as_listener) {
        memory_listener_unregister(cpu->tcg_as_listener);
    } else {
        cpu->tcg_as_listener = g_new0(MemoryListener, 1);
    }
    cpu->tcg_as_listener->commit = tcg_commit;
    memory_listener_register(cpu->tcg_as_listener, as);
}
#endif

472
void cpu_exec_init(CPUArchState *env)
B
bellard 已提交
473
{
474
    CPUState *cpu = ENV_GET_CPU(env);
475
    CPUClass *cc = CPU_GET_CLASS(cpu);
A
Andreas Färber 已提交
476
    CPUState *some_cpu;
477 478 479 480 481 482
    int cpu_index;

#if defined(CONFIG_USER_ONLY)
    cpu_list_lock();
#endif
    cpu_index = 0;
A
Andreas Färber 已提交
483
    CPU_FOREACH(some_cpu) {
484 485
        cpu_index++;
    }
486
    cpu->cpu_index = cpu_index;
487
    cpu->numa_node = 0;
488
    QTAILQ_INIT(&cpu->breakpoints);
489
    QTAILQ_INIT(&cpu->watchpoints);
490
#ifndef CONFIG_USER_ONLY
491
    cpu->as = &address_space_memory;
492 493
    cpu->thread_id = qemu_get_thread_id();
#endif
A
Andreas Färber 已提交
494
    QTAILQ_INSERT_TAIL(&cpus, cpu, node);
495 496 497
#if defined(CONFIG_USER_ONLY)
    cpu_list_unlock();
#endif
498 499 500
    if (qdev_get_vmsd(DEVICE(cpu)) == NULL) {
        vmstate_register(NULL, cpu_index, &vmstate_cpu_common, cpu);
    }
501 502 503
#if defined(CPU_SAVE_VERSION) && !defined(CONFIG_USER_ONLY)
    register_savevm(NULL, "cpu", cpu_index, CPU_SAVE_VERSION,
                    cpu_save, cpu_load, env);
504
    assert(cc->vmsd == NULL);
505
    assert(qdev_get_vmsd(DEVICE(cpu)) == NULL);
506
#endif
507 508 509
    if (cc->vmsd != NULL) {
        vmstate_register(NULL, cpu_index, cc->vmsd, cpu);
    }
B
bellard 已提交
510 511
}

B
bellard 已提交
512
#if defined(TARGET_HAS_ICE)
513
#if defined(CONFIG_USER_ONLY)
514
static void breakpoint_invalidate(CPUState *cpu, target_ulong pc)
515 516 517 518
{
    tb_invalidate_phys_page_range(pc, pc + 1, 0);
}
#else
519
static void breakpoint_invalidate(CPUState *cpu, target_ulong pc)
520
{
521 522
    hwaddr phys = cpu_get_phys_page_debug(cpu, pc);
    if (phys != -1) {
523
        tb_invalidate_phys_addr(cpu->as,
524
                                phys | (pc & ~TARGET_PAGE_MASK));
525
    }
526
}
B
bellard 已提交
527
#endif
528
#endif /* TARGET_HAS_ICE */
B
bellard 已提交
529

530
#if defined(CONFIG_USER_ONLY)
531
void cpu_watchpoint_remove_all(CPUState *cpu, int mask)
532 533 534 535

{
}

536
int cpu_watchpoint_insert(CPUState *cpu, vaddr addr, vaddr len,
537 538 539 540 541
                          int flags, CPUWatchpoint **watchpoint)
{
    return -ENOSYS;
}
#else
542
/* Add a watchpoint.  */
543
int cpu_watchpoint_insert(CPUState *cpu, vaddr addr, vaddr len,
544
                          int flags, CPUWatchpoint **watchpoint)
545
{
546
    vaddr len_mask = ~(len - 1);
547
    CPUWatchpoint *wp;
548

549
    /* sanity checks: allow power-of-2 lengths, deny unaligned watchpoints */
550 551
    if ((len & (len - 1)) || (addr & ~len_mask) ||
            len == 0 || len > TARGET_PAGE_SIZE) {
552 553
        error_report("tried to set invalid watchpoint at %"
                     VADDR_PRIx ", len=%" VADDR_PRIu, addr, len);
554 555
        return -EINVAL;
    }
556
    wp = g_malloc(sizeof(*wp));
557 558

    wp->vaddr = addr;
559
    wp->len_mask = len_mask;
560 561
    wp->flags = flags;

562
    /* keep all GDB-injected watchpoints in front */
563 564 565 566 567
    if (flags & BP_GDB) {
        QTAILQ_INSERT_HEAD(&cpu->watchpoints, wp, entry);
    } else {
        QTAILQ_INSERT_TAIL(&cpu->watchpoints, wp, entry);
    }
568

569
    tlb_flush_page(cpu, addr);
570 571 572 573

    if (watchpoint)
        *watchpoint = wp;
    return 0;
574 575
}

576
/* Remove a specific watchpoint.  */
577
int cpu_watchpoint_remove(CPUState *cpu, vaddr addr, vaddr len,
578
                          int flags)
579
{
580
    vaddr len_mask = ~(len - 1);
581
    CPUWatchpoint *wp;
582

583
    QTAILQ_FOREACH(wp, &cpu->watchpoints, entry) {
584
        if (addr == wp->vaddr && len_mask == wp->len_mask
585
                && flags == (wp->flags & ~BP_WATCHPOINT_HIT)) {
586
            cpu_watchpoint_remove_by_ref(cpu, wp);
587 588 589
            return 0;
        }
    }
590
    return -ENOENT;
591 592
}

593
/* Remove a specific watchpoint by reference.  */
594
void cpu_watchpoint_remove_by_ref(CPUState *cpu, CPUWatchpoint *watchpoint)
595
{
596
    QTAILQ_REMOVE(&cpu->watchpoints, watchpoint, entry);
597

598
    tlb_flush_page(cpu, watchpoint->vaddr);
599

600
    g_free(watchpoint);
601 602 603
}

/* Remove all matching watchpoints.  */
604
void cpu_watchpoint_remove_all(CPUState *cpu, int mask)
605
{
606
    CPUWatchpoint *wp, *next;
607

608
    QTAILQ_FOREACH_SAFE(wp, &cpu->watchpoints, entry, next) {
609 610 611
        if (wp->flags & mask) {
            cpu_watchpoint_remove_by_ref(cpu, wp);
        }
612
    }
613
}
614
#endif
615

616
/* Add a breakpoint.  */
617
int cpu_breakpoint_insert(CPUState *cpu, vaddr pc, int flags,
618
                          CPUBreakpoint **breakpoint)
B
bellard 已提交
619
{
B
bellard 已提交
620
#if defined(TARGET_HAS_ICE)
621
    CPUBreakpoint *bp;
622

623
    bp = g_malloc(sizeof(*bp));
B
bellard 已提交
624

625 626 627
    bp->pc = pc;
    bp->flags = flags;

628
    /* keep all GDB-injected breakpoints in front */
629
    if (flags & BP_GDB) {
630
        QTAILQ_INSERT_HEAD(&cpu->breakpoints, bp, entry);
631
    } else {
632
        QTAILQ_INSERT_TAIL(&cpu->breakpoints, bp, entry);
633
    }
634

635
    breakpoint_invalidate(cpu, pc);
636

637
    if (breakpoint) {
638
        *breakpoint = bp;
639
    }
B
bellard 已提交
640 641
    return 0;
#else
642
    return -ENOSYS;
B
bellard 已提交
643 644 645
#endif
}

646
/* Remove a specific breakpoint.  */
647
int cpu_breakpoint_remove(CPUState *cpu, vaddr pc, int flags)
648
{
649
#if defined(TARGET_HAS_ICE)
650 651
    CPUBreakpoint *bp;

652
    QTAILQ_FOREACH(bp, &cpu->breakpoints, entry) {
653
        if (bp->pc == pc && bp->flags == flags) {
654
            cpu_breakpoint_remove_by_ref(cpu, bp);
655 656
            return 0;
        }
657
    }
658 659 660
    return -ENOENT;
#else
    return -ENOSYS;
661 662 663
#endif
}

664
/* Remove a specific breakpoint by reference.  */
665
void cpu_breakpoint_remove_by_ref(CPUState *cpu, CPUBreakpoint *breakpoint)
B
bellard 已提交
666
{
B
bellard 已提交
667
#if defined(TARGET_HAS_ICE)
668 669 670
    QTAILQ_REMOVE(&cpu->breakpoints, breakpoint, entry);

    breakpoint_invalidate(cpu, breakpoint->pc);
671

672
    g_free(breakpoint);
673 674 675 676
#endif
}

/* Remove all matching breakpoints. */
677
void cpu_breakpoint_remove_all(CPUState *cpu, int mask)
678 679
{
#if defined(TARGET_HAS_ICE)
680
    CPUBreakpoint *bp, *next;
681

682
    QTAILQ_FOREACH_SAFE(bp, &cpu->breakpoints, entry, next) {
683 684 685
        if (bp->flags & mask) {
            cpu_breakpoint_remove_by_ref(cpu, bp);
        }
686
    }
B
bellard 已提交
687 688 689
#endif
}

B
bellard 已提交
690 691
/* enable or disable single step mode. EXCP_DEBUG is returned by the
   CPU loop after each instruction */
692
void cpu_single_step(CPUState *cpu, int enabled)
B
bellard 已提交
693
{
B
bellard 已提交
694
#if defined(TARGET_HAS_ICE)
695 696 697
    if (cpu->singlestep_enabled != enabled) {
        cpu->singlestep_enabled = enabled;
        if (kvm_enabled()) {
698
            kvm_update_guest_debug(cpu, 0);
699
        } else {
S
Stuart Brady 已提交
700
            /* must flush all the translated code to avoid inconsistencies */
701
            /* XXX: only flush what is necessary */
702
            CPUArchState *env = cpu->env_ptr;
703 704
            tb_flush(env);
        }
B
bellard 已提交
705 706 707 708
    }
#endif
}

709
void cpu_abort(CPUState *cpu, const char *fmt, ...)
B
bellard 已提交
710 711
{
    va_list ap;
P
pbrook 已提交
712
    va_list ap2;
B
bellard 已提交
713 714

    va_start(ap, fmt);
P
pbrook 已提交
715
    va_copy(ap2, ap);
B
bellard 已提交
716 717 718
    fprintf(stderr, "qemu: fatal: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
719
    cpu_dump_state(cpu, stderr, fprintf, CPU_DUMP_FPU | CPU_DUMP_CCOP);
720 721 722 723
    if (qemu_log_enabled()) {
        qemu_log("qemu: fatal: ");
        qemu_log_vprintf(fmt, ap2);
        qemu_log("\n");
724
        log_cpu_state(cpu, CPU_DUMP_FPU | CPU_DUMP_CCOP);
725
        qemu_log_flush();
726
        qemu_log_close();
727
    }
P
pbrook 已提交
728
    va_end(ap2);
729
    va_end(ap);
730 731 732 733 734 735 736 737
#if defined(CONFIG_USER_ONLY)
    {
        struct sigaction act;
        sigfillset(&act.sa_mask);
        act.sa_handler = SIG_DFL;
        sigaction(SIGABRT, &act, NULL);
    }
#endif
B
bellard 已提交
738 739 740
    abort();
}

741
#if !defined(CONFIG_USER_ONLY)
P
Paolo Bonzini 已提交
742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
static RAMBlock *qemu_get_ram_block(ram_addr_t addr)
{
    RAMBlock *block;

    /* The list is protected by the iothread lock here.  */
    block = ram_list.mru_block;
    if (block && addr - block->offset < block->length) {
        goto found;
    }
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
        if (addr - block->offset < block->length) {
            goto found;
        }
    }

    fprintf(stderr, "Bad ram offset %" PRIx64 "\n", (uint64_t)addr);
    abort();

found:
    ram_list.mru_block = block;
    return block;
}

765
static void tlb_reset_dirty_range_all(ram_addr_t start, ram_addr_t length)
J
Juan Quintela 已提交
766
{
P
Paolo Bonzini 已提交
767
    ram_addr_t start1;
768 769 770 771 772
    RAMBlock *block;
    ram_addr_t end;

    end = TARGET_PAGE_ALIGN(start + length);
    start &= TARGET_PAGE_MASK;
J
Juan Quintela 已提交
773

P
Paolo Bonzini 已提交
774 775 776 777
    block = qemu_get_ram_block(start);
    assert(block == qemu_get_ram_block(end - 1));
    start1 = (uintptr_t)block->host + (start - block->offset);
    cpu_tlb_reset_dirty_all(start1, length);
J
Juan Quintela 已提交
778 779
}

P
pbrook 已提交
780
/* Note: start and end must be within the same ram block.  */
781
void cpu_physical_memory_reset_dirty(ram_addr_t start, ram_addr_t length,
782
                                     unsigned client)
783 784 785
{
    if (length == 0)
        return;
786
    cpu_physical_memory_clear_dirty_range(start, length, client);
B
bellard 已提交
787

J
Juan Quintela 已提交
788
    if (tcg_enabled()) {
789
        tlb_reset_dirty_range_all(start, length);
P
pbrook 已提交
790
    }
791 792
}

793
static void cpu_physical_memory_set_dirty_tracking(bool enable)
A
aliguori 已提交
794 795 796 797
{
    in_migration = enable;
}

798
hwaddr memory_region_section_get_iotlb(CPUState *cpu,
799 800 801 802 803
                                       MemoryRegionSection *section,
                                       target_ulong vaddr,
                                       hwaddr paddr, hwaddr xlat,
                                       int prot,
                                       target_ulong *address)
B
Blue Swirl 已提交
804
{
A
Avi Kivity 已提交
805
    hwaddr iotlb;
B
Blue Swirl 已提交
806 807
    CPUWatchpoint *wp;

808
    if (memory_region_is_ram(section->mr)) {
B
Blue Swirl 已提交
809 810
        /* Normal RAM.  */
        iotlb = (memory_region_get_ram_addr(section->mr) & TARGET_PAGE_MASK)
811
            + xlat;
B
Blue Swirl 已提交
812
        if (!section->readonly) {
813
            iotlb |= PHYS_SECTION_NOTDIRTY;
B
Blue Swirl 已提交
814
        } else {
815
            iotlb |= PHYS_SECTION_ROM;
B
Blue Swirl 已提交
816 817
        }
    } else {
818
        iotlb = section - section->address_space->dispatch->map.sections;
819
        iotlb += xlat;
B
Blue Swirl 已提交
820 821 822 823
    }

    /* Make accesses to pages with watchpoints go via the
       watchpoint trap routines.  */
824
    QTAILQ_FOREACH(wp, &cpu->watchpoints, entry) {
B
Blue Swirl 已提交
825 826 827
        if (vaddr == (wp->vaddr & TARGET_PAGE_MASK)) {
            /* Avoid trapping reads of pages with a write breakpoint. */
            if ((prot & PAGE_WRITE) || (wp->flags & BP_MEM_READ)) {
828
                iotlb = PHYS_SECTION_WATCH + paddr;
B
Blue Swirl 已提交
829 830 831 832 833 834 835 836
                *address |= TLB_MMIO;
                break;
            }
        }
    }

    return iotlb;
}
837 838
#endif /* defined(CONFIG_USER_ONLY) */

839
#if !defined(CONFIG_USER_ONLY)
840

A
Anthony Liguori 已提交
841
static int subpage_register (subpage_t *mmio, uint32_t start, uint32_t end,
842
                             uint16_t section);
843
static subpage_t *subpage_init(AddressSpace *as, hwaddr base);
844

845
static void *(*phys_mem_alloc)(size_t size) = qemu_anon_ram_alloc;
846 847 848 849 850 851

/*
 * Set a custom physical guest memory alloator.
 * Accelerators with unusual needs may need this.  Hopefully, we can
 * get rid of it eventually.
 */
852
void phys_mem_set_alloc(void *(*alloc)(size_t))
853 854 855 856
{
    phys_mem_alloc = alloc;
}

857 858
static uint16_t phys_section_add(PhysPageMap *map,
                                 MemoryRegionSection *section)
859
{
860 861 862 863
    /* The physical section number is ORed with a page-aligned
     * pointer to produce the iotlb entries.  Thus it should
     * never overflow into the page-aligned value.
     */
864
    assert(map->sections_nb < TARGET_PAGE_SIZE);
865

866 867 868 869
    if (map->sections_nb == map->sections_nb_alloc) {
        map->sections_nb_alloc = MAX(map->sections_nb_alloc * 2, 16);
        map->sections = g_renew(MemoryRegionSection, map->sections,
                                map->sections_nb_alloc);
870
    }
871
    map->sections[map->sections_nb] = *section;
P
Paolo Bonzini 已提交
872
    memory_region_ref(section->mr);
873
    return map->sections_nb++;
874 875
}

876 877
static void phys_section_destroy(MemoryRegion *mr)
{
P
Paolo Bonzini 已提交
878 879
    memory_region_unref(mr);

880 881 882 883 884 885 886
    if (mr->subpage) {
        subpage_t *subpage = container_of(mr, subpage_t, iomem);
        memory_region_destroy(&subpage->iomem);
        g_free(subpage);
    }
}

P
Paolo Bonzini 已提交
887
static void phys_sections_free(PhysPageMap *map)
888
{
889 890
    while (map->sections_nb > 0) {
        MemoryRegionSection *section = &map->sections[--map->sections_nb];
891 892
        phys_section_destroy(section->mr);
    }
893 894
    g_free(map->sections);
    g_free(map->nodes);
895 896
}

A
Avi Kivity 已提交
897
static void register_subpage(AddressSpaceDispatch *d, MemoryRegionSection *section)
898 899
{
    subpage_t *subpage;
A
Avi Kivity 已提交
900
    hwaddr base = section->offset_within_address_space
901
        & TARGET_PAGE_MASK;
902
    MemoryRegionSection *existing = phys_page_find(d->phys_map, base,
903
                                                   d->map.nodes, d->map.sections);
904 905
    MemoryRegionSection subsection = {
        .offset_within_address_space = base,
906
        .size = int128_make64(TARGET_PAGE_SIZE),
907
    };
A
Avi Kivity 已提交
908
    hwaddr start, end;
909

910
    assert(existing->mr->subpage || existing->mr == &io_mem_unassigned);
911

912
    if (!(existing->mr->subpage)) {
913
        subpage = subpage_init(d->as, base);
914
        subsection.address_space = d->as;
915
        subsection.mr = &subpage->iomem;
A
Avi Kivity 已提交
916
        phys_page_set(d, base >> TARGET_PAGE_BITS, 1,
917
                      phys_section_add(&d->map, &subsection));
918
    } else {
919
        subpage = container_of(existing->mr, subpage_t, iomem);
920 921
    }
    start = section->offset_within_address_space & ~TARGET_PAGE_MASK;
922
    end = start + int128_get64(section->size) - 1;
923 924
    subpage_register(subpage, start, end,
                     phys_section_add(&d->map, section));
925 926 927
}


928 929
static void register_multipage(AddressSpaceDispatch *d,
                               MemoryRegionSection *section)
930
{
A
Avi Kivity 已提交
931
    hwaddr start_addr = section->offset_within_address_space;
932
    uint16_t section_index = phys_section_add(&d->map, section);
933 934
    uint64_t num_pages = int128_get64(int128_rshift(section->size,
                                                    TARGET_PAGE_BITS));
935

936 937
    assert(num_pages);
    phys_page_set(d, start_addr >> TARGET_PAGE_BITS, num_pages, section_index);
938 939
}

A
Avi Kivity 已提交
940
static void mem_add(MemoryListener *listener, MemoryRegionSection *section)
941
{
942
    AddressSpace *as = container_of(listener, AddressSpace, dispatch_listener);
943
    AddressSpaceDispatch *d = as->next_dispatch;
944
    MemoryRegionSection now = *section, remain = *section;
945
    Int128 page_size = int128_make64(TARGET_PAGE_SIZE);
946

947 948 949 950
    if (now.offset_within_address_space & ~TARGET_PAGE_MASK) {
        uint64_t left = TARGET_PAGE_ALIGN(now.offset_within_address_space)
                       - now.offset_within_address_space;

951
        now.size = int128_min(int128_make64(left), now.size);
A
Avi Kivity 已提交
952
        register_subpage(d, &now);
953
    } else {
954
        now.size = int128_zero();
955
    }
956 957 958 959
    while (int128_ne(remain.size, now.size)) {
        remain.size = int128_sub(remain.size, now.size);
        remain.offset_within_address_space += int128_get64(now.size);
        remain.offset_within_region += int128_get64(now.size);
960
        now = remain;
961
        if (int128_lt(remain.size, page_size)) {
962
            register_subpage(d, &now);
963
        } else if (remain.offset_within_address_space & ~TARGET_PAGE_MASK) {
964
            now.size = page_size;
A
Avi Kivity 已提交
965
            register_subpage(d, &now);
966
        } else {
967
            now.size = int128_and(now.size, int128_neg(page_size));
A
Avi Kivity 已提交
968
            register_multipage(d, &now);
969
        }
970 971 972
    }
}

973 974 975 976 977 978
void qemu_flush_coalesced_mmio_buffer(void)
{
    if (kvm_enabled())
        kvm_flush_coalesced_mmio_buffer();
}

979 980 981 982 983 984 985 986 987 988
void qemu_mutex_lock_ramlist(void)
{
    qemu_mutex_lock(&ram_list.mutex);
}

void qemu_mutex_unlock_ramlist(void)
{
    qemu_mutex_unlock(&ram_list.mutex);
}

989
#ifdef __linux__
990 991 992 993 994 995 996 997 998 999 1000

#include <sys/vfs.h>

#define HUGETLBFS_MAGIC       0x958458f6

static long gethugepagesize(const char *path)
{
    struct statfs fs;
    int ret;

    do {
Y
Yoshiaki Tamura 已提交
1001
        ret = statfs(path, &fs);
1002 1003 1004
    } while (ret != 0 && errno == EINTR);

    if (ret != 0) {
Y
Yoshiaki Tamura 已提交
1005 1006
        perror(path);
        return 0;
1007 1008 1009
    }

    if (fs.f_type != HUGETLBFS_MAGIC)
Y
Yoshiaki Tamura 已提交
1010
        fprintf(stderr, "Warning: path not on HugeTLBFS: %s\n", path);
1011 1012 1013 1014

    return fs.f_bsize;
}

1015 1016 1017 1018 1019 1020 1021
static sigjmp_buf sigjump;

static void sigbus_handler(int signal)
{
    siglongjmp(sigjump, 1);
}

A
Alex Williamson 已提交
1022 1023 1024
static void *file_ram_alloc(RAMBlock *block,
                            ram_addr_t memory,
                            const char *path)
1025 1026
{
    char *filename;
1027 1028
    char *sanitized_name;
    char *c;
1029 1030 1031 1032 1033 1034
    void *area;
    int fd;
    unsigned long hpagesize;

    hpagesize = gethugepagesize(path);
    if (!hpagesize) {
1035
        goto error;
1036 1037 1038 1039 1040 1041 1042 1043
    }

    if (memory < hpagesize) {
        return NULL;
    }

    if (kvm_enabled() && !kvm_has_sync_mmu()) {
        fprintf(stderr, "host lacks kvm mmu notifiers, -mem-path unsupported\n");
1044
        goto error;
1045 1046
    }

1047 1048 1049 1050 1051 1052 1053 1054 1055 1056
    /* Make name safe to use with mkstemp by replacing '/' with '_'. */
    sanitized_name = g_strdup(block->mr->name);
    for (c = sanitized_name; *c != '\0'; c++) {
        if (*c == '/')
            *c = '_';
    }

    filename = g_strdup_printf("%s/qemu_back_mem.%s.XXXXXX", path,
                               sanitized_name);
    g_free(sanitized_name);
1057 1058 1059

    fd = mkstemp(filename);
    if (fd < 0) {
Y
Yoshiaki Tamura 已提交
1060
        perror("unable to create backing store for hugepages");
1061
        g_free(filename);
1062
        goto error;
1063 1064
    }
    unlink(filename);
1065
    g_free(filename);
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075

    memory = (memory+hpagesize-1) & ~(hpagesize-1);

    /*
     * ftruncate is not supported by hugetlbfs in older
     * hosts, so don't bother bailing out on errors.
     * If anything goes wrong with it under other filesystems,
     * mmap will fail.
     */
    if (ftruncate(fd, memory))
Y
Yoshiaki Tamura 已提交
1076
        perror("ftruncate");
1077 1078 1079

    area = mmap(0, memory, PROT_READ | PROT_WRITE, MAP_PRIVATE, fd, 0);
    if (area == MAP_FAILED) {
Y
Yoshiaki Tamura 已提交
1080 1081
        perror("file_ram_alloc: can't mmap RAM pages");
        close(fd);
1082
        goto error;
1083
    }
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110

    if (mem_prealloc) {
        int ret, i;
        struct sigaction act, oldact;
        sigset_t set, oldset;

        memset(&act, 0, sizeof(act));
        act.sa_handler = &sigbus_handler;
        act.sa_flags = 0;

        ret = sigaction(SIGBUS, &act, &oldact);
        if (ret) {
            perror("file_ram_alloc: failed to install signal handler");
            exit(1);
        }

        /* unblock SIGBUS */
        sigemptyset(&set);
        sigaddset(&set, SIGBUS);
        pthread_sigmask(SIG_UNBLOCK, &set, &oldset);

        if (sigsetjmp(sigjump, 1)) {
            fprintf(stderr, "file_ram_alloc: failed to preallocate pages\n");
            exit(1);
        }

        /* MAP_POPULATE silently ignores failures */
1111
        for (i = 0; i < (memory/hpagesize); i++) {
1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123
            memset(area + (hpagesize*i), 0, 1);
        }

        ret = sigaction(SIGBUS, &oldact, NULL);
        if (ret) {
            perror("file_ram_alloc: failed to reinstall signal handler");
            exit(1);
        }

        pthread_sigmask(SIG_SETMASK, &oldset, NULL);
    }

A
Alex Williamson 已提交
1124
    block->fd = fd;
1125
    return area;
1126 1127 1128 1129 1130 1131

error:
    if (mem_prealloc) {
        exit(1);
    }
    return NULL;
1132
}
1133 1134 1135 1136 1137 1138 1139 1140
#else
static void *file_ram_alloc(RAMBlock *block,
                            ram_addr_t memory,
                            const char *path)
{
    fprintf(stderr, "-mem-path not supported on this host\n");
    exit(1);
}
1141 1142
#endif

1143
static ram_addr_t find_ram_offset(ram_addr_t size)
A
Alex Williamson 已提交
1144 1145
{
    RAMBlock *block, *next_block;
A
Alex Williamson 已提交
1146
    ram_addr_t offset = RAM_ADDR_MAX, mingap = RAM_ADDR_MAX;
A
Alex Williamson 已提交
1147

1148 1149
    assert(size != 0); /* it would hand out same offset multiple times */

P
Paolo Bonzini 已提交
1150
    if (QTAILQ_EMPTY(&ram_list.blocks))
A
Alex Williamson 已提交
1151 1152
        return 0;

P
Paolo Bonzini 已提交
1153
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
1154
        ram_addr_t end, next = RAM_ADDR_MAX;
A
Alex Williamson 已提交
1155 1156 1157

        end = block->offset + block->length;

P
Paolo Bonzini 已提交
1158
        QTAILQ_FOREACH(next_block, &ram_list.blocks, next) {
A
Alex Williamson 已提交
1159 1160 1161 1162 1163
            if (next_block->offset >= end) {
                next = MIN(next, next_block->offset);
            }
        }
        if (next - end >= size && next - end < mingap) {
A
Alex Williamson 已提交
1164
            offset = end;
A
Alex Williamson 已提交
1165 1166 1167
            mingap = next - end;
        }
    }
A
Alex Williamson 已提交
1168 1169 1170 1171 1172 1173 1174

    if (offset == RAM_ADDR_MAX) {
        fprintf(stderr, "Failed to find gap of requested size: %" PRIu64 "\n",
                (uint64_t)size);
        abort();
    }

A
Alex Williamson 已提交
1175 1176 1177
    return offset;
}

J
Juan Quintela 已提交
1178
ram_addr_t last_ram_offset(void)
1179 1180 1181 1182
{
    RAMBlock *block;
    ram_addr_t last = 0;

P
Paolo Bonzini 已提交
1183
    QTAILQ_FOREACH(block, &ram_list.blocks, next)
1184 1185 1186 1187 1188
        last = MAX(last, block->offset + block->length);

    return last;
}

1189 1190 1191 1192 1193
static void qemu_ram_setup_dump(void *addr, ram_addr_t size)
{
    int ret;

    /* Use MADV_DONTDUMP, if user doesn't want the guest memory in the core */
1194 1195
    if (!qemu_opt_get_bool(qemu_get_machine_opts(),
                           "dump-guest-core", true)) {
1196 1197 1198 1199 1200 1201 1202 1203 1204
        ret = qemu_madvise(addr, size, QEMU_MADV_DONTDUMP);
        if (ret) {
            perror("qemu_madvise");
            fprintf(stderr, "madvise doesn't support MADV_DONTDUMP, "
                            "but dump_guest_core=off specified\n");
        }
    }
}

1205
void qemu_ram_set_idstr(ram_addr_t addr, const char *name, DeviceState *dev)
1206 1207 1208
{
    RAMBlock *new_block, *block;

1209
    new_block = NULL;
P
Paolo Bonzini 已提交
1210
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
1211 1212 1213 1214 1215 1216 1217
        if (block->offset == addr) {
            new_block = block;
            break;
        }
    }
    assert(new_block);
    assert(!new_block->idstr[0]);
1218

1219 1220
    if (dev) {
        char *id = qdev_get_dev_path(dev);
1221 1222
        if (id) {
            snprintf(new_block->idstr, sizeof(new_block->idstr), "%s/", id);
1223
            g_free(id);
1224 1225 1226 1227
        }
    }
    pstrcat(new_block->idstr, sizeof(new_block->idstr), name);

1228 1229
    /* This assumes the iothread lock is taken here too.  */
    qemu_mutex_lock_ramlist();
P
Paolo Bonzini 已提交
1230
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
1231
        if (block != new_block && !strcmp(block->idstr, new_block->idstr)) {
1232 1233 1234 1235 1236
            fprintf(stderr, "RAMBlock \"%s\" already registered, abort!\n",
                    new_block->idstr);
            abort();
        }
    }
1237
    qemu_mutex_unlock_ramlist();
1238 1239
}

1240 1241
static int memory_try_enable_merging(void *addr, size_t len)
{
1242
    if (!qemu_opt_get_bool(qemu_get_machine_opts(), "mem-merge", true)) {
1243 1244 1245 1246 1247 1248 1249
        /* disabled by the user */
        return 0;
    }

    return qemu_madvise(addr, len, QEMU_MADV_MERGEABLE);
}

1250 1251 1252
ram_addr_t qemu_ram_alloc_from_ptr(ram_addr_t size, void *host,
                                   MemoryRegion *mr)
{
1253
    RAMBlock *block, *new_block;
1254 1255 1256
    ram_addr_t old_ram_size, new_ram_size;

    old_ram_size = last_ram_offset() >> TARGET_PAGE_BITS;
1257 1258 1259

    size = TARGET_PAGE_ALIGN(size);
    new_block = g_malloc0(sizeof(*new_block));
1260
    new_block->fd = -1;
1261

1262 1263
    /* This assumes the iothread lock is taken here too.  */
    qemu_mutex_lock_ramlist();
A
Avi Kivity 已提交
1264
    new_block->mr = mr;
J
Jun Nakajima 已提交
1265
    new_block->offset = find_ram_offset(size);
1266 1267
    if (host) {
        new_block->host = host;
H
Huang Ying 已提交
1268
        new_block->flags |= RAM_PREALLOC_MASK;
1269 1270 1271 1272 1273 1274
    } else if (xen_enabled()) {
        if (mem_path) {
            fprintf(stderr, "-mem-path not supported with Xen\n");
            exit(1);
        }
        xen_ram_alloc(new_block->offset, size, mr);
1275 1276
    } else {
        if (mem_path) {
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286
            if (phys_mem_alloc != qemu_anon_ram_alloc) {
                /*
                 * file_ram_alloc() needs to allocate just like
                 * phys_mem_alloc, but we haven't bothered to provide
                 * a hook there.
                 */
                fprintf(stderr,
                        "-mem-path not supported with this accelerator\n");
                exit(1);
            }
1287
            new_block->host = file_ram_alloc(new_block, size, mem_path);
1288 1289
        }
        if (!new_block->host) {
1290
            new_block->host = phys_mem_alloc(size);
1291 1292 1293 1294 1295
            if (!new_block->host) {
                fprintf(stderr, "Cannot set up guest memory '%s': %s\n",
                        new_block->mr->name, strerror(errno));
                exit(1);
            }
1296
            memory_try_enable_merging(new_block->host, size);
1297
        }
1298
    }
P
pbrook 已提交
1299 1300
    new_block->length = size;

1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
    /* Keep the list sorted from biggest to smallest block.  */
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
        if (block->length < new_block->length) {
            break;
        }
    }
    if (block) {
        QTAILQ_INSERT_BEFORE(block, new_block, next);
    } else {
        QTAILQ_INSERT_TAIL(&ram_list.blocks, new_block, next);
    }
1312
    ram_list.mru_block = NULL;
P
pbrook 已提交
1313

U
Umesh Deshpande 已提交
1314
    ram_list.version++;
1315
    qemu_mutex_unlock_ramlist();
U
Umesh Deshpande 已提交
1316

1317 1318 1319
    new_ram_size = last_ram_offset() >> TARGET_PAGE_BITS;

    if (new_ram_size > old_ram_size) {
1320 1321 1322 1323 1324 1325
        int i;
        for (i = 0; i < DIRTY_MEMORY_NUM; i++) {
            ram_list.dirty_memory[i] =
                bitmap_zero_extend(ram_list.dirty_memory[i],
                                   old_ram_size, new_ram_size);
       }
1326
    }
1327
    cpu_physical_memory_set_dirty_range(new_block->offset, size);
P
pbrook 已提交
1328

1329
    qemu_ram_setup_dump(new_block->host, size);
1330
    qemu_madvise(new_block->host, size, QEMU_MADV_HUGEPAGE);
1331
    qemu_madvise(new_block->host, size, QEMU_MADV_DONTFORK);
1332

1333 1334 1335
    if (kvm_enabled())
        kvm_setup_guest_memory(new_block->host, size);

P
pbrook 已提交
1336 1337
    return new_block->offset;
}
B
bellard 已提交
1338

1339
ram_addr_t qemu_ram_alloc(ram_addr_t size, MemoryRegion *mr)
1340
{
1341
    return qemu_ram_alloc_from_ptr(size, NULL, mr);
1342 1343
}

1344 1345 1346 1347
void qemu_ram_free_from_ptr(ram_addr_t addr)
{
    RAMBlock *block;

1348 1349
    /* This assumes the iothread lock is taken here too.  */
    qemu_mutex_lock_ramlist();
P
Paolo Bonzini 已提交
1350
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
1351
        if (addr == block->offset) {
P
Paolo Bonzini 已提交
1352
            QTAILQ_REMOVE(&ram_list.blocks, block, next);
1353
            ram_list.mru_block = NULL;
U
Umesh Deshpande 已提交
1354
            ram_list.version++;
1355
            g_free(block);
1356
            break;
1357 1358
        }
    }
1359
    qemu_mutex_unlock_ramlist();
1360 1361
}

A
Anthony Liguori 已提交
1362
void qemu_ram_free(ram_addr_t addr)
B
bellard 已提交
1363
{
A
Alex Williamson 已提交
1364 1365
    RAMBlock *block;

1366 1367
    /* This assumes the iothread lock is taken here too.  */
    qemu_mutex_lock_ramlist();
P
Paolo Bonzini 已提交
1368
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
A
Alex Williamson 已提交
1369
        if (addr == block->offset) {
P
Paolo Bonzini 已提交
1370
            QTAILQ_REMOVE(&ram_list.blocks, block, next);
1371
            ram_list.mru_block = NULL;
U
Umesh Deshpande 已提交
1372
            ram_list.version++;
H
Huang Ying 已提交
1373 1374
            if (block->flags & RAM_PREALLOC_MASK) {
                ;
1375 1376
            } else if (xen_enabled()) {
                xen_invalidate_map_cache_entry(block->host);
1377
#ifndef _WIN32
1378 1379 1380
            } else if (block->fd >= 0) {
                munmap(block->host, block->length);
                close(block->fd);
1381
#endif
A
Alex Williamson 已提交
1382
            } else {
1383
                qemu_anon_ram_free(block->host, block->length);
A
Alex Williamson 已提交
1384
            }
1385
            g_free(block);
1386
            break;
A
Alex Williamson 已提交
1387 1388
        }
    }
1389
    qemu_mutex_unlock_ramlist();
A
Alex Williamson 已提交
1390

B
bellard 已提交
1391 1392
}

H
Huang Ying 已提交
1393 1394 1395 1396 1397 1398 1399 1400
#ifndef _WIN32
void qemu_ram_remap(ram_addr_t addr, ram_addr_t length)
{
    RAMBlock *block;
    ram_addr_t offset;
    int flags;
    void *area, *vaddr;

P
Paolo Bonzini 已提交
1401
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
H
Huang Ying 已提交
1402 1403 1404 1405 1406
        offset = addr - block->offset;
        if (offset < block->length) {
            vaddr = block->host + offset;
            if (block->flags & RAM_PREALLOC_MASK) {
                ;
1407 1408
            } else if (xen_enabled()) {
                abort();
H
Huang Ying 已提交
1409 1410 1411
            } else {
                flags = MAP_FIXED;
                munmap(vaddr, length);
1412
                if (block->fd >= 0) {
H
Huang Ying 已提交
1413
#ifdef MAP_POPULATE
1414 1415
                    flags |= mem_prealloc ? MAP_POPULATE | MAP_SHARED :
                        MAP_PRIVATE;
1416
#else
1417
                    flags |= MAP_PRIVATE;
H
Huang Ying 已提交
1418
#endif
1419 1420
                    area = mmap(vaddr, length, PROT_READ | PROT_WRITE,
                                flags, block->fd, offset);
H
Huang Ying 已提交
1421
                } else {
1422 1423 1424 1425 1426 1427 1428
                    /*
                     * Remap needs to match alloc.  Accelerators that
                     * set phys_mem_alloc never remap.  If they did,
                     * we'd need a remap hook here.
                     */
                    assert(phys_mem_alloc == qemu_anon_ram_alloc);

H
Huang Ying 已提交
1429 1430 1431 1432 1433
                    flags |= MAP_PRIVATE | MAP_ANONYMOUS;
                    area = mmap(vaddr, length, PROT_READ | PROT_WRITE,
                                flags, -1, 0);
                }
                if (area != vaddr) {
1434 1435
                    fprintf(stderr, "Could not remap addr: "
                            RAM_ADDR_FMT "@" RAM_ADDR_FMT "\n",
H
Huang Ying 已提交
1436 1437 1438
                            length, addr);
                    exit(1);
                }
1439
                memory_try_enable_merging(vaddr, length);
1440
                qemu_ram_setup_dump(vaddr, length);
H
Huang Ying 已提交
1441 1442 1443 1444 1445 1446 1447
            }
            return;
        }
    }
}
#endif /* !_WIN32 */

1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459
/* Return a host pointer to ram allocated with qemu_ram_alloc.
   With the exception of the softmmu code in this file, this should
   only be used for local memory (e.g. video ram) that the device owns,
   and knows it isn't going to access beyond the end of the block.

   It should not be used for general purpose DMA.
   Use cpu_physical_memory_map/cpu_physical_memory_rw instead.
 */
void *qemu_get_ram_ptr(ram_addr_t addr)
{
    RAMBlock *block = qemu_get_ram_block(addr);

1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472
    if (xen_enabled()) {
        /* We need to check if the requested address is in the RAM
         * because we don't want to map the entire memory in QEMU.
         * In that case just map until the end of the page.
         */
        if (block->offset == 0) {
            return xen_map_cache(addr, 0, 0);
        } else if (block->host == NULL) {
            block->host =
                xen_map_cache(block->offset, block->length, 1);
        }
    }
    return block->host + (addr - block->offset);
1473 1474
}

1475 1476
/* Return a host pointer to guest's ram. Similar to qemu_get_ram_ptr
 * but takes a size argument */
1477
static void *qemu_ram_ptr_length(ram_addr_t addr, hwaddr *size)
1478
{
1479 1480 1481
    if (*size == 0) {
        return NULL;
    }
1482
    if (xen_enabled()) {
J
Jan Kiszka 已提交
1483
        return xen_map_cache(addr, *size, 1);
1484
    } else {
1485 1486
        RAMBlock *block;

P
Paolo Bonzini 已提交
1487
        QTAILQ_FOREACH(block, &ram_list.blocks, next) {
1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499
            if (addr - block->offset < block->length) {
                if (addr - block->offset + *size > block->length)
                    *size = block->length - addr + block->offset;
                return block->host + (addr - block->offset);
            }
        }

        fprintf(stderr, "Bad ram offset %" PRIx64 "\n", (uint64_t)addr);
        abort();
    }
}

1500 1501
/* Some of the softmmu routines need to translate from a host pointer
   (typically a TLB entry) back to a ram offset.  */
1502
MemoryRegion *qemu_ram_addr_from_host(void *ptr, ram_addr_t *ram_addr)
P
pbrook 已提交
1503
{
P
pbrook 已提交
1504 1505 1506
    RAMBlock *block;
    uint8_t *host = ptr;

1507
    if (xen_enabled()) {
J
Jan Kiszka 已提交
1508
        *ram_addr = xen_ram_addr_from_mapcache(ptr);
1509
        return qemu_get_ram_block(*ram_addr)->mr;
1510 1511
    }

1512 1513 1514 1515 1516
    block = ram_list.mru_block;
    if (block && block->host && host - block->host < block->length) {
        goto found;
    }

P
Paolo Bonzini 已提交
1517
    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
J
Jun Nakajima 已提交
1518 1519 1520 1521
        /* This case append when the block is not mapped. */
        if (block->host == NULL) {
            continue;
        }
A
Alex Williamson 已提交
1522
        if (host - block->host < block->length) {
1523
            goto found;
A
Alex Williamson 已提交
1524
        }
P
pbrook 已提交
1525
    }
J
Jun Nakajima 已提交
1526

1527
    return NULL;
1528 1529 1530

found:
    *ram_addr = block->offset + (host - block->host);
1531
    return block->mr;
M
Marcelo Tosatti 已提交
1532
}
A
Alex Williamson 已提交
1533

A
Avi Kivity 已提交
1534
static void notdirty_mem_write(void *opaque, hwaddr ram_addr,
1535
                               uint64_t val, unsigned size)
1536
{
1537
    if (!cpu_physical_memory_get_dirty_flag(ram_addr, DIRTY_MEMORY_CODE)) {
1538
        tb_invalidate_phys_page_fast(ram_addr, size);
1539
    }
1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551
    switch (size) {
    case 1:
        stb_p(qemu_get_ram_ptr(ram_addr), val);
        break;
    case 2:
        stw_p(qemu_get_ram_ptr(ram_addr), val);
        break;
    case 4:
        stl_p(qemu_get_ram_ptr(ram_addr), val);
        break;
    default:
        abort();
1552
    }
1553 1554
    cpu_physical_memory_set_dirty_flag(ram_addr, DIRTY_MEMORY_MIGRATION);
    cpu_physical_memory_set_dirty_flag(ram_addr, DIRTY_MEMORY_VGA);
B
bellard 已提交
1555 1556
    /* we remove the notdirty callback only if the code has been
       flushed */
1557
    if (!cpu_physical_memory_is_clean(ram_addr)) {
1558
        CPUArchState *env = current_cpu->env_ptr;
1559
        tlb_set_dirty(env, current_cpu->mem_io_vaddr);
1560
    }
1561 1562
}

1563 1564 1565 1566 1567 1568
static bool notdirty_mem_accepts(void *opaque, hwaddr addr,
                                 unsigned size, bool is_write)
{
    return is_write;
}

1569 1570
static const MemoryRegionOps notdirty_mem_ops = {
    .write = notdirty_mem_write,
1571
    .valid.accepts = notdirty_mem_accepts,
1572
    .endianness = DEVICE_NATIVE_ENDIAN,
1573 1574
};

P
pbrook 已提交
1575
/* Generate a debug exception if a watchpoint has been hit.  */
1576
static void check_watchpoint(int offset, int len_mask, int flags)
P
pbrook 已提交
1577
{
1578 1579
    CPUState *cpu = current_cpu;
    CPUArchState *env = cpu->env_ptr;
1580
    target_ulong pc, cs_base;
P
pbrook 已提交
1581
    target_ulong vaddr;
1582
    CPUWatchpoint *wp;
1583
    int cpu_flags;
P
pbrook 已提交
1584

1585
    if (cpu->watchpoint_hit) {
1586 1587 1588
        /* We re-entered the check after replacing the TB. Now raise
         * the debug interrupt so that is will trigger after the
         * current instruction. */
1589
        cpu_interrupt(cpu, CPU_INTERRUPT_DEBUG);
1590 1591
        return;
    }
1592
    vaddr = (cpu->mem_io_vaddr & TARGET_PAGE_MASK) + offset;
1593
    QTAILQ_FOREACH(wp, &cpu->watchpoints, entry) {
1594 1595
        if ((vaddr == (wp->vaddr & len_mask) ||
             (vaddr & wp->len_mask) == wp->vaddr) && (wp->flags & flags)) {
1596
            wp->flags |= BP_WATCHPOINT_HIT;
1597 1598
            if (!cpu->watchpoint_hit) {
                cpu->watchpoint_hit = wp;
1599
                tb_check_watchpoint(cpu);
1600
                if (wp->flags & BP_STOP_BEFORE_ACCESS) {
1601
                    cpu->exception_index = EXCP_DEBUG;
1602
                    cpu_loop_exit(cpu);
1603 1604
                } else {
                    cpu_get_tb_cpu_state(env, &pc, &cs_base, &cpu_flags);
1605
                    tb_gen_code(cpu, pc, cs_base, cpu_flags, 1);
1606
                    cpu_resume_from_signal(cpu, NULL);
1607
                }
1608
            }
1609 1610
        } else {
            wp->flags &= ~BP_WATCHPOINT_HIT;
P
pbrook 已提交
1611 1612 1613 1614
        }
    }
}

1615 1616 1617
/* Watchpoint access routines.  Watchpoints are inserted using TLB tricks,
   so these check for a hit then pass through to the normal out-of-line
   phys routines.  */
A
Avi Kivity 已提交
1618
static uint64_t watch_mem_read(void *opaque, hwaddr addr,
1619
                               unsigned size)
1620
{
1621 1622
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~(size - 1), BP_MEM_READ);
    switch (size) {
1623
    case 1: return ldub_phys(&address_space_memory, addr);
1624
    case 2: return lduw_phys(&address_space_memory, addr);
1625
    case 4: return ldl_phys(&address_space_memory, addr);
1626 1627
    default: abort();
    }
1628 1629
}

A
Avi Kivity 已提交
1630
static void watch_mem_write(void *opaque, hwaddr addr,
1631
                            uint64_t val, unsigned size)
1632
{
1633 1634
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~(size - 1), BP_MEM_WRITE);
    switch (size) {
1635
    case 1:
1636
        stb_phys(&address_space_memory, addr, val);
1637 1638
        break;
    case 2:
1639
        stw_phys(&address_space_memory, addr, val);
1640 1641
        break;
    case 4:
1642
        stl_phys(&address_space_memory, addr, val);
1643
        break;
1644 1645
    default: abort();
    }
1646 1647
}

1648 1649 1650 1651
static const MemoryRegionOps watch_mem_ops = {
    .read = watch_mem_read,
    .write = watch_mem_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
1652 1653
};

A
Avi Kivity 已提交
1654
static uint64_t subpage_read(void *opaque, hwaddr addr,
1655
                             unsigned len)
1656
{
1657 1658
    subpage_t *subpage = opaque;
    uint8_t buf[4];
1659

1660
#if defined(DEBUG_SUBPAGE)
A
Amos Kong 已提交
1661
    printf("%s: subpage %p len %u addr " TARGET_FMT_plx "\n", __func__,
1662
           subpage, len, addr);
1663
#endif
1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674
    address_space_read(subpage->as, addr + subpage->base, buf, len);
    switch (len) {
    case 1:
        return ldub_p(buf);
    case 2:
        return lduw_p(buf);
    case 4:
        return ldl_p(buf);
    default:
        abort();
    }
1675 1676
}

A
Avi Kivity 已提交
1677
static void subpage_write(void *opaque, hwaddr addr,
1678
                          uint64_t value, unsigned len)
1679
{
1680 1681 1682
    subpage_t *subpage = opaque;
    uint8_t buf[4];

1683
#if defined(DEBUG_SUBPAGE)
A
Amos Kong 已提交
1684
    printf("%s: subpage %p len %u addr " TARGET_FMT_plx
1685 1686
           " value %"PRIx64"\n",
           __func__, subpage, len, addr, value);
1687
#endif
1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701
    switch (len) {
    case 1:
        stb_p(buf, value);
        break;
    case 2:
        stw_p(buf, value);
        break;
    case 4:
        stl_p(buf, value);
        break;
    default:
        abort();
    }
    address_space_write(subpage->as, addr + subpage->base, buf, len);
1702 1703
}

1704
static bool subpage_accepts(void *opaque, hwaddr addr,
A
Amos Kong 已提交
1705
                            unsigned len, bool is_write)
1706
{
1707
    subpage_t *subpage = opaque;
1708
#if defined(DEBUG_SUBPAGE)
A
Amos Kong 已提交
1709
    printf("%s: subpage %p %c len %u addr " TARGET_FMT_plx "\n",
1710
           __func__, subpage, is_write ? 'w' : 'r', len, addr);
1711 1712
#endif

1713
    return address_space_access_valid(subpage->as, addr + subpage->base,
A
Amos Kong 已提交
1714
                                      len, is_write);
1715 1716
}

1717 1718 1719
static const MemoryRegionOps subpage_ops = {
    .read = subpage_read,
    .write = subpage_write,
1720
    .valid.accepts = subpage_accepts,
1721
    .endianness = DEVICE_NATIVE_ENDIAN,
1722 1723
};

A
Anthony Liguori 已提交
1724
static int subpage_register (subpage_t *mmio, uint32_t start, uint32_t end,
1725
                             uint16_t section)
1726 1727 1728 1729 1730 1731 1732 1733
{
    int idx, eidx;

    if (start >= TARGET_PAGE_SIZE || end >= TARGET_PAGE_SIZE)
        return -1;
    idx = SUBPAGE_IDX(start);
    eidx = SUBPAGE_IDX(end);
#if defined(DEBUG_SUBPAGE)
A
Amos Kong 已提交
1734 1735
    printf("%s: %p start %08x end %08x idx %08x eidx %08x section %d\n",
           __func__, mmio, start, end, idx, eidx, section);
1736 1737
#endif
    for (; idx <= eidx; idx++) {
1738
        mmio->sub_section[idx] = section;
1739 1740 1741 1742 1743
    }

    return 0;
}

1744
static subpage_t *subpage_init(AddressSpace *as, hwaddr base)
1745
{
A
Anthony Liguori 已提交
1746
    subpage_t *mmio;
1747

1748
    mmio = g_malloc0(sizeof(subpage_t));
1749

1750
    mmio->as = as;
1751
    mmio->base = base;
1752
    memory_region_init_io(&mmio->iomem, NULL, &subpage_ops, mmio,
1753
                          "subpage", TARGET_PAGE_SIZE);
A
Avi Kivity 已提交
1754
    mmio->iomem.subpage = true;
1755
#if defined(DEBUG_SUBPAGE)
A
Amos Kong 已提交
1756 1757
    printf("%s: %p base " TARGET_FMT_plx " len %08x\n", __func__,
           mmio, base, TARGET_PAGE_SIZE);
1758
#endif
1759
    subpage_register(mmio, 0, TARGET_PAGE_SIZE-1, PHYS_SECTION_UNASSIGNED);
1760 1761 1762 1763

    return mmio;
}

1764
static uint16_t dummy_section(PhysPageMap *map, MemoryRegion *mr)
1765 1766
{
    MemoryRegionSection section = {
1767
        .address_space = &address_space_memory,
1768 1769 1770
        .mr = mr,
        .offset_within_address_space = 0,
        .offset_within_region = 0,
1771
        .size = int128_2_64(),
1772 1773
    };

1774
    return phys_section_add(map, &section);
1775 1776
}

1777
MemoryRegion *iotlb_to_region(AddressSpace *as, hwaddr index)
1778
{
1779
    return as->dispatch->map.sections[index & ~TARGET_PAGE_MASK].mr;
1780 1781
}

A
Avi Kivity 已提交
1782 1783
static void io_mem_init(void)
{
1784 1785
    memory_region_init_io(&io_mem_rom, NULL, &unassigned_mem_ops, NULL, "rom", UINT64_MAX);
    memory_region_init_io(&io_mem_unassigned, NULL, &unassigned_mem_ops, NULL,
1786
                          "unassigned", UINT64_MAX);
1787
    memory_region_init_io(&io_mem_notdirty, NULL, &notdirty_mem_ops, NULL,
1788
                          "notdirty", UINT64_MAX);
1789
    memory_region_init_io(&io_mem_watch, NULL, &watch_mem_ops, NULL,
1790
                          "watch", UINT64_MAX);
A
Avi Kivity 已提交
1791 1792
}

A
Avi Kivity 已提交
1793
static void mem_begin(MemoryListener *listener)
1794 1795
{
    AddressSpace *as = container_of(listener, AddressSpace, dispatch_listener);
1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806
    AddressSpaceDispatch *d = g_new0(AddressSpaceDispatch, 1);
    uint16_t n;

    n = dummy_section(&d->map, &io_mem_unassigned);
    assert(n == PHYS_SECTION_UNASSIGNED);
    n = dummy_section(&d->map, &io_mem_notdirty);
    assert(n == PHYS_SECTION_NOTDIRTY);
    n = dummy_section(&d->map, &io_mem_rom);
    assert(n == PHYS_SECTION_ROM);
    n = dummy_section(&d->map, &io_mem_watch);
    assert(n == PHYS_SECTION_WATCH);
1807

M
Michael S. Tsirkin 已提交
1808
    d->phys_map  = (PhysPageEntry) { .ptr = PHYS_MAP_NODE_NIL, .skip = 1 };
1809 1810 1811 1812 1813
    d->as = as;
    as->next_dispatch = d;
}

static void mem_commit(MemoryListener *listener)
A
Avi Kivity 已提交
1814
{
1815
    AddressSpace *as = container_of(listener, AddressSpace, dispatch_listener);
1816 1817 1818
    AddressSpaceDispatch *cur = as->dispatch;
    AddressSpaceDispatch *next = as->next_dispatch;

1819
    phys_page_compact_all(next, next->map.nodes_nb);
1820

1821
    as->dispatch = next;
1822

1823 1824 1825 1826
    if (cur) {
        phys_sections_free(&cur->map);
        g_free(cur);
    }
1827 1828
}

1829
static void tcg_commit(MemoryListener *listener)
1830
{
1831
    CPUState *cpu;
1832 1833 1834 1835

    /* since each CPU stores ram addresses in its TLB cache, we must
       reset the modified entries */
    /* XXX: slow ! */
A
Andreas Färber 已提交
1836
    CPU_FOREACH(cpu) {
1837 1838
        CPUArchState *env = cpu->env_ptr;

1839 1840 1841 1842 1843
        /* FIXME: Disentangle the cpu.h circular files deps so we can
           directly get the right CPU from listener.  */
        if (cpu->tcg_as_listener != listener) {
            continue;
        }
1844 1845
        tlb_flush(env, 1);
    }
1846 1847
}

1848 1849
static void core_log_global_start(MemoryListener *listener)
{
1850
    cpu_physical_memory_set_dirty_tracking(true);
1851 1852 1853 1854
}

static void core_log_global_stop(MemoryListener *listener)
{
1855
    cpu_physical_memory_set_dirty_tracking(false);
1856 1857 1858 1859 1860
}

static MemoryListener core_memory_listener = {
    .log_global_start = core_log_global_start,
    .log_global_stop = core_log_global_stop,
A
Avi Kivity 已提交
1861
    .priority = 1,
1862 1863
};

A
Avi Kivity 已提交
1864 1865
void address_space_init_dispatch(AddressSpace *as)
{
1866
    as->dispatch = NULL;
1867
    as->dispatch_listener = (MemoryListener) {
A
Avi Kivity 已提交
1868
        .begin = mem_begin,
1869
        .commit = mem_commit,
A
Avi Kivity 已提交
1870 1871 1872 1873
        .region_add = mem_add,
        .region_nop = mem_add,
        .priority = 0,
    };
1874
    memory_listener_register(&as->dispatch_listener, as);
A
Avi Kivity 已提交
1875 1876
}

A
Avi Kivity 已提交
1877 1878 1879 1880
void address_space_destroy_dispatch(AddressSpace *as)
{
    AddressSpaceDispatch *d = as->dispatch;

1881
    memory_listener_unregister(&as->dispatch_listener);
A
Avi Kivity 已提交
1882 1883 1884 1885
    g_free(d);
    as->dispatch = NULL;
}

A
Avi Kivity 已提交
1886 1887
static void memory_map_init(void)
{
1888
    system_memory = g_malloc(sizeof(*system_memory));
1889

1890
    memory_region_init(system_memory, NULL, "system", UINT64_MAX);
1891
    address_space_init(&address_space_memory, system_memory, "memory");
1892

1893
    system_io = g_malloc(sizeof(*system_io));
1894 1895
    memory_region_init_io(system_io, NULL, &unassigned_io_ops, NULL, "io",
                          65536);
1896
    address_space_init(&address_space_io, system_io, "I/O");
1897

1898
    memory_listener_register(&core_memory_listener, &address_space_memory);
A
Avi Kivity 已提交
1899 1900 1901 1902 1903 1904 1905
}

MemoryRegion *get_system_memory(void)
{
    return system_memory;
}

1906 1907 1908 1909 1910
MemoryRegion *get_system_io(void)
{
    return system_io;
}

1911 1912
#endif /* !defined(CONFIG_USER_ONLY) */

B
bellard 已提交
1913 1914
/* physical memory access (slow version, mainly for debug) */
#if defined(CONFIG_USER_ONLY)
1915
int cpu_memory_rw_debug(CPUState *cpu, target_ulong addr,
P
Paul Brook 已提交
1916
                        uint8_t *buf, int len, int is_write)
B
bellard 已提交
1917 1918 1919
{
    int l, flags;
    target_ulong page;
1920
    void * p;
B
bellard 已提交
1921 1922 1923 1924 1925 1926 1927 1928

    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
        l = (page + TARGET_PAGE_SIZE) - addr;
        if (l > len)
            l = len;
        flags = page_get_flags(page);
        if (!(flags & PAGE_VALID))
P
Paul Brook 已提交
1929
            return -1;
B
bellard 已提交
1930 1931
        if (is_write) {
            if (!(flags & PAGE_WRITE))
P
Paul Brook 已提交
1932
                return -1;
1933
            /* XXX: this code should not depend on lock_user */
A
aurel32 已提交
1934
            if (!(p = lock_user(VERIFY_WRITE, addr, l, 0)))
P
Paul Brook 已提交
1935
                return -1;
A
aurel32 已提交
1936 1937
            memcpy(p, buf, l);
            unlock_user(p, addr, l);
B
bellard 已提交
1938 1939
        } else {
            if (!(flags & PAGE_READ))
P
Paul Brook 已提交
1940
                return -1;
1941
            /* XXX: this code should not depend on lock_user */
A
aurel32 已提交
1942
            if (!(p = lock_user(VERIFY_READ, addr, l, 1)))
P
Paul Brook 已提交
1943
                return -1;
A
aurel32 已提交
1944
            memcpy(buf, p, l);
A
aurel32 已提交
1945
            unlock_user(p, addr, 0);
B
bellard 已提交
1946 1947 1948 1949 1950
        }
        len -= l;
        buf += l;
        addr += l;
    }
P
Paul Brook 已提交
1951
    return 0;
B
bellard 已提交
1952
}
B
bellard 已提交
1953

B
bellard 已提交
1954
#else
1955

A
Avi Kivity 已提交
1956 1957
static void invalidate_and_set_dirty(hwaddr addr,
                                     hwaddr length)
1958
{
1959
    if (cpu_physical_memory_is_clean(addr)) {
1960 1961 1962
        /* invalidate code */
        tb_invalidate_phys_page_range(addr, addr + length, 0);
        /* set dirty bit */
1963 1964
        cpu_physical_memory_set_dirty_flag(addr, DIRTY_MEMORY_VGA);
        cpu_physical_memory_set_dirty_flag(addr, DIRTY_MEMORY_MIGRATION);
1965
    }
1966
    xen_modified_memory(addr, length);
1967 1968
}

1969
static int memory_access_size(MemoryRegion *mr, unsigned l, hwaddr addr)
1970
{
1971
    unsigned access_size_max = mr->ops->valid.max_access_size;
1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984

    /* Regions are assumed to support 1-4 byte accesses unless
       otherwise specified.  */
    if (access_size_max == 0) {
        access_size_max = 4;
    }

    /* Bound the maximum access by the alignment of the address.  */
    if (!mr->ops->impl.unaligned) {
        unsigned align_size_max = addr & -addr;
        if (align_size_max != 0 && align_size_max < access_size_max) {
            access_size_max = align_size_max;
        }
1985
    }
1986 1987 1988 1989

    /* Don't attempt accesses larger than the maximum.  */
    if (l > access_size_max) {
        l = access_size_max;
1990
    }
1991 1992 1993
    if (l & (l - 1)) {
        l = 1 << (qemu_fls(l) - 1);
    }
1994 1995

    return l;
1996 1997
}

1998
bool address_space_rw(AddressSpace *as, hwaddr addr, uint8_t *buf,
A
Avi Kivity 已提交
1999
                      int len, bool is_write)
B
bellard 已提交
2000
{
2001
    hwaddr l;
B
bellard 已提交
2002
    uint8_t *ptr;
2003
    uint64_t val;
2004
    hwaddr addr1;
2005
    MemoryRegion *mr;
2006
    bool error = false;
2007

B
bellard 已提交
2008
    while (len > 0) {
2009
        l = len;
2010
        mr = address_space_translate(as, addr, &addr1, &l, is_write);
2011

B
bellard 已提交
2012
        if (is_write) {
2013 2014
            if (!memory_access_is_direct(mr, is_write)) {
                l = memory_access_size(mr, l, addr1);
2015
                /* XXX: could force current_cpu to NULL to avoid
B
bellard 已提交
2016
                   potential bugs */
2017 2018 2019 2020 2021 2022 2023
                switch (l) {
                case 8:
                    /* 64 bit write access */
                    val = ldq_p(buf);
                    error |= io_mem_write(mr, addr1, val, 8);
                    break;
                case 4:
B
bellard 已提交
2024
                    /* 32 bit write access */
B
bellard 已提交
2025
                    val = ldl_p(buf);
2026
                    error |= io_mem_write(mr, addr1, val, 4);
2027 2028
                    break;
                case 2:
B
bellard 已提交
2029
                    /* 16 bit write access */
B
bellard 已提交
2030
                    val = lduw_p(buf);
2031
                    error |= io_mem_write(mr, addr1, val, 2);
2032 2033
                    break;
                case 1:
B
bellard 已提交
2034
                    /* 8 bit write access */
B
bellard 已提交
2035
                    val = ldub_p(buf);
2036
                    error |= io_mem_write(mr, addr1, val, 1);
2037 2038 2039
                    break;
                default:
                    abort();
B
bellard 已提交
2040
                }
2041
            } else {
2042
                addr1 += memory_region_get_ram_addr(mr);
B
bellard 已提交
2043
                /* RAM case */
P
pbrook 已提交
2044
                ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
2045
                memcpy(ptr, buf, l);
2046
                invalidate_and_set_dirty(addr1, l);
B
bellard 已提交
2047 2048
            }
        } else {
2049
            if (!memory_access_is_direct(mr, is_write)) {
B
bellard 已提交
2050
                /* I/O case */
2051
                l = memory_access_size(mr, l, addr1);
2052 2053 2054 2055 2056 2057 2058
                switch (l) {
                case 8:
                    /* 64 bit read access */
                    error |= io_mem_read(mr, addr1, &val, 8);
                    stq_p(buf, val);
                    break;
                case 4:
B
bellard 已提交
2059
                    /* 32 bit read access */
2060
                    error |= io_mem_read(mr, addr1, &val, 4);
B
bellard 已提交
2061
                    stl_p(buf, val);
2062 2063
                    break;
                case 2:
B
bellard 已提交
2064
                    /* 16 bit read access */
2065
                    error |= io_mem_read(mr, addr1, &val, 2);
B
bellard 已提交
2066
                    stw_p(buf, val);
2067 2068
                    break;
                case 1:
B
bellard 已提交
2069
                    /* 8 bit read access */
2070
                    error |= io_mem_read(mr, addr1, &val, 1);
B
bellard 已提交
2071
                    stb_p(buf, val);
2072 2073 2074
                    break;
                default:
                    abort();
B
bellard 已提交
2075 2076 2077
                }
            } else {
                /* RAM case */
2078
                ptr = qemu_get_ram_ptr(mr->ram_addr + addr1);
2079
                memcpy(buf, ptr, l);
B
bellard 已提交
2080 2081 2082 2083 2084 2085
            }
        }
        len -= l;
        buf += l;
        addr += l;
    }
2086 2087

    return error;
B
bellard 已提交
2088
}
B
bellard 已提交
2089

2090
bool address_space_write(AddressSpace *as, hwaddr addr,
A
Avi Kivity 已提交
2091 2092
                         const uint8_t *buf, int len)
{
2093
    return address_space_rw(as, addr, (uint8_t *)buf, len, true);
A
Avi Kivity 已提交
2094 2095
}

2096
bool address_space_read(AddressSpace *as, hwaddr addr, uint8_t *buf, int len)
A
Avi Kivity 已提交
2097
{
2098
    return address_space_rw(as, addr, buf, len, false);
A
Avi Kivity 已提交
2099 2100 2101
}


A
Avi Kivity 已提交
2102
void cpu_physical_memory_rw(hwaddr addr, uint8_t *buf,
A
Avi Kivity 已提交
2103 2104
                            int len, int is_write)
{
2105
    address_space_rw(&address_space_memory, addr, buf, len, is_write);
A
Avi Kivity 已提交
2106 2107
}

2108 2109 2110 2111 2112
enum write_rom_type {
    WRITE_DATA,
    FLUSH_CACHE,
};

2113
static inline void cpu_physical_memory_write_rom_internal(AddressSpace *as,
2114
    hwaddr addr, const uint8_t *buf, int len, enum write_rom_type type)
B
bellard 已提交
2115
{
2116
    hwaddr l;
B
bellard 已提交
2117
    uint8_t *ptr;
2118
    hwaddr addr1;
2119
    MemoryRegion *mr;
2120

B
bellard 已提交
2121
    while (len > 0) {
2122
        l = len;
2123
        mr = address_space_translate(as, addr, &addr1, &l, true);
2124

2125 2126
        if (!(memory_region_is_ram(mr) ||
              memory_region_is_romd(mr))) {
B
bellard 已提交
2127 2128
            /* do nothing */
        } else {
2129
            addr1 += memory_region_get_ram_addr(mr);
B
bellard 已提交
2130
            /* ROM/RAM case */
P
pbrook 已提交
2131
            ptr = qemu_get_ram_ptr(addr1);
2132 2133 2134 2135 2136 2137 2138 2139 2140
            switch (type) {
            case WRITE_DATA:
                memcpy(ptr, buf, l);
                invalidate_and_set_dirty(addr1, l);
                break;
            case FLUSH_CACHE:
                flush_icache_range((uintptr_t)ptr, (uintptr_t)ptr + l);
                break;
            }
B
bellard 已提交
2141 2142 2143 2144 2145 2146 2147
        }
        len -= l;
        buf += l;
        addr += l;
    }
}

2148
/* used for ROM loading : can write in RAM and ROM */
2149
void cpu_physical_memory_write_rom(AddressSpace *as, hwaddr addr,
2150 2151
                                   const uint8_t *buf, int len)
{
2152
    cpu_physical_memory_write_rom_internal(as, addr, buf, len, WRITE_DATA);
2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166
}

void cpu_flush_icache_range(hwaddr start, int len)
{
    /*
     * This function should do the same thing as an icache flush that was
     * triggered from within the guest. For TCG we are always cache coherent,
     * so there is no need to flush anything. For KVM / Xen we need to flush
     * the host's instruction cache at least.
     */
    if (tcg_enabled()) {
        return;
    }

2167 2168
    cpu_physical_memory_write_rom_internal(&address_space_memory,
                                           start, NULL, len, FLUSH_CACHE);
2169 2170
}

2171
typedef struct {
2172
    MemoryRegion *mr;
2173
    void *buffer;
A
Avi Kivity 已提交
2174 2175
    hwaddr addr;
    hwaddr len;
2176 2177 2178 2179
} BounceBuffer;

static BounceBuffer bounce;

2180 2181 2182
typedef struct MapClient {
    void *opaque;
    void (*callback)(void *opaque);
B
Blue Swirl 已提交
2183
    QLIST_ENTRY(MapClient) link;
2184 2185
} MapClient;

B
Blue Swirl 已提交
2186 2187
static QLIST_HEAD(map_client_list, MapClient) map_client_list
    = QLIST_HEAD_INITIALIZER(map_client_list);
2188 2189 2190

void *cpu_register_map_client(void *opaque, void (*callback)(void *opaque))
{
2191
    MapClient *client = g_malloc(sizeof(*client));
2192 2193 2194

    client->opaque = opaque;
    client->callback = callback;
B
Blue Swirl 已提交
2195
    QLIST_INSERT_HEAD(&map_client_list, client, link);
2196 2197 2198
    return client;
}

B
Blue Swirl 已提交
2199
static void cpu_unregister_map_client(void *_client)
2200 2201 2202
{
    MapClient *client = (MapClient *)_client;

B
Blue Swirl 已提交
2203
    QLIST_REMOVE(client, link);
2204
    g_free(client);
2205 2206 2207 2208 2209 2210
}

static void cpu_notify_map_clients(void)
{
    MapClient *client;

B
Blue Swirl 已提交
2211 2212
    while (!QLIST_EMPTY(&map_client_list)) {
        client = QLIST_FIRST(&map_client_list);
2213
        client->callback(client->opaque);
2214
        cpu_unregister_map_client(client);
2215 2216 2217
    }
}

2218 2219
bool address_space_access_valid(AddressSpace *as, hwaddr addr, int len, bool is_write)
{
2220
    MemoryRegion *mr;
2221 2222 2223 2224
    hwaddr l, xlat;

    while (len > 0) {
        l = len;
2225 2226 2227 2228
        mr = address_space_translate(as, addr, &xlat, &l, is_write);
        if (!memory_access_is_direct(mr, is_write)) {
            l = memory_access_size(mr, l, addr);
            if (!memory_region_access_valid(mr, xlat, l, is_write)) {
2229 2230 2231 2232 2233 2234 2235 2236 2237 2238
                return false;
            }
        }

        len -= l;
        addr += l;
    }
    return true;
}

2239 2240 2241 2242
/* Map a physical memory region into a host virtual address.
 * May map a subset of the requested range, given by and returned in *plen.
 * May return NULL if resources needed to perform the mapping are exhausted.
 * Use only for reads OR writes - not for read-modify-write operations.
2243 2244
 * Use cpu_register_map_client() to know when retrying the map operation is
 * likely to succeed.
2245
 */
A
Avi Kivity 已提交
2246
void *address_space_map(AddressSpace *as,
A
Avi Kivity 已提交
2247 2248
                        hwaddr addr,
                        hwaddr *plen,
A
Avi Kivity 已提交
2249
                        bool is_write)
2250
{
A
Avi Kivity 已提交
2251
    hwaddr len = *plen;
2252 2253 2254 2255
    hwaddr done = 0;
    hwaddr l, xlat, base;
    MemoryRegion *mr, *this_mr;
    ram_addr_t raddr;
2256

2257 2258 2259
    if (len == 0) {
        return NULL;
    }
2260

2261 2262 2263 2264 2265
    l = len;
    mr = address_space_translate(as, addr, &xlat, &l, is_write);
    if (!memory_access_is_direct(mr, is_write)) {
        if (bounce.buffer) {
            return NULL;
2266
        }
2267 2268 2269
        /* Avoid unbounded allocations */
        l = MIN(l, TARGET_PAGE_SIZE);
        bounce.buffer = qemu_memalign(TARGET_PAGE_SIZE, l);
2270 2271
        bounce.addr = addr;
        bounce.len = l;
2272 2273 2274

        memory_region_ref(mr);
        bounce.mr = mr;
2275 2276
        if (!is_write) {
            address_space_read(as, addr, bounce.buffer, l);
2277
        }
2278

2279 2280 2281 2282 2283 2284 2285 2286
        *plen = l;
        return bounce.buffer;
    }

    base = xlat;
    raddr = memory_region_get_ram_addr(mr);

    for (;;) {
2287 2288
        len -= l;
        addr += l;
2289 2290 2291 2292 2293 2294 2295 2296 2297 2298
        done += l;
        if (len == 0) {
            break;
        }

        l = len;
        this_mr = address_space_translate(as, addr, &xlat, &l, is_write);
        if (this_mr != mr || xlat != base + done) {
            break;
        }
2299
    }
2300

2301
    memory_region_ref(mr);
2302 2303
    *plen = done;
    return qemu_ram_ptr_length(raddr + base, plen);
2304 2305
}

A
Avi Kivity 已提交
2306
/* Unmaps a memory region previously mapped by address_space_map().
2307 2308 2309
 * Will also mark the memory as dirty if is_write == 1.  access_len gives
 * the amount of memory that was actually read or written by the caller.
 */
A
Avi Kivity 已提交
2310 2311
void address_space_unmap(AddressSpace *as, void *buffer, hwaddr len,
                         int is_write, hwaddr access_len)
2312 2313
{
    if (buffer != bounce.buffer) {
2314 2315 2316 2317 2318
        MemoryRegion *mr;
        ram_addr_t addr1;

        mr = qemu_ram_addr_from_host(buffer, &addr1);
        assert(mr != NULL);
2319 2320 2321 2322 2323 2324
        if (is_write) {
            while (access_len) {
                unsigned l;
                l = TARGET_PAGE_SIZE;
                if (l > access_len)
                    l = access_len;
2325
                invalidate_and_set_dirty(addr1, l);
2326 2327 2328 2329
                addr1 += l;
                access_len -= l;
            }
        }
2330
        if (xen_enabled()) {
J
Jan Kiszka 已提交
2331
            xen_invalidate_map_cache_entry(buffer);
A
Anthony PERARD 已提交
2332
        }
2333
        memory_region_unref(mr);
2334 2335 2336
        return;
    }
    if (is_write) {
A
Avi Kivity 已提交
2337
        address_space_write(as, bounce.addr, bounce.buffer, access_len);
2338
    }
2339
    qemu_vfree(bounce.buffer);
2340
    bounce.buffer = NULL;
2341
    memory_region_unref(bounce.mr);
2342
    cpu_notify_map_clients();
2343
}
B
bellard 已提交
2344

A
Avi Kivity 已提交
2345 2346
void *cpu_physical_memory_map(hwaddr addr,
                              hwaddr *plen,
A
Avi Kivity 已提交
2347 2348 2349 2350 2351
                              int is_write)
{
    return address_space_map(&address_space_memory, addr, plen, is_write);
}

A
Avi Kivity 已提交
2352 2353
void cpu_physical_memory_unmap(void *buffer, hwaddr len,
                               int is_write, hwaddr access_len)
A
Avi Kivity 已提交
2354 2355 2356 2357
{
    return address_space_unmap(&address_space_memory, buffer, len, is_write, access_len);
}

B
bellard 已提交
2358
/* warning: addr must be aligned */
2359
static inline uint32_t ldl_phys_internal(AddressSpace *as, hwaddr addr,
2360
                                         enum device_endian endian)
B
bellard 已提交
2361 2362
{
    uint8_t *ptr;
2363
    uint64_t val;
2364
    MemoryRegion *mr;
2365 2366
    hwaddr l = 4;
    hwaddr addr1;
B
bellard 已提交
2367

2368
    mr = address_space_translate(as, addr, &addr1, &l, false);
2369
    if (l < 4 || !memory_access_is_direct(mr, false)) {
B
bellard 已提交
2370
        /* I/O case */
2371
        io_mem_read(mr, addr1, &val, 4);
2372 2373 2374 2375 2376 2377 2378 2379 2380
#if defined(TARGET_WORDS_BIGENDIAN)
        if (endian == DEVICE_LITTLE_ENDIAN) {
            val = bswap32(val);
        }
#else
        if (endian == DEVICE_BIG_ENDIAN) {
            val = bswap32(val);
        }
#endif
B
bellard 已提交
2381 2382
    } else {
        /* RAM case */
2383
        ptr = qemu_get_ram_ptr((memory_region_get_ram_addr(mr)
2384
                                & TARGET_PAGE_MASK)
2385
                               + addr1);
2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396
        switch (endian) {
        case DEVICE_LITTLE_ENDIAN:
            val = ldl_le_p(ptr);
            break;
        case DEVICE_BIG_ENDIAN:
            val = ldl_be_p(ptr);
            break;
        default:
            val = ldl_p(ptr);
            break;
        }
B
bellard 已提交
2397 2398 2399 2400
    }
    return val;
}

2401
uint32_t ldl_phys(AddressSpace *as, hwaddr addr)
2402
{
2403
    return ldl_phys_internal(as, addr, DEVICE_NATIVE_ENDIAN);
2404 2405
}

2406
uint32_t ldl_le_phys(AddressSpace *as, hwaddr addr)
2407
{
2408
    return ldl_phys_internal(as, addr, DEVICE_LITTLE_ENDIAN);
2409 2410
}

2411
uint32_t ldl_be_phys(AddressSpace *as, hwaddr addr)
2412
{
2413
    return ldl_phys_internal(as, addr, DEVICE_BIG_ENDIAN);
2414 2415
}

B
bellard 已提交
2416
/* warning: addr must be aligned */
2417
static inline uint64_t ldq_phys_internal(AddressSpace *as, hwaddr addr,
2418
                                         enum device_endian endian)
B
bellard 已提交
2419 2420 2421
{
    uint8_t *ptr;
    uint64_t val;
2422
    MemoryRegion *mr;
2423 2424
    hwaddr l = 8;
    hwaddr addr1;
B
bellard 已提交
2425

2426
    mr = address_space_translate(as, addr, &addr1, &l,
2427 2428
                                 false);
    if (l < 8 || !memory_access_is_direct(mr, false)) {
B
bellard 已提交
2429
        /* I/O case */
2430
        io_mem_read(mr, addr1, &val, 8);
2431 2432 2433 2434 2435 2436 2437 2438
#if defined(TARGET_WORDS_BIGENDIAN)
        if (endian == DEVICE_LITTLE_ENDIAN) {
            val = bswap64(val);
        }
#else
        if (endian == DEVICE_BIG_ENDIAN) {
            val = bswap64(val);
        }
B
bellard 已提交
2439 2440 2441
#endif
    } else {
        /* RAM case */
2442
        ptr = qemu_get_ram_ptr((memory_region_get_ram_addr(mr)
2443
                                & TARGET_PAGE_MASK)
2444
                               + addr1);
2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455
        switch (endian) {
        case DEVICE_LITTLE_ENDIAN:
            val = ldq_le_p(ptr);
            break;
        case DEVICE_BIG_ENDIAN:
            val = ldq_be_p(ptr);
            break;
        default:
            val = ldq_p(ptr);
            break;
        }
B
bellard 已提交
2456 2457 2458 2459
    }
    return val;
}

2460
uint64_t ldq_phys(AddressSpace *as, hwaddr addr)
2461
{
2462
    return ldq_phys_internal(as, addr, DEVICE_NATIVE_ENDIAN);
2463 2464
}

2465
uint64_t ldq_le_phys(AddressSpace *as, hwaddr addr)
2466
{
2467
    return ldq_phys_internal(as, addr, DEVICE_LITTLE_ENDIAN);
2468 2469
}

2470
uint64_t ldq_be_phys(AddressSpace *as, hwaddr addr)
2471
{
2472
    return ldq_phys_internal(as, addr, DEVICE_BIG_ENDIAN);
2473 2474
}

B
bellard 已提交
2475
/* XXX: optimize */
2476
uint32_t ldub_phys(AddressSpace *as, hwaddr addr)
B
bellard 已提交
2477 2478
{
    uint8_t val;
2479
    address_space_rw(as, addr, &val, 1, 0);
B
bellard 已提交
2480 2481 2482
    return val;
}

2483
/* warning: addr must be aligned */
2484
static inline uint32_t lduw_phys_internal(AddressSpace *as, hwaddr addr,
2485
                                          enum device_endian endian)
B
bellard 已提交
2486
{
2487 2488
    uint8_t *ptr;
    uint64_t val;
2489
    MemoryRegion *mr;
2490 2491
    hwaddr l = 2;
    hwaddr addr1;
2492

2493
    mr = address_space_translate(as, addr, &addr1, &l,
2494 2495
                                 false);
    if (l < 2 || !memory_access_is_direct(mr, false)) {
2496
        /* I/O case */
2497
        io_mem_read(mr, addr1, &val, 2);
2498 2499 2500 2501 2502 2503 2504 2505 2506
#if defined(TARGET_WORDS_BIGENDIAN)
        if (endian == DEVICE_LITTLE_ENDIAN) {
            val = bswap16(val);
        }
#else
        if (endian == DEVICE_BIG_ENDIAN) {
            val = bswap16(val);
        }
#endif
2507 2508
    } else {
        /* RAM case */
2509
        ptr = qemu_get_ram_ptr((memory_region_get_ram_addr(mr)
2510
                                & TARGET_PAGE_MASK)
2511
                               + addr1);
2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522
        switch (endian) {
        case DEVICE_LITTLE_ENDIAN:
            val = lduw_le_p(ptr);
            break;
        case DEVICE_BIG_ENDIAN:
            val = lduw_be_p(ptr);
            break;
        default:
            val = lduw_p(ptr);
            break;
        }
2523 2524
    }
    return val;
B
bellard 已提交
2525 2526
}

2527
uint32_t lduw_phys(AddressSpace *as, hwaddr addr)
2528
{
2529
    return lduw_phys_internal(as, addr, DEVICE_NATIVE_ENDIAN);
2530 2531
}

2532
uint32_t lduw_le_phys(AddressSpace *as, hwaddr addr)
2533
{
2534
    return lduw_phys_internal(as, addr, DEVICE_LITTLE_ENDIAN);
2535 2536
}

2537
uint32_t lduw_be_phys(AddressSpace *as, hwaddr addr)
2538
{
2539
    return lduw_phys_internal(as, addr, DEVICE_BIG_ENDIAN);
2540 2541
}

B
bellard 已提交
2542 2543 2544
/* warning: addr must be aligned. The ram page is not masked as dirty
   and the code inside is not invalidated. It is useful if the dirty
   bits are used to track modified PTEs */
2545
void stl_phys_notdirty(AddressSpace *as, hwaddr addr, uint32_t val)
B
bellard 已提交
2546 2547
{
    uint8_t *ptr;
2548
    MemoryRegion *mr;
2549 2550
    hwaddr l = 4;
    hwaddr addr1;
B
bellard 已提交
2551

2552
    mr = address_space_translate(as, addr, &addr1, &l,
2553 2554 2555
                                 true);
    if (l < 4 || !memory_access_is_direct(mr, true)) {
        io_mem_write(mr, addr1, val, 4);
B
bellard 已提交
2556
    } else {
2557
        addr1 += memory_region_get_ram_addr(mr) & TARGET_PAGE_MASK;
P
pbrook 已提交
2558
        ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
2559
        stl_p(ptr, val);
A
aliguori 已提交
2560 2561

        if (unlikely(in_migration)) {
2562
            if (cpu_physical_memory_is_clean(addr1)) {
A
aliguori 已提交
2563 2564 2565
                /* invalidate code */
                tb_invalidate_phys_page_range(addr1, addr1 + 4, 0);
                /* set dirty bit */
2566 2567 2568
                cpu_physical_memory_set_dirty_flag(addr1,
                                                   DIRTY_MEMORY_MIGRATION);
                cpu_physical_memory_set_dirty_flag(addr1, DIRTY_MEMORY_VGA);
A
aliguori 已提交
2569 2570
            }
        }
B
bellard 已提交
2571 2572 2573 2574
    }
}

/* warning: addr must be aligned */
2575 2576
static inline void stl_phys_internal(AddressSpace *as,
                                     hwaddr addr, uint32_t val,
2577
                                     enum device_endian endian)
B
bellard 已提交
2578 2579
{
    uint8_t *ptr;
2580
    MemoryRegion *mr;
2581 2582
    hwaddr l = 4;
    hwaddr addr1;
B
bellard 已提交
2583

2584
    mr = address_space_translate(as, addr, &addr1, &l,
2585 2586
                                 true);
    if (l < 4 || !memory_access_is_direct(mr, true)) {
2587 2588 2589 2590 2591 2592 2593 2594 2595
#if defined(TARGET_WORDS_BIGENDIAN)
        if (endian == DEVICE_LITTLE_ENDIAN) {
            val = bswap32(val);
        }
#else
        if (endian == DEVICE_BIG_ENDIAN) {
            val = bswap32(val);
        }
#endif
2596
        io_mem_write(mr, addr1, val, 4);
B
bellard 已提交
2597 2598
    } else {
        /* RAM case */
2599
        addr1 += memory_region_get_ram_addr(mr) & TARGET_PAGE_MASK;
P
pbrook 已提交
2600
        ptr = qemu_get_ram_ptr(addr1);
2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611
        switch (endian) {
        case DEVICE_LITTLE_ENDIAN:
            stl_le_p(ptr, val);
            break;
        case DEVICE_BIG_ENDIAN:
            stl_be_p(ptr, val);
            break;
        default:
            stl_p(ptr, val);
            break;
        }
2612
        invalidate_and_set_dirty(addr1, 4);
B
bellard 已提交
2613 2614 2615
    }
}

2616
void stl_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2617
{
2618
    stl_phys_internal(as, addr, val, DEVICE_NATIVE_ENDIAN);
2619 2620
}

2621
void stl_le_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2622
{
2623
    stl_phys_internal(as, addr, val, DEVICE_LITTLE_ENDIAN);
2624 2625
}

2626
void stl_be_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2627
{
2628
    stl_phys_internal(as, addr, val, DEVICE_BIG_ENDIAN);
2629 2630
}

B
bellard 已提交
2631
/* XXX: optimize */
2632
void stb_phys(AddressSpace *as, hwaddr addr, uint32_t val)
B
bellard 已提交
2633 2634
{
    uint8_t v = val;
2635
    address_space_rw(as, addr, &v, 1, 1);
B
bellard 已提交
2636 2637
}

2638
/* warning: addr must be aligned */
2639 2640
static inline void stw_phys_internal(AddressSpace *as,
                                     hwaddr addr, uint32_t val,
2641
                                     enum device_endian endian)
B
bellard 已提交
2642
{
2643
    uint8_t *ptr;
2644
    MemoryRegion *mr;
2645 2646
    hwaddr l = 2;
    hwaddr addr1;
2647

2648
    mr = address_space_translate(as, addr, &addr1, &l, true);
2649
    if (l < 2 || !memory_access_is_direct(mr, true)) {
2650 2651 2652 2653 2654 2655 2656 2657 2658
#if defined(TARGET_WORDS_BIGENDIAN)
        if (endian == DEVICE_LITTLE_ENDIAN) {
            val = bswap16(val);
        }
#else
        if (endian == DEVICE_BIG_ENDIAN) {
            val = bswap16(val);
        }
#endif
2659
        io_mem_write(mr, addr1, val, 2);
2660 2661
    } else {
        /* RAM case */
2662
        addr1 += memory_region_get_ram_addr(mr) & TARGET_PAGE_MASK;
2663
        ptr = qemu_get_ram_ptr(addr1);
2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674
        switch (endian) {
        case DEVICE_LITTLE_ENDIAN:
            stw_le_p(ptr, val);
            break;
        case DEVICE_BIG_ENDIAN:
            stw_be_p(ptr, val);
            break;
        default:
            stw_p(ptr, val);
            break;
        }
2675
        invalidate_and_set_dirty(addr1, 2);
2676
    }
B
bellard 已提交
2677 2678
}

2679
void stw_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2680
{
2681
    stw_phys_internal(as, addr, val, DEVICE_NATIVE_ENDIAN);
2682 2683
}

2684
void stw_le_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2685
{
2686
    stw_phys_internal(as, addr, val, DEVICE_LITTLE_ENDIAN);
2687 2688
}

2689
void stw_be_phys(AddressSpace *as, hwaddr addr, uint32_t val)
2690
{
2691
    stw_phys_internal(as, addr, val, DEVICE_BIG_ENDIAN);
2692 2693
}

B
bellard 已提交
2694
/* XXX: optimize */
2695
void stq_phys(AddressSpace *as, hwaddr addr, uint64_t val)
B
bellard 已提交
2696 2697
{
    val = tswap64(val);
2698
    address_space_rw(as, addr, (void *) &val, 8, 1);
B
bellard 已提交
2699 2700
}

2701
void stq_le_phys(AddressSpace *as, hwaddr addr, uint64_t val)
2702 2703
{
    val = cpu_to_le64(val);
2704
    address_space_rw(as, addr, (void *) &val, 8, 1);
2705 2706
}

2707
void stq_be_phys(AddressSpace *as, hwaddr addr, uint64_t val)
2708 2709
{
    val = cpu_to_be64(val);
2710
    address_space_rw(as, addr, (void *) &val, 8, 1);
2711 2712
}

2713
/* virtual memory access for debug (includes writing to ROM) */
2714
int cpu_memory_rw_debug(CPUState *cpu, target_ulong addr,
2715
                        uint8_t *buf, int len, int is_write)
B
bellard 已提交
2716 2717
{
    int l;
A
Avi Kivity 已提交
2718
    hwaddr phys_addr;
2719
    target_ulong page;
B
bellard 已提交
2720 2721 2722

    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
2723
        phys_addr = cpu_get_phys_page_debug(cpu, page);
B
bellard 已提交
2724 2725 2726 2727 2728 2729
        /* if no physical page mapped, return an error */
        if (phys_addr == -1)
            return -1;
        l = (page + TARGET_PAGE_SIZE) - addr;
        if (l > len)
            l = len;
2730
        phys_addr += (addr & ~TARGET_PAGE_MASK);
2731 2732 2733 2734 2735
        if (is_write) {
            cpu_physical_memory_write_rom(cpu->as, phys_addr, buf, l);
        } else {
            address_space_rw(cpu->as, phys_addr, buf, l, 0);
        }
B
bellard 已提交
2736 2737 2738 2739 2740 2741
        len -= l;
        buf += l;
        addr += l;
    }
    return 0;
}
P
Paul Brook 已提交
2742
#endif
B
bellard 已提交
2743

2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761
#if !defined(CONFIG_USER_ONLY)

/*
 * A helper function for the _utterly broken_ virtio device model to find out if
 * it's running on a big endian machine. Don't do this at home kids!
 */
bool virtio_is_big_endian(void);
bool virtio_is_big_endian(void)
{
#if defined(TARGET_WORDS_BIGENDIAN)
    return true;
#else
    return false;
#endif
}

#endif

2762
#ifndef CONFIG_USER_ONLY
A
Avi Kivity 已提交
2763
bool cpu_physical_memory_is_io(hwaddr phys_addr)
2764
{
2765
    MemoryRegion*mr;
2766
    hwaddr l = 1;
2767

2768 2769
    mr = address_space_translate(&address_space_memory,
                                 phys_addr, &phys_addr, &l, false);
2770

2771 2772
    return !(memory_region_is_ram(mr) ||
             memory_region_is_romd(mr));
2773
}
2774 2775 2776 2777 2778 2779 2780 2781 2782

void qemu_ram_foreach_block(RAMBlockIterFunc func, void *opaque)
{
    RAMBlock *block;

    QTAILQ_FOREACH(block, &ram_list.blocks, next) {
        func(block->host, block->offset, block->length, opaque);
    }
}
2783
#endif