exec.c 119.8 KB
Newer Older
B
bellard 已提交
1
/*
B
bellard 已提交
2
 *  virtual page mapping and translated block handling
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"
B
bellard 已提交
20 21 22
#ifdef _WIN32
#include <windows.h>
#else
B
bellard 已提交
23
#include <sys/types.h>
B
bellard 已提交
24 25
#include <sys/mman.h>
#endif
B
bellard 已提交
26 27 28 29 30 31 32 33
#include <stdlib.h>
#include <stdio.h>
#include <stdarg.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <inttypes.h>

B
bellard 已提交
34 35
#include "cpu.h"
#include "exec-all.h"
36
#include "qemu-common.h"
B
bellard 已提交
37
#include "tcg.h"
38
#include "hw/hw.h"
A
aliguori 已提交
39
#include "osdep.h"
A
aliguori 已提交
40
#include "kvm.h"
B
Blue Swirl 已提交
41
#include "qemu-timer.h"
42 43
#if defined(CONFIG_USER_ONLY)
#include <qemu.h>
44
#include <signal.h>
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
#include <sys/param.h>
#if __FreeBSD_version >= 700104
#define HAVE_KINFO_GETVMMAP
#define sigqueue sigqueue_freebsd  /* avoid redefinition */
#include <sys/time.h>
#include <sys/proc.h>
#include <machine/profile.h>
#define _KERNEL
#include <sys/user.h>
#undef _KERNEL
#undef sigqueue
#include <libutil.h>
#endif
#endif
60
#endif
B
bellard 已提交
61

B
bellard 已提交
62
//#define DEBUG_TB_INVALIDATE
B
bellard 已提交
63
//#define DEBUG_FLUSH
64
//#define DEBUG_TLB
P
pbrook 已提交
65
//#define DEBUG_UNASSIGNED
B
bellard 已提交
66 67

/* make various TB consistency checks */
68 69
//#define DEBUG_TB_CHECK
//#define DEBUG_TLB_CHECK
B
bellard 已提交
70

T
ths 已提交
71
//#define DEBUG_IOPORT
72
//#define DEBUG_SUBPAGE
T
ths 已提交
73

74 75 76 77 78
#if !defined(CONFIG_USER_ONLY)
/* TB consistency checks only implemented for usermode emulation.  */
#undef DEBUG_TB_CHECK
#endif

79 80
#define SMC_BITMAP_USE_THRESHOLD 10

B
blueswir1 已提交
81
static TranslationBlock *tbs;
82
int code_gen_max_blocks;
83
TranslationBlock *tb_phys_hash[CODE_GEN_PHYS_HASH_SIZE];
B
blueswir1 已提交
84
static int nb_tbs;
B
bellard 已提交
85
/* any access to the tbs or the page table must use this lock */
A
Anthony Liguori 已提交
86
spinlock_t tb_lock = SPIN_LOCK_UNLOCKED;
B
bellard 已提交
87

B
blueswir1 已提交
88 89 90
#if defined(__arm__) || defined(__sparc_v9__)
/* The prologue must be reachable with a direct jump. ARM and Sparc64
 have limited branch ranges (possibly also PPC) so place it in a
91 92 93 94
 section close to code segment. */
#define code_gen_section                                \
    __attribute__((__section__(".gen_code")))           \
    __attribute__((aligned (32)))
95 96 97 98
#elif defined(_WIN32)
/* Maximum alignment for Win32 is 16. */
#define code_gen_section                                \
    __attribute__((aligned (16)))
99 100 101 102 103 104
#else
#define code_gen_section                                \
    __attribute__((aligned (32)))
#endif

uint8_t code_gen_prologue[1024] code_gen_section;
B
blueswir1 已提交
105 106
static uint8_t *code_gen_buffer;
static unsigned long code_gen_buffer_size;
107
/* threshold to flush the translated code buffer */
B
blueswir1 已提交
108
static unsigned long code_gen_buffer_max_size;
B
bellard 已提交
109 110
uint8_t *code_gen_ptr;

111
#if !defined(CONFIG_USER_ONLY)
112
int phys_ram_fd;
113
uint8_t *phys_ram_dirty;
A
aliguori 已提交
114
static int in_migration;
P
pbrook 已提交
115 116 117

typedef struct RAMBlock {
    uint8_t *host;
A
Anthony Liguori 已提交
118 119
    ram_addr_t offset;
    ram_addr_t length;
P
pbrook 已提交
120 121 122 123 124
    struct RAMBlock *next;
} RAMBlock;

static RAMBlock *ram_blocks;
/* TODO: When we implement (and use) ram deallocation (e.g. for hotplug)
S
Stuart Brady 已提交
125
   then we can no longer assume contiguous ram offsets, and external uses
P
pbrook 已提交
126
   of this variable will break.  */
A
Anthony Liguori 已提交
127
ram_addr_t last_ram_offset;
128
#endif
129

B
bellard 已提交
130 131 132
CPUState *first_cpu;
/* current CPU in the current thread. It is only valid inside
   cpu_exec() */
133
CPUState *cpu_single_env;
P
pbrook 已提交
134
/* 0 = Do not count executed instructions.
T
ths 已提交
135
   1 = Precise instruction counting.
P
pbrook 已提交
136 137 138 139 140
   2 = Adaptive rate instruction counting.  */
int use_icount = 0;
/* Current instruction counter.  While executing translated code this may
   include some instructions that have not yet been executed.  */
int64_t qemu_icount;
B
bellard 已提交
141

B
bellard 已提交
142
typedef struct PageDesc {
B
bellard 已提交
143
    /* list of TBs intersecting this ram page */
B
bellard 已提交
144
    TranslationBlock *first_tb;
145 146 147 148 149 150 151
    /* in order to optimize self modifying code, we count the number
       of lookups we do to a given page to use a bitmap */
    unsigned int code_write_count;
    uint8_t *code_bitmap;
#if defined(CONFIG_USER_ONLY)
    unsigned long flags;
#endif
B
bellard 已提交
152 153
} PageDesc;

P
Paul Brook 已提交
154
/* In system mode we want L1_MAP to be based on ram offsets,
155 156
   while in user mode we want it to be based on virtual addresses.  */
#if !defined(CONFIG_USER_ONLY)
P
Paul Brook 已提交
157 158 159
#if HOST_LONG_BITS < TARGET_PHYS_ADDR_SPACE_BITS
# define L1_MAP_ADDR_SPACE_BITS  HOST_LONG_BITS
#else
160
# define L1_MAP_ADDR_SPACE_BITS  TARGET_PHYS_ADDR_SPACE_BITS
P
Paul Brook 已提交
161
#endif
162
#else
163
# define L1_MAP_ADDR_SPACE_BITS  TARGET_VIRT_ADDR_SPACE_BITS
164
#endif
B
bellard 已提交
165

166 167
/* Size of the L2 (and L3, etc) page tables.  */
#define L2_BITS 10
B
bellard 已提交
168 169
#define L2_SIZE (1 << L2_BITS)

170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194
/* The bits remaining after N lower levels of page tables.  */
#define P_L1_BITS_REM \
    ((TARGET_PHYS_ADDR_SPACE_BITS - TARGET_PAGE_BITS) % L2_BITS)
#define V_L1_BITS_REM \
    ((L1_MAP_ADDR_SPACE_BITS - TARGET_PAGE_BITS) % L2_BITS)

/* Size of the L1 page table.  Avoid silly small sizes.  */
#if P_L1_BITS_REM < 4
#define P_L1_BITS  (P_L1_BITS_REM + L2_BITS)
#else
#define P_L1_BITS  P_L1_BITS_REM
#endif

#if V_L1_BITS_REM < 4
#define V_L1_BITS  (V_L1_BITS_REM + L2_BITS)
#else
#define V_L1_BITS  V_L1_BITS_REM
#endif

#define P_L1_SIZE  ((target_phys_addr_t)1 << P_L1_BITS)
#define V_L1_SIZE  ((target_ulong)1 << V_L1_BITS)

#define P_L1_SHIFT (TARGET_PHYS_ADDR_SPACE_BITS - TARGET_PAGE_BITS - P_L1_BITS)
#define V_L1_SHIFT (L1_MAP_ADDR_SPACE_BITS - TARGET_PAGE_BITS - V_L1_BITS)

195 196 197 198
unsigned long qemu_real_host_page_size;
unsigned long qemu_host_page_bits;
unsigned long qemu_host_page_size;
unsigned long qemu_host_page_mask;
B
bellard 已提交
199

200 201 202
/* This is a multi-level map on the virtual address space.
   The bottom level has pointers to PageDesc.  */
static void *l1_map[V_L1_SIZE];
B
bellard 已提交
203

204
#if !defined(CONFIG_USER_ONLY)
P
Paul Brook 已提交
205 206 207 208 209 210
typedef struct PhysPageDesc {
    /* offset in host memory of the page + io_index in the low bits */
    ram_addr_t phys_offset;
    ram_addr_t region_offset;
} PhysPageDesc;

211 212 213
/* This is a multi-level map on the physical address space.
   The bottom level has pointers to PhysPageDesc.  */
static void *l1_phys_map[P_L1_SIZE];
214

215 216
static void io_mem_init(void);

217 218 219
/* io memory support */
CPUWriteMemoryFunc *io_mem_write[IO_MEM_NB_ENTRIES][4];
CPUReadMemoryFunc *io_mem_read[IO_MEM_NB_ENTRIES][4];
B
bellard 已提交
220
void *io_mem_opaque[IO_MEM_NB_ENTRIES];
221
static char io_mem_used[IO_MEM_NB_ENTRIES];
222 223
static int io_mem_watch;
#endif
224

225
/* log support */
J
Juha Riihimäki 已提交
226 227 228
#ifdef WIN32
static const char *logfilename = "qemu.log";
#else
229
static const char *logfilename = "/tmp/qemu.log";
J
Juha Riihimäki 已提交
230
#endif
231 232
FILE *logfile;
int loglevel;
P
pbrook 已提交
233
static int log_append = 0;
234

B
bellard 已提交
235
/* statistics */
236
#if !defined(CONFIG_USER_ONLY)
B
bellard 已提交
237
static int tlb_flush_count;
238
#endif
B
bellard 已提交
239 240 241
static int tb_flush_count;
static int tb_phys_invalidate_count;

242 243 244 245 246 247 248 249 250 251 252
#ifdef _WIN32
static void map_exec(void *addr, long size)
{
    DWORD old_protect;
    VirtualProtect(addr, size,
                   PAGE_EXECUTE_READWRITE, &old_protect);
    
}
#else
static void map_exec(void *addr, long size)
{
253
    unsigned long start, end, page_size;
254
    
255
    page_size = getpagesize();
256
    start = (unsigned long)addr;
257
    start &= ~(page_size - 1);
258 259
    
    end = (unsigned long)addr + size;
260 261
    end += page_size - 1;
    end &= ~(page_size - 1);
262 263 264 265 266 267
    
    mprotect((void *)start, end - start,
             PROT_READ | PROT_WRITE | PROT_EXEC);
}
#endif

B
bellard 已提交
268
static void page_init(void)
B
bellard 已提交
269
{
270
    /* NOTE: we can always suppose that qemu_host_page_size >=
B
bellard 已提交
271
       TARGET_PAGE_SIZE */
272 273 274 275 276 277 278 279 280 281
#ifdef _WIN32
    {
        SYSTEM_INFO system_info;

        GetSystemInfo(&system_info);
        qemu_real_host_page_size = system_info.dwPageSize;
    }
#else
    qemu_real_host_page_size = getpagesize();
#endif
282 283 284 285 286 287 288 289
    if (qemu_host_page_size == 0)
        qemu_host_page_size = qemu_real_host_page_size;
    if (qemu_host_page_size < TARGET_PAGE_SIZE)
        qemu_host_page_size = TARGET_PAGE_SIZE;
    qemu_host_page_bits = 0;
    while ((1 << qemu_host_page_bits) < qemu_host_page_size)
        qemu_host_page_bits++;
    qemu_host_page_mask = ~(qemu_host_page_size - 1);
290 291 292

#if !defined(_WIN32) && defined(CONFIG_USER_ONLY)
    {
293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322
#ifdef HAVE_KINFO_GETVMMAP
        struct kinfo_vmentry *freep;
        int i, cnt;

        freep = kinfo_getvmmap(getpid(), &cnt);
        if (freep) {
            mmap_lock();
            for (i = 0; i < cnt; i++) {
                unsigned long startaddr, endaddr;

                startaddr = freep[i].kve_start;
                endaddr = freep[i].kve_end;
                if (h2g_valid(startaddr)) {
                    startaddr = h2g(startaddr) & TARGET_PAGE_MASK;

                    if (h2g_valid(endaddr)) {
                        endaddr = h2g(endaddr);
                        page_set_flags(startaddr, endaddr, PAGE_RESERVED);
                    } else {
#if TARGET_ABI_BITS <= L1_MAP_ADDR_SPACE_BITS
                        endaddr = ~0ul;
                        page_set_flags(startaddr, endaddr, PAGE_RESERVED);
#endif
                    }
                }
            }
            free(freep);
            mmap_unlock();
        }
#else
323 324
        FILE *f;

P
pbrook 已提交
325
        last_brk = (unsigned long)sbrk(0);
326

327 328 329
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
        f = fopen("/compat/linux/proc/self/maps", "r");
#else
330
        f = fopen("/proc/self/maps", "r");
331
#endif
332
        if (f) {
333 334
            mmap_lock();

335
            do {
336 337 338 339 340 341 342 343 344 345 346 347 348 349
                unsigned long startaddr, endaddr;
                int n;

                n = fscanf (f, "%lx-%lx %*[^\n]\n", &startaddr, &endaddr);

                if (n == 2 && h2g_valid(startaddr)) {
                    startaddr = h2g(startaddr) & TARGET_PAGE_MASK;

                    if (h2g_valid(endaddr)) {
                        endaddr = h2g(endaddr);
                    } else {
                        endaddr = ~0ul;
                    }
                    page_set_flags(startaddr, endaddr, PAGE_RESERVED);
350 351
                }
            } while (!feof(f));
352

353
            fclose(f);
354
            mmap_unlock();
355
        }
356
#endif
357 358
    }
#endif
B
bellard 已提交
359 360
}

P
Paul Brook 已提交
361
static PageDesc *page_find_alloc(tb_page_addr_t index, int alloc)
B
bellard 已提交
362
{
P
Paul Brook 已提交
363 364 365 366
    PageDesc *pd;
    void **lp;
    int i;

367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389
#if defined(CONFIG_USER_ONLY)
    /* We can't use qemu_malloc because it may recurse into a locked mutex.
       Neither can we record the new pages we reserve while allocating a
       given page because that may recurse into an unallocated page table
       entry.  Stuff the allocations we do make into a queue and process
       them after having completed one entire page table allocation.  */

    unsigned long reserve[2 * (V_L1_SHIFT / L2_BITS)];
    int reserve_idx = 0;

# define ALLOC(P, SIZE)                                 \
    do {                                                \
        P = mmap(NULL, SIZE, PROT_READ | PROT_WRITE,    \
                 MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);   \
        if (h2g_valid(P)) {                             \
            reserve[reserve_idx] = h2g(P);              \
            reserve[reserve_idx + 1] = SIZE;            \
            reserve_idx += 2;                           \
        }                                               \
    } while (0)
#else
# define ALLOC(P, SIZE) \
    do { P = qemu_mallocz(SIZE); } while (0)
390
#endif
391

392 393 394 395 396 397 398 399 400 401 402 403 404
    /* Level 1.  Always allocated.  */
    lp = l1_map + ((index >> V_L1_SHIFT) & (V_L1_SIZE - 1));

    /* Level 2..N-1.  */
    for (i = V_L1_SHIFT / L2_BITS - 1; i > 0; i--) {
        void **p = *lp;

        if (p == NULL) {
            if (!alloc) {
                return NULL;
            }
            ALLOC(p, sizeof(void *) * L2_SIZE);
            *lp = p;
405
        }
406 407 408 409 410 411 412 413 414 415 416

        lp = p + ((index >> (i * L2_BITS)) & (L2_SIZE - 1));
    }

    pd = *lp;
    if (pd == NULL) {
        if (!alloc) {
            return NULL;
        }
        ALLOC(pd, sizeof(PageDesc) * L2_SIZE);
        *lp = pd;
B
bellard 已提交
417
    }
418 419 420 421 422 423 424 425 426 427 428 429 430 431

#undef ALLOC
#if defined(CONFIG_USER_ONLY)
    for (i = 0; i < reserve_idx; i += 2) {
        unsigned long addr = reserve[i];
        unsigned long len = reserve[i + 1];

        page_set_flags(addr & TARGET_PAGE_MASK,
                       TARGET_PAGE_ALIGN(addr + len),
                       PAGE_RESERVED);
    }
#endif

    return pd + (index & (L2_SIZE - 1));
B
bellard 已提交
432 433
}

P
Paul Brook 已提交
434
static inline PageDesc *page_find(tb_page_addr_t index)
B
bellard 已提交
435
{
436
    return page_find_alloc(index, 0);
B
bellard 已提交
437 438
}

439
#if !defined(CONFIG_USER_ONLY)
A
Anthony Liguori 已提交
440
static PhysPageDesc *phys_page_find_alloc(target_phys_addr_t index, int alloc)
B
bellard 已提交
441
{
442
    PhysPageDesc *pd;
443 444
    void **lp;
    int i;
B
bellard 已提交
445

446 447
    /* Level 1.  Always allocated.  */
    lp = l1_phys_map + ((index >> P_L1_SHIFT) & (P_L1_SIZE - 1));
448

449 450 451 452 453 454 455 456 457 458
    /* Level 2..N-1.  */
    for (i = P_L1_SHIFT / L2_BITS - 1; i > 0; i--) {
        void **p = *lp;
        if (p == NULL) {
            if (!alloc) {
                return NULL;
            }
            *lp = p = qemu_mallocz(sizeof(void *) * L2_SIZE);
        }
        lp = p + ((index >> (i * L2_BITS)) & (L2_SIZE - 1));
459
    }
460

461
    pd = *lp;
462
    if (pd == NULL) {
463
        int i;
464 465

        if (!alloc) {
466
            return NULL;
467 468 469 470
        }

        *lp = pd = qemu_malloc(sizeof(PhysPageDesc) * L2_SIZE);

P
pbrook 已提交
471
        for (i = 0; i < L2_SIZE; i++) {
472 473
            pd[i].phys_offset = IO_MEM_UNASSIGNED;
            pd[i].region_offset = (index + i) << TARGET_PAGE_BITS;
P
pbrook 已提交
474
        }
B
bellard 已提交
475
    }
476 477

    return pd + (index & (L2_SIZE - 1));
B
bellard 已提交
478 479
}

A
Anthony Liguori 已提交
480
static inline PhysPageDesc *phys_page_find(target_phys_addr_t index)
B
bellard 已提交
481
{
482
    return phys_page_find_alloc(index, 0);
B
bellard 已提交
483 484
}

A
Anthony Liguori 已提交
485 486
static void tlb_protect_code(ram_addr_t ram_addr);
static void tlb_unprotect_code_phys(CPUState *env, ram_addr_t ram_addr,
487
                                    target_ulong vaddr);
P
pbrook 已提交
488 489
#define mmap_lock() do { } while(0)
#define mmap_unlock() do { } while(0)
490
#endif
B
bellard 已提交
491

492 493 494
#define DEFAULT_CODE_GEN_BUFFER_SIZE (32 * 1024 * 1024)

#if defined(CONFIG_USER_ONLY)
S
Stuart Brady 已提交
495
/* Currently it is not recommended to allocate big chunks of data in
496 497 498 499 500
   user mode. It will change when a dedicated libc will be used */
#define USE_STATIC_CODE_GEN_BUFFER
#endif

#ifdef USE_STATIC_CODE_GEN_BUFFER
501 502
static uint8_t static_code_gen_buffer[DEFAULT_CODE_GEN_BUFFER_SIZE]
               __attribute__((aligned (CODE_GEN_ALIGN)));
503 504
#endif

505
static void code_gen_alloc(unsigned long tb_size)
506
{
507 508 509 510 511
#ifdef USE_STATIC_CODE_GEN_BUFFER
    code_gen_buffer = static_code_gen_buffer;
    code_gen_buffer_size = DEFAULT_CODE_GEN_BUFFER_SIZE;
    map_exec(code_gen_buffer, code_gen_buffer_size);
#else
512 513
    code_gen_buffer_size = tb_size;
    if (code_gen_buffer_size == 0) {
514 515 516 517
#if defined(CONFIG_USER_ONLY)
        /* in user mode, phys_ram_size is not meaningful */
        code_gen_buffer_size = DEFAULT_CODE_GEN_BUFFER_SIZE;
#else
S
Stuart Brady 已提交
518
        /* XXX: needs adjustments */
P
pbrook 已提交
519
        code_gen_buffer_size = (unsigned long)(ram_size / 4);
520
#endif
521 522 523 524 525 526 527 528
    }
    if (code_gen_buffer_size < MIN_CODE_GEN_BUFFER_SIZE)
        code_gen_buffer_size = MIN_CODE_GEN_BUFFER_SIZE;
    /* The code gen buffer location may have constraints depending on
       the host cpu and OS */
#if defined(__linux__) 
    {
        int flags;
B
blueswir1 已提交
529 530
        void *start = NULL;

531 532 533 534 535 536
        flags = MAP_PRIVATE | MAP_ANONYMOUS;
#if defined(__x86_64__)
        flags |= MAP_32BIT;
        /* Cannot map more than that */
        if (code_gen_buffer_size > (800 * 1024 * 1024))
            code_gen_buffer_size = (800 * 1024 * 1024);
B
blueswir1 已提交
537 538 539 540 541 542
#elif defined(__sparc_v9__)
        // Map the buffer below 2G, so we can use direct calls and branches
        flags |= MAP_FIXED;
        start = (void *) 0x60000000UL;
        if (code_gen_buffer_size > (512 * 1024 * 1024))
            code_gen_buffer_size = (512 * 1024 * 1024);
543
#elif defined(__arm__)
B
balrog 已提交
544
        /* Map the buffer below 32M, so we can use direct calls and branches */
545 546 547 548
        flags |= MAP_FIXED;
        start = (void *) 0x01000000UL;
        if (code_gen_buffer_size > 16 * 1024 * 1024)
            code_gen_buffer_size = 16 * 1024 * 1024;
549
#endif
B
blueswir1 已提交
550 551
        code_gen_buffer = mmap(start, code_gen_buffer_size,
                               PROT_WRITE | PROT_READ | PROT_EXEC,
552 553 554 555 556 557
                               flags, -1, 0);
        if (code_gen_buffer == MAP_FAILED) {
            fprintf(stderr, "Could not allocate dynamic translator buffer\n");
            exit(1);
        }
    }
A
Aurelien Jarno 已提交
558
#elif defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
    {
        int flags;
        void *addr = NULL;
        flags = MAP_PRIVATE | MAP_ANONYMOUS;
#if defined(__x86_64__)
        /* FreeBSD doesn't have MAP_32BIT, use MAP_FIXED and assume
         * 0x40000000 is free */
        flags |= MAP_FIXED;
        addr = (void *)0x40000000;
        /* Cannot map more than that */
        if (code_gen_buffer_size > (800 * 1024 * 1024))
            code_gen_buffer_size = (800 * 1024 * 1024);
#endif
        code_gen_buffer = mmap(addr, code_gen_buffer_size,
                               PROT_WRITE | PROT_READ | PROT_EXEC, 
                               flags, -1, 0);
        if (code_gen_buffer == MAP_FAILED) {
            fprintf(stderr, "Could not allocate dynamic translator buffer\n");
            exit(1);
        }
    }
580 581 582 583
#else
    code_gen_buffer = qemu_malloc(code_gen_buffer_size);
    map_exec(code_gen_buffer, code_gen_buffer_size);
#endif
584
#endif /* !USE_STATIC_CODE_GEN_BUFFER */
585 586 587 588 589 590 591 592 593 594 595 596 597 598 599
    map_exec(code_gen_prologue, sizeof(code_gen_prologue));
    code_gen_buffer_max_size = code_gen_buffer_size - 
        code_gen_max_block_size();
    code_gen_max_blocks = code_gen_buffer_size / CODE_GEN_AVG_BLOCK_SIZE;
    tbs = qemu_malloc(code_gen_max_blocks * sizeof(TranslationBlock));
}

/* Must be called before using the QEMU cpus. 'tb_size' is the size
   (in bytes) allocated to the translation buffer. Zero means default
   size. */
void cpu_exec_init_all(unsigned long tb_size)
{
    cpu_gen_init();
    code_gen_alloc(tb_size);
    code_gen_ptr = code_gen_buffer;
600
    page_init();
601
#if !defined(CONFIG_USER_ONLY)
602
    io_mem_init();
603
#endif
604 605
}

606 607
#if defined(CPU_SAVE_VERSION) && !defined(CONFIG_USER_ONLY)

608
static int cpu_common_post_load(void *opaque, int version_id)
J
Juan Quintela 已提交
609 610
{
    CPUState *env = opaque;
611

612 613 614
    /* 0x01 was CPU_INTERRUPT_EXIT. This line can be removed when the
       version_id is increased. */
    env->interrupt_request &= ~0x01;
615 616 617 618
    tlb_flush(env, 1);

    return 0;
}
J
Juan Quintela 已提交
619 620 621 622 623 624 625 626 627 628 629 630 631

static const VMStateDescription vmstate_cpu_common = {
    .name = "cpu_common",
    .version_id = 1,
    .minimum_version_id = 1,
    .minimum_version_id_old = 1,
    .post_load = cpu_common_post_load,
    .fields      = (VMStateField []) {
        VMSTATE_UINT32(halted, CPUState),
        VMSTATE_UINT32(interrupt_request, CPUState),
        VMSTATE_END_OF_LIST()
    }
};
632 633
#endif

G
Glauber Costa 已提交
634 635 636 637 638 639 640 641 642 643 644 645 646
CPUState *qemu_get_cpu(int cpu)
{
    CPUState *env = first_cpu;

    while (env) {
        if (env->cpu_index == cpu)
            break;
        env = env->next_cpu;
    }

    return env;
}

B
bellard 已提交
647
void cpu_exec_init(CPUState *env)
B
bellard 已提交
648
{
B
bellard 已提交
649 650 651
    CPUState **penv;
    int cpu_index;

652 653 654
#if defined(CONFIG_USER_ONLY)
    cpu_list_lock();
#endif
B
bellard 已提交
655 656 657 658
    env->next_cpu = NULL;
    penv = &first_cpu;
    cpu_index = 0;
    while (*penv != NULL) {
659
        penv = &(*penv)->next_cpu;
B
bellard 已提交
660 661 662
        cpu_index++;
    }
    env->cpu_index = cpu_index;
663
    env->numa_node = 0;
B
Blue Swirl 已提交
664 665
    QTAILQ_INIT(&env->breakpoints);
    QTAILQ_INIT(&env->watchpoints);
B
bellard 已提交
666
    *penv = env;
667 668 669
#if defined(CONFIG_USER_ONLY)
    cpu_list_unlock();
#endif
670
#if defined(CPU_SAVE_VERSION) && !defined(CONFIG_USER_ONLY)
J
Juan Quintela 已提交
671
    vmstate_register(cpu_index, &vmstate_cpu_common, env);
672 673 674
    register_savevm("cpu", cpu_index, CPU_SAVE_VERSION,
                    cpu_save, cpu_load, env);
#endif
B
bellard 已提交
675 676
}

677 678 679
static inline void invalidate_page_bitmap(PageDesc *p)
{
    if (p->code_bitmap) {
680
        qemu_free(p->code_bitmap);
681 682 683 684 685
        p->code_bitmap = NULL;
    }
    p->code_write_count = 0;
}

686 687 688
/* Set to NULL all the 'first_tb' fields in all PageDescs. */

static void page_flush_tb_1 (int level, void **lp)
B
bellard 已提交
689
{
690
    int i;
B
bellard 已提交
691

692 693 694 695 696
    if (*lp == NULL) {
        return;
    }
    if (level == 0) {
        PageDesc *pd = *lp;
P
Paul Brook 已提交
697
        for (i = 0; i < L2_SIZE; ++i) {
698 699
            pd[i].first_tb = NULL;
            invalidate_page_bitmap(pd + i);
B
bellard 已提交
700
        }
701 702
    } else {
        void **pp = *lp;
P
Paul Brook 已提交
703
        for (i = 0; i < L2_SIZE; ++i) {
704 705 706 707 708 709 710 711 712 713
            page_flush_tb_1 (level - 1, pp + i);
        }
    }
}

static void page_flush_tb(void)
{
    int i;
    for (i = 0; i < V_L1_SIZE; i++) {
        page_flush_tb_1(V_L1_SHIFT / L2_BITS - 1, l1_map + i);
B
bellard 已提交
714 715 716 717
    }
}

/* flush all the translation blocks */
B
bellard 已提交
718
/* XXX: tb_flush is currently not thread safe */
B
bellard 已提交
719
void tb_flush(CPUState *env1)
B
bellard 已提交
720
{
B
bellard 已提交
721
    CPUState *env;
722
#if defined(DEBUG_FLUSH)
B
blueswir1 已提交
723 724 725 726
    printf("qemu: flush code_size=%ld nb_tbs=%d avg_tb_size=%ld\n",
           (unsigned long)(code_gen_ptr - code_gen_buffer),
           nb_tbs, nb_tbs > 0 ?
           ((unsigned long)(code_gen_ptr - code_gen_buffer)) / nb_tbs : 0);
B
bellard 已提交
727
#endif
728
    if ((unsigned long)(code_gen_ptr - code_gen_buffer) > code_gen_buffer_size)
P
pbrook 已提交
729 730
        cpu_abort(env1, "Internal error: code buffer overflow\n");

B
bellard 已提交
731
    nb_tbs = 0;
732

B
bellard 已提交
733 734 735
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
        memset (env->tb_jmp_cache, 0, TB_JMP_CACHE_SIZE * sizeof (void *));
    }
736

B
bellard 已提交
737
    memset (tb_phys_hash, 0, CODE_GEN_PHYS_HASH_SIZE * sizeof (void *));
B
bellard 已提交
738
    page_flush_tb();
739

B
bellard 已提交
740
    code_gen_ptr = code_gen_buffer;
B
bellard 已提交
741 742
    /* XXX: flush processor icache at this point if cache flush is
       expensive */
B
bellard 已提交
743
    tb_flush_count++;
B
bellard 已提交
744 745 746 747
}

#ifdef DEBUG_TB_CHECK

J
j_mayer 已提交
748
static void tb_invalidate_check(target_ulong address)
B
bellard 已提交
749 750 751 752
{
    TranslationBlock *tb;
    int i;
    address &= TARGET_PAGE_MASK;
753 754
    for(i = 0;i < CODE_GEN_PHYS_HASH_SIZE; i++) {
        for(tb = tb_phys_hash[i]; tb != NULL; tb = tb->phys_hash_next) {
B
bellard 已提交
755 756
            if (!(address + TARGET_PAGE_SIZE <= tb->pc ||
                  address >= tb->pc + tb->size)) {
757 758
                printf("ERROR invalidate: address=" TARGET_FMT_lx
                       " PC=%08lx size=%04x\n",
759
                       address, (long)tb->pc, tb->size);
B
bellard 已提交
760 761 762 763 764 765 766 767 768 769
            }
        }
    }
}

/* verify that all the pages have correct rights for code */
static void tb_page_check(void)
{
    TranslationBlock *tb;
    int i, flags1, flags2;
770

771 772
    for(i = 0;i < CODE_GEN_PHYS_HASH_SIZE; i++) {
        for(tb = tb_phys_hash[i]; tb != NULL; tb = tb->phys_hash_next) {
B
bellard 已提交
773 774 775 776
            flags1 = page_get_flags(tb->pc);
            flags2 = page_get_flags(tb->pc + tb->size - 1);
            if ((flags1 & PAGE_WRITE) || (flags2 & PAGE_WRITE)) {
                printf("ERROR page flags: PC=%08lx size=%04x f1=%x f2=%x\n",
777
                       (long)tb->pc, tb->size, flags1, flags2);
B
bellard 已提交
778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
            }
        }
    }
}

#endif

/* invalidate one TB */
static inline void tb_remove(TranslationBlock **ptb, TranslationBlock *tb,
                             int next_offset)
{
    TranslationBlock *tb1;
    for(;;) {
        tb1 = *ptb;
        if (tb1 == tb) {
            *ptb = *(TranslationBlock **)((char *)tb1 + next_offset);
            break;
        }
        ptb = (TranslationBlock **)((char *)tb1 + next_offset);
    }
}

800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816
static inline void tb_page_remove(TranslationBlock **ptb, TranslationBlock *tb)
{
    TranslationBlock *tb1;
    unsigned int n1;

    for(;;) {
        tb1 = *ptb;
        n1 = (long)tb1 & 3;
        tb1 = (TranslationBlock *)((long)tb1 & ~3);
        if (tb1 == tb) {
            *ptb = tb1->page_next[n1];
            break;
        }
        ptb = &tb1->page_next[n1];
    }
}

B
bellard 已提交
817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851
static inline void tb_jmp_remove(TranslationBlock *tb, int n)
{
    TranslationBlock *tb1, **ptb;
    unsigned int n1;

    ptb = &tb->jmp_next[n];
    tb1 = *ptb;
    if (tb1) {
        /* find tb(n) in circular list */
        for(;;) {
            tb1 = *ptb;
            n1 = (long)tb1 & 3;
            tb1 = (TranslationBlock *)((long)tb1 & ~3);
            if (n1 == n && tb1 == tb)
                break;
            if (n1 == 2) {
                ptb = &tb1->jmp_first;
            } else {
                ptb = &tb1->jmp_next[n1];
            }
        }
        /* now we can suppress tb(n) from the list */
        *ptb = tb->jmp_next[n];

        tb->jmp_next[n] = NULL;
    }
}

/* reset the jump entry 'n' of a TB so that it is not chained to
   another TB */
static inline void tb_reset_jump(TranslationBlock *tb, int n)
{
    tb_set_jmp_target(tb, n, (unsigned long)(tb->tc_ptr + tb->tb_next_offset[n]));
}

P
Paul Brook 已提交
852
void tb_phys_invalidate(TranslationBlock *tb, tb_page_addr_t page_addr)
B
bellard 已提交
853
{
B
bellard 已提交
854
    CPUState *env;
855
    PageDesc *p;
B
bellard 已提交
856
    unsigned int h, n1;
P
Paul Brook 已提交
857
    tb_page_addr_t phys_pc;
858
    TranslationBlock *tb1, *tb2;
859

860 861 862
    /* remove the TB from the hash list */
    phys_pc = tb->page_addr[0] + (tb->pc & ~TARGET_PAGE_MASK);
    h = tb_phys_hash_func(phys_pc);
863
    tb_remove(&tb_phys_hash[h], tb,
864 865 866 867 868 869 870 871 872 873 874 875 876 877
              offsetof(TranslationBlock, phys_hash_next));

    /* remove the TB from the page list */
    if (tb->page_addr[0] != page_addr) {
        p = page_find(tb->page_addr[0] >> TARGET_PAGE_BITS);
        tb_page_remove(&p->first_tb, tb);
        invalidate_page_bitmap(p);
    }
    if (tb->page_addr[1] != -1 && tb->page_addr[1] != page_addr) {
        p = page_find(tb->page_addr[1] >> TARGET_PAGE_BITS);
        tb_page_remove(&p->first_tb, tb);
        invalidate_page_bitmap(p);
    }

878
    tb_invalidated_flag = 1;
879

B
bellard 已提交
880
    /* remove the TB from the hash list */
881
    h = tb_jmp_cache_hash_func(tb->pc);
B
bellard 已提交
882 883 884 885
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
        if (env->tb_jmp_cache[h] == tb)
            env->tb_jmp_cache[h] = NULL;
    }
B
bellard 已提交
886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903

    /* suppress this TB from the two jump lists */
    tb_jmp_remove(tb, 0);
    tb_jmp_remove(tb, 1);

    /* suppress any remaining jumps to this TB */
    tb1 = tb->jmp_first;
    for(;;) {
        n1 = (long)tb1 & 3;
        if (n1 == 2)
            break;
        tb1 = (TranslationBlock *)((long)tb1 & ~3);
        tb2 = tb1->jmp_next[n1];
        tb_reset_jump(tb1, n1);
        tb1->jmp_next[n1] = NULL;
        tb1 = tb2;
    }
    tb->jmp_first = (TranslationBlock *)((long)tb | 2); /* fail safe */
904

B
bellard 已提交
905
    tb_phys_invalidate_count++;
906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
}

static inline void set_bits(uint8_t *tab, int start, int len)
{
    int end, mask, end1;

    end = start + len;
    tab += start >> 3;
    mask = 0xff << (start & 7);
    if ((start & ~7) == (end & ~7)) {
        if (start < end) {
            mask &= ~(0xff << (end & 7));
            *tab |= mask;
        }
    } else {
        *tab++ |= mask;
        start = (start + 8) & ~7;
        end1 = end & ~7;
        while (start < end1) {
            *tab++ = 0xff;
            start += 8;
        }
        if (start < end) {
            mask = ~(0xff << (end & 7));
            *tab |= mask;
        }
    }
}

static void build_page_bitmap(PageDesc *p)
{
    int n, tb_start, tb_end;
    TranslationBlock *tb;
939

P
pbrook 已提交
940
    p->code_bitmap = qemu_mallocz(TARGET_PAGE_SIZE / 8);
941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962

    tb = p->first_tb;
    while (tb != NULL) {
        n = (long)tb & 3;
        tb = (TranslationBlock *)((long)tb & ~3);
        /* NOTE: this is subtle as a TB may span two physical pages */
        if (n == 0) {
            /* NOTE: tb_end may be after the end of the page, but
               it is not a problem */
            tb_start = tb->pc & ~TARGET_PAGE_MASK;
            tb_end = tb_start + tb->size;
            if (tb_end > TARGET_PAGE_SIZE)
                tb_end = TARGET_PAGE_SIZE;
        } else {
            tb_start = 0;
            tb_end = ((tb->pc + tb->size) & ~TARGET_PAGE_MASK);
        }
        set_bits(p->code_bitmap, tb_start, tb_end - tb_start);
        tb = tb->page_next[n];
    }
}

P
pbrook 已提交
963 964 965
TranslationBlock *tb_gen_code(CPUState *env,
                              target_ulong pc, target_ulong cs_base,
                              int flags, int cflags)
B
bellard 已提交
966 967 968
{
    TranslationBlock *tb;
    uint8_t *tc_ptr;
P
Paul Brook 已提交
969 970
    tb_page_addr_t phys_pc, phys_page2;
    target_ulong virt_page2;
B
bellard 已提交
971 972
    int code_gen_size;

P
Paul Brook 已提交
973
    phys_pc = get_page_addr_code(env, pc);
B
bellard 已提交
974
    tb = tb_alloc(pc);
B
bellard 已提交
975 976 977 978
    if (!tb) {
        /* flush must be done */
        tb_flush(env);
        /* cannot fail at this point */
B
bellard 已提交
979
        tb = tb_alloc(pc);
P
pbrook 已提交
980 981
        /* Don't forget to invalidate previous TB info.  */
        tb_invalidated_flag = 1;
B
bellard 已提交
982 983 984 985 986 987
    }
    tc_ptr = code_gen_ptr;
    tb->tc_ptr = tc_ptr;
    tb->cs_base = cs_base;
    tb->flags = flags;
    tb->cflags = cflags;
988
    cpu_gen_code(env, tb, &code_gen_size);
B
bellard 已提交
989
    code_gen_ptr = (void *)(((unsigned long)code_gen_ptr + code_gen_size + CODE_GEN_ALIGN - 1) & ~(CODE_GEN_ALIGN - 1));
990

B
bellard 已提交
991
    /* check next page if needed */
B
bellard 已提交
992
    virt_page2 = (pc + tb->size - 1) & TARGET_PAGE_MASK;
B
bellard 已提交
993
    phys_page2 = -1;
B
bellard 已提交
994
    if ((pc & TARGET_PAGE_MASK) != virt_page2) {
P
Paul Brook 已提交
995
        phys_page2 = get_page_addr_code(env, virt_page2);
B
bellard 已提交
996
    }
P
Paul Brook 已提交
997
    tb_link_page(tb, phys_pc, phys_page2);
P
pbrook 已提交
998
    return tb;
B
bellard 已提交
999
}
1000

1001 1002
/* invalidate all TBs which intersect with the target physical page
   starting in range [start;end[. NOTE: start and end must refer to
B
bellard 已提交
1003 1004 1005
   the same physical page. 'is_cpu_write_access' should be true if called
   from a real cpu write access: the virtual CPU will exit the current
   TB if code is modified inside this TB. */
P
Paul Brook 已提交
1006
void tb_invalidate_phys_page_range(tb_page_addr_t start, tb_page_addr_t end,
B
bellard 已提交
1007 1008
                                   int is_cpu_write_access)
{
1009
    TranslationBlock *tb, *tb_next, *saved_tb;
B
bellard 已提交
1010
    CPUState *env = cpu_single_env;
P
Paul Brook 已提交
1011
    tb_page_addr_t tb_start, tb_end;
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
    PageDesc *p;
    int n;
#ifdef TARGET_HAS_PRECISE_SMC
    int current_tb_not_found = is_cpu_write_access;
    TranslationBlock *current_tb = NULL;
    int current_tb_modified = 0;
    target_ulong current_pc = 0;
    target_ulong current_cs_base = 0;
    int current_flags = 0;
#endif /* TARGET_HAS_PRECISE_SMC */
1022 1023

    p = page_find(start >> TARGET_PAGE_BITS);
1024
    if (!p)
1025
        return;
1026
    if (!p->code_bitmap &&
B
bellard 已提交
1027 1028
        ++p->code_write_count >= SMC_BITMAP_USE_THRESHOLD &&
        is_cpu_write_access) {
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050
        /* build code bitmap */
        build_page_bitmap(p);
    }

    /* we remove all the TBs in the range [start, end[ */
    /* XXX: see if in some cases it could be faster to invalidate all the code */
    tb = p->first_tb;
    while (tb != NULL) {
        n = (long)tb & 3;
        tb = (TranslationBlock *)((long)tb & ~3);
        tb_next = tb->page_next[n];
        /* NOTE: this is subtle as a TB may span two physical pages */
        if (n == 0) {
            /* NOTE: tb_end may be after the end of the page, but
               it is not a problem */
            tb_start = tb->page_addr[0] + (tb->pc & ~TARGET_PAGE_MASK);
            tb_end = tb_start + tb->size;
        } else {
            tb_start = tb->page_addr[1];
            tb_end = tb_start + ((tb->pc + tb->size) & ~TARGET_PAGE_MASK);
        }
        if (!(tb_end <= start || tb_start >= end)) {
B
bellard 已提交
1051 1052 1053 1054
#ifdef TARGET_HAS_PRECISE_SMC
            if (current_tb_not_found) {
                current_tb_not_found = 0;
                current_tb = NULL;
P
pbrook 已提交
1055
                if (env->mem_io_pc) {
B
bellard 已提交
1056
                    /* now we have a real cpu fault */
P
pbrook 已提交
1057
                    current_tb = tb_find_pc(env->mem_io_pc);
B
bellard 已提交
1058 1059 1060
                }
            }
            if (current_tb == tb &&
P
pbrook 已提交
1061
                (current_tb->cflags & CF_COUNT_MASK) != 1) {
B
bellard 已提交
1062 1063 1064 1065 1066
                /* If we are modifying the current TB, we must stop
                its execution. We could be more precise by checking
                that the modification is after the current PC, but it
                would require a specialized function to partially
                restore the CPU state */
1067

B
bellard 已提交
1068
                current_tb_modified = 1;
1069
                cpu_restore_state(current_tb, env,
P
pbrook 已提交
1070
                                  env->mem_io_pc, NULL);
1071 1072
                cpu_get_tb_cpu_state(env, &current_pc, &current_cs_base,
                                     &current_flags);
B
bellard 已提交
1073 1074
            }
#endif /* TARGET_HAS_PRECISE_SMC */
1075 1076 1077 1078 1079 1080 1081
            /* we need to do that to handle the case where a signal
               occurs while doing tb_phys_invalidate() */
            saved_tb = NULL;
            if (env) {
                saved_tb = env->current_tb;
                env->current_tb = NULL;
            }
1082
            tb_phys_invalidate(tb, -1);
1083 1084 1085 1086 1087
            if (env) {
                env->current_tb = saved_tb;
                if (env->interrupt_request && env->current_tb)
                    cpu_interrupt(env, env->interrupt_request);
            }
1088 1089 1090 1091 1092 1093 1094
        }
        tb = tb_next;
    }
#if !defined(CONFIG_USER_ONLY)
    /* if no code remaining, no need to continue to use slow writes */
    if (!p->first_tb) {
        invalidate_page_bitmap(p);
B
bellard 已提交
1095
        if (is_cpu_write_access) {
P
pbrook 已提交
1096
            tlb_unprotect_code_phys(env, start, env->mem_io_vaddr);
B
bellard 已提交
1097 1098 1099 1100 1101 1102 1103 1104
        }
    }
#endif
#ifdef TARGET_HAS_PRECISE_SMC
    if (current_tb_modified) {
        /* we generate a block containing just the instruction
           modifying the memory. It will ensure that it cannot modify
           itself */
1105
        env->current_tb = NULL;
P
pbrook 已提交
1106
        tb_gen_code(env, current_pc, current_cs_base, current_flags, 1);
B
bellard 已提交
1107
        cpu_resume_from_signal(env, NULL);
1108
    }
B
bellard 已提交
1109
#endif
1110
}
B
bellard 已提交
1111

1112
/* len must be <= 8 and start must be a multiple of len */
P
Paul Brook 已提交
1113
static inline void tb_invalidate_phys_page_fast(tb_page_addr_t start, int len)
1114 1115 1116
{
    PageDesc *p;
    int offset, b;
1117
#if 0
B
bellard 已提交
1118
    if (1) {
1119 1120 1121 1122
        qemu_log("modifying code at 0x%x size=%d EIP=%x PC=%08x\n",
                  cpu_single_env->mem_io_vaddr, len,
                  cpu_single_env->eip,
                  cpu_single_env->eip + (long)cpu_single_env->segs[R_CS].base);
1123 1124
    }
#endif
1125
    p = page_find(start >> TARGET_PAGE_BITS);
1126
    if (!p)
1127 1128 1129 1130 1131 1132 1133 1134
        return;
    if (p->code_bitmap) {
        offset = start & ~TARGET_PAGE_MASK;
        b = p->code_bitmap[offset >> 3] >> (offset & 7);
        if (b & ((1 << len) - 1))
            goto do_invalidate;
    } else {
    do_invalidate:
B
bellard 已提交
1135
        tb_invalidate_phys_page_range(start, start + len, 1);
1136 1137 1138 1139
    }
}

#if !defined(CONFIG_SOFTMMU)
P
Paul Brook 已提交
1140
static void tb_invalidate_phys_page(tb_page_addr_t addr,
B
bellard 已提交
1141
                                    unsigned long pc, void *puc)
1142
{
1143
    TranslationBlock *tb;
1144
    PageDesc *p;
1145
    int n;
B
bellard 已提交
1146
#ifdef TARGET_HAS_PRECISE_SMC
1147
    TranslationBlock *current_tb = NULL;
B
bellard 已提交
1148
    CPUState *env = cpu_single_env;
1149 1150 1151 1152
    int current_tb_modified = 0;
    target_ulong current_pc = 0;
    target_ulong current_cs_base = 0;
    int current_flags = 0;
B
bellard 已提交
1153
#endif
1154 1155 1156

    addr &= TARGET_PAGE_MASK;
    p = page_find(addr >> TARGET_PAGE_BITS);
1157
    if (!p)
1158 1159
        return;
    tb = p->first_tb;
B
bellard 已提交
1160 1161 1162 1163 1164
#ifdef TARGET_HAS_PRECISE_SMC
    if (tb && pc != 0) {
        current_tb = tb_find_pc(pc);
    }
#endif
1165 1166 1167
    while (tb != NULL) {
        n = (long)tb & 3;
        tb = (TranslationBlock *)((long)tb & ~3);
B
bellard 已提交
1168 1169
#ifdef TARGET_HAS_PRECISE_SMC
        if (current_tb == tb &&
P
pbrook 已提交
1170
            (current_tb->cflags & CF_COUNT_MASK) != 1) {
B
bellard 已提交
1171 1172 1173 1174 1175
                /* If we are modifying the current TB, we must stop
                   its execution. We could be more precise by checking
                   that the modification is after the current PC, but it
                   would require a specialized function to partially
                   restore the CPU state */
1176

B
bellard 已提交
1177 1178
            current_tb_modified = 1;
            cpu_restore_state(current_tb, env, pc, puc);
1179 1180
            cpu_get_tb_cpu_state(env, &current_pc, &current_cs_base,
                                 &current_flags);
B
bellard 已提交
1181 1182
        }
#endif /* TARGET_HAS_PRECISE_SMC */
1183 1184 1185
        tb_phys_invalidate(tb, addr);
        tb = tb->page_next[n];
    }
B
bellard 已提交
1186
    p->first_tb = NULL;
B
bellard 已提交
1187 1188 1189 1190 1191
#ifdef TARGET_HAS_PRECISE_SMC
    if (current_tb_modified) {
        /* we generate a block containing just the instruction
           modifying the memory. It will ensure that it cannot modify
           itself */
1192
        env->current_tb = NULL;
P
pbrook 已提交
1193
        tb_gen_code(env, current_pc, current_cs_base, current_flags, 1);
B
bellard 已提交
1194 1195 1196
        cpu_resume_from_signal(env, puc);
    }
#endif
B
bellard 已提交
1197
}
1198
#endif
B
bellard 已提交
1199 1200

/* add the tb in the target page and protect it if necessary */
1201
static inline void tb_alloc_page(TranslationBlock *tb,
P
Paul Brook 已提交
1202
                                 unsigned int n, tb_page_addr_t page_addr)
B
bellard 已提交
1203 1204
{
    PageDesc *p;
1205 1206 1207
    TranslationBlock *last_first_tb;

    tb->page_addr[n] = page_addr;
1208
    p = page_find_alloc(page_addr >> TARGET_PAGE_BITS, 1);
1209 1210 1211 1212
    tb->page_next[n] = p->first_tb;
    last_first_tb = p->first_tb;
    p->first_tb = (TranslationBlock *)((long)tb | n);
    invalidate_page_bitmap(p);
B
bellard 已提交
1213

1214
#if defined(TARGET_HAS_SMC) || 1
B
bellard 已提交
1215

1216
#if defined(CONFIG_USER_ONLY)
B
bellard 已提交
1217
    if (p->flags & PAGE_WRITE) {
1218 1219
        target_ulong addr;
        PageDesc *p2;
1220 1221
        int prot;

B
bellard 已提交
1222 1223
        /* force the host page as non writable (writes will have a
           page fault + mprotect overhead) */
1224
        page_addr &= qemu_host_page_mask;
B
bellard 已提交
1225
        prot = 0;
1226 1227 1228 1229 1230 1231 1232 1233 1234
        for(addr = page_addr; addr < page_addr + qemu_host_page_size;
            addr += TARGET_PAGE_SIZE) {

            p2 = page_find (addr >> TARGET_PAGE_BITS);
            if (!p2)
                continue;
            prot |= p2->flags;
            p2->flags &= ~PAGE_WRITE;
          }
1235
        mprotect(g2h(page_addr), qemu_host_page_size,
B
bellard 已提交
1236 1237
                 (prot & PAGE_BITS) & ~PAGE_WRITE);
#ifdef DEBUG_TB_INVALIDATE
B
blueswir1 已提交
1238
        printf("protecting code page: 0x" TARGET_FMT_lx "\n",
1239
               page_addr);
B
bellard 已提交
1240 1241
#endif
    }
1242 1243 1244 1245 1246
#else
    /* if some code is already present, then the pages are already
       protected. So we handle the case where only the first TB is
       allocated in a physical page */
    if (!last_first_tb) {
B
bellard 已提交
1247
        tlb_protect_code(page_addr);
1248 1249
    }
#endif
B
bellard 已提交
1250 1251

#endif /* TARGET_HAS_SMC */
B
bellard 已提交
1252 1253 1254 1255
}

/* Allocate a new translation block. Flush the translation buffer if
   too many translation blocks or too much generated code. */
B
bellard 已提交
1256
TranslationBlock *tb_alloc(target_ulong pc)
B
bellard 已提交
1257 1258 1259
{
    TranslationBlock *tb;

1260 1261
    if (nb_tbs >= code_gen_max_blocks ||
        (code_gen_ptr - code_gen_buffer) >= code_gen_buffer_max_size)
B
bellard 已提交
1262
        return NULL;
B
bellard 已提交
1263 1264
    tb = &tbs[nb_tbs++];
    tb->pc = pc;
1265
    tb->cflags = 0;
B
bellard 已提交
1266 1267 1268
    return tb;
}

P
pbrook 已提交
1269 1270
void tb_free(TranslationBlock *tb)
{
T
ths 已提交
1271
    /* In practice this is mostly used for single use temporary TB
P
pbrook 已提交
1272 1273 1274 1275 1276 1277 1278 1279
       Ignore the hard cases and just back up if this TB happens to
       be the last one generated.  */
    if (nb_tbs > 0 && tb == &tbs[nb_tbs - 1]) {
        code_gen_ptr = tb->tc_ptr;
        nb_tbs--;
    }
}

1280 1281
/* add a new TB and link it to the physical page tables. phys_page2 is
   (-1) to indicate that only one page contains the TB. */
P
Paul Brook 已提交
1282 1283
void tb_link_page(TranslationBlock *tb,
                  tb_page_addr_t phys_pc, tb_page_addr_t phys_page2)
B
bellard 已提交
1284
{
1285 1286 1287
    unsigned int h;
    TranslationBlock **ptb;

P
pbrook 已提交
1288 1289 1290
    /* Grab the mmap lock to stop another thread invalidating this TB
       before we are done.  */
    mmap_lock();
1291 1292 1293 1294 1295
    /* add in the physical hash table */
    h = tb_phys_hash_func(phys_pc);
    ptb = &tb_phys_hash[h];
    tb->phys_hash_next = *ptb;
    *ptb = tb;
B
bellard 已提交
1296 1297

    /* add in the page list */
1298 1299 1300 1301 1302 1303
    tb_alloc_page(tb, 0, phys_pc & TARGET_PAGE_MASK);
    if (phys_page2 != -1)
        tb_alloc_page(tb, 1, phys_page2);
    else
        tb->page_addr[1] = -1;

B
bellard 已提交
1304 1305 1306 1307 1308 1309 1310 1311 1312
    tb->jmp_first = (TranslationBlock *)((long)tb | 2);
    tb->jmp_next[0] = NULL;
    tb->jmp_next[1] = NULL;

    /* init original jump addresses */
    if (tb->tb_next_offset[0] != 0xffff)
        tb_reset_jump(tb, 0);
    if (tb->tb_next_offset[1] != 0xffff)
        tb_reset_jump(tb, 1);
1313 1314 1315 1316

#ifdef DEBUG_TB_CHECK
    tb_page_check();
#endif
P
pbrook 已提交
1317
    mmap_unlock();
B
bellard 已提交
1318 1319
}

1320 1321 1322
/* find the TB 'tb' such that tb[0].tc_ptr <= tc_ptr <
   tb[1].tc_ptr. Return NULL if not found */
TranslationBlock *tb_find_pc(unsigned long tc_ptr)
B
bellard 已提交
1323
{
1324 1325 1326
    int m_min, m_max, m;
    unsigned long v;
    TranslationBlock *tb;
B
bellard 已提交
1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346

    if (nb_tbs <= 0)
        return NULL;
    if (tc_ptr < (unsigned long)code_gen_buffer ||
        tc_ptr >= (unsigned long)code_gen_ptr)
        return NULL;
    /* binary search (cf Knuth) */
    m_min = 0;
    m_max = nb_tbs - 1;
    while (m_min <= m_max) {
        m = (m_min + m_max) >> 1;
        tb = &tbs[m];
        v = (unsigned long)tb->tc_ptr;
        if (v == tc_ptr)
            return tb;
        else if (tc_ptr < v) {
            m_max = m - 1;
        } else {
            m_min = m + 1;
        }
1347
    }
B
bellard 已提交
1348 1349
    return &tbs[m_max];
}
B
bellard 已提交
1350

B
bellard 已提交
1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
static void tb_reset_jump_recursive(TranslationBlock *tb);

static inline void tb_reset_jump_recursive2(TranslationBlock *tb, int n)
{
    TranslationBlock *tb1, *tb_next, **ptb;
    unsigned int n1;

    tb1 = tb->jmp_next[n];
    if (tb1 != NULL) {
        /* find head of list */
        for(;;) {
            n1 = (long)tb1 & 3;
            tb1 = (TranslationBlock *)((long)tb1 & ~3);
            if (n1 == 2)
                break;
            tb1 = tb1->jmp_next[n1];
        }
        /* we are now sure now that tb jumps to tb1 */
        tb_next = tb1;

        /* remove tb from the jmp_first list */
        ptb = &tb_next->jmp_first;
        for(;;) {
            tb1 = *ptb;
            n1 = (long)tb1 & 3;
            tb1 = (TranslationBlock *)((long)tb1 & ~3);
            if (n1 == n && tb1 == tb)
                break;
            ptb = &tb1->jmp_next[n1];
        }
        *ptb = tb->jmp_next[n];
        tb->jmp_next[n] = NULL;
1383

B
bellard 已提交
1384 1385 1386
        /* suppress the jump to next tb in generated code */
        tb_reset_jump(tb, n);

1387
        /* suppress jumps in the tb on which we could have jumped */
B
bellard 已提交
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397
        tb_reset_jump_recursive(tb_next);
    }
}

static void tb_reset_jump_recursive(TranslationBlock *tb)
{
    tb_reset_jump_recursive2(tb, 0);
    tb_reset_jump_recursive2(tb, 1);
}

B
bellard 已提交
1398
#if defined(TARGET_HAS_ICE)
1399 1400 1401 1402 1403 1404
#if defined(CONFIG_USER_ONLY)
static void breakpoint_invalidate(CPUState *env, target_ulong pc)
{
    tb_invalidate_phys_page_range(pc, pc + 1, 0);
}
#else
B
bellard 已提交
1405 1406
static void breakpoint_invalidate(CPUState *env, target_ulong pc)
{
A
Anthony Liguori 已提交
1407
    target_phys_addr_t addr;
1408
    target_ulong pd;
A
Anthony Liguori 已提交
1409
    ram_addr_t ram_addr;
P
pbrook 已提交
1410
    PhysPageDesc *p;
B
bellard 已提交
1411

P
pbrook 已提交
1412 1413 1414 1415 1416 1417 1418 1419
    addr = cpu_get_phys_page_debug(env, pc);
    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
    ram_addr = (pd & TARGET_PAGE_MASK) | (pc & ~TARGET_PAGE_MASK);
P
pbrook 已提交
1420
    tb_invalidate_phys_page_range(ram_addr, ram_addr + 1, 0);
B
bellard 已提交
1421
}
B
bellard 已提交
1422
#endif
1423
#endif /* TARGET_HAS_ICE */
B
bellard 已提交
1424

1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
#if defined(CONFIG_USER_ONLY)
void cpu_watchpoint_remove_all(CPUState *env, int mask)

{
}

int cpu_watchpoint_insert(CPUState *env, target_ulong addr, target_ulong len,
                          int flags, CPUWatchpoint **watchpoint)
{
    return -ENOSYS;
}
#else
1437
/* Add a watchpoint.  */
1438 1439
int cpu_watchpoint_insert(CPUState *env, target_ulong addr, target_ulong len,
                          int flags, CPUWatchpoint **watchpoint)
1440
{
1441
    target_ulong len_mask = ~(len - 1);
1442
    CPUWatchpoint *wp;
1443

1444 1445 1446 1447 1448 1449
    /* sanity checks: allow power-of-2 lengths, deny unaligned watchpoints */
    if ((len != 1 && len != 2 && len != 4 && len != 8) || (addr & ~len_mask)) {
        fprintf(stderr, "qemu: tried to set invalid watchpoint at "
                TARGET_FMT_lx ", len=" TARGET_FMT_lu "\n", addr, len);
        return -EINVAL;
    }
1450 1451 1452
    wp = qemu_malloc(sizeof(*wp));

    wp->vaddr = addr;
1453
    wp->len_mask = len_mask;
1454 1455
    wp->flags = flags;

1456
    /* keep all GDB-injected watchpoints in front */
1457
    if (flags & BP_GDB)
B
Blue Swirl 已提交
1458
        QTAILQ_INSERT_HEAD(&env->watchpoints, wp, entry);
1459
    else
B
Blue Swirl 已提交
1460
        QTAILQ_INSERT_TAIL(&env->watchpoints, wp, entry);
1461 1462

    tlb_flush_page(env, addr);
1463 1464 1465 1466

    if (watchpoint)
        *watchpoint = wp;
    return 0;
1467 1468
}

1469 1470 1471
/* Remove a specific watchpoint.  */
int cpu_watchpoint_remove(CPUState *env, target_ulong addr, target_ulong len,
                          int flags)
1472
{
1473
    target_ulong len_mask = ~(len - 1);
1474
    CPUWatchpoint *wp;
1475

B
Blue Swirl 已提交
1476
    QTAILQ_FOREACH(wp, &env->watchpoints, entry) {
1477
        if (addr == wp->vaddr && len_mask == wp->len_mask
1478
                && flags == (wp->flags & ~BP_WATCHPOINT_HIT)) {
1479
            cpu_watchpoint_remove_by_ref(env, wp);
1480 1481 1482
            return 0;
        }
    }
1483
    return -ENOENT;
1484 1485
}

1486 1487 1488
/* Remove a specific watchpoint by reference.  */
void cpu_watchpoint_remove_by_ref(CPUState *env, CPUWatchpoint *watchpoint)
{
B
Blue Swirl 已提交
1489
    QTAILQ_REMOVE(&env->watchpoints, watchpoint, entry);
1490

1491 1492 1493 1494 1495 1496 1497 1498
    tlb_flush_page(env, watchpoint->vaddr);

    qemu_free(watchpoint);
}

/* Remove all matching watchpoints.  */
void cpu_watchpoint_remove_all(CPUState *env, int mask)
{
1499
    CPUWatchpoint *wp, *next;
1500

B
Blue Swirl 已提交
1501
    QTAILQ_FOREACH_SAFE(wp, &env->watchpoints, entry, next) {
1502 1503
        if (wp->flags & mask)
            cpu_watchpoint_remove_by_ref(env, wp);
1504
    }
1505
}
1506
#endif
1507

1508 1509 1510
/* Add a breakpoint.  */
int cpu_breakpoint_insert(CPUState *env, target_ulong pc, int flags,
                          CPUBreakpoint **breakpoint)
B
bellard 已提交
1511
{
B
bellard 已提交
1512
#if defined(TARGET_HAS_ICE)
1513
    CPUBreakpoint *bp;
1514

1515
    bp = qemu_malloc(sizeof(*bp));
B
bellard 已提交
1516

1517 1518 1519
    bp->pc = pc;
    bp->flags = flags;

1520
    /* keep all GDB-injected breakpoints in front */
1521
    if (flags & BP_GDB)
B
Blue Swirl 已提交
1522
        QTAILQ_INSERT_HEAD(&env->breakpoints, bp, entry);
1523
    else
B
Blue Swirl 已提交
1524
        QTAILQ_INSERT_TAIL(&env->breakpoints, bp, entry);
1525

B
bellard 已提交
1526
    breakpoint_invalidate(env, pc);
1527 1528 1529

    if (breakpoint)
        *breakpoint = bp;
B
bellard 已提交
1530 1531
    return 0;
#else
1532
    return -ENOSYS;
B
bellard 已提交
1533 1534 1535
#endif
}

1536 1537 1538
/* Remove a specific breakpoint.  */
int cpu_breakpoint_remove(CPUState *env, target_ulong pc, int flags)
{
1539
#if defined(TARGET_HAS_ICE)
1540 1541
    CPUBreakpoint *bp;

B
Blue Swirl 已提交
1542
    QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
1543 1544 1545 1546
        if (bp->pc == pc && bp->flags == flags) {
            cpu_breakpoint_remove_by_ref(env, bp);
            return 0;
        }
1547
    }
1548 1549 1550
    return -ENOENT;
#else
    return -ENOSYS;
1551 1552 1553
#endif
}

1554 1555
/* Remove a specific breakpoint by reference.  */
void cpu_breakpoint_remove_by_ref(CPUState *env, CPUBreakpoint *breakpoint)
B
bellard 已提交
1556
{
B
bellard 已提交
1557
#if defined(TARGET_HAS_ICE)
B
Blue Swirl 已提交
1558
    QTAILQ_REMOVE(&env->breakpoints, breakpoint, entry);
B
bellard 已提交
1559

1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
    breakpoint_invalidate(env, breakpoint->pc);

    qemu_free(breakpoint);
#endif
}

/* Remove all matching breakpoints. */
void cpu_breakpoint_remove_all(CPUState *env, int mask)
{
#if defined(TARGET_HAS_ICE)
1570
    CPUBreakpoint *bp, *next;
1571

B
Blue Swirl 已提交
1572
    QTAILQ_FOREACH_SAFE(bp, &env->breakpoints, entry, next) {
1573 1574
        if (bp->flags & mask)
            cpu_breakpoint_remove_by_ref(env, bp);
1575
    }
B
bellard 已提交
1576 1577 1578
#endif
}

B
bellard 已提交
1579 1580 1581 1582
/* enable or disable single step mode. EXCP_DEBUG is returned by the
   CPU loop after each instruction */
void cpu_single_step(CPUState *env, int enabled)
{
B
bellard 已提交
1583
#if defined(TARGET_HAS_ICE)
B
bellard 已提交
1584 1585
    if (env->singlestep_enabled != enabled) {
        env->singlestep_enabled = enabled;
1586 1587 1588
        if (kvm_enabled())
            kvm_update_guest_debug(env, 0);
        else {
S
Stuart Brady 已提交
1589
            /* must flush all the translated code to avoid inconsistencies */
1590 1591 1592
            /* XXX: only flush what is necessary */
            tb_flush(env);
        }
B
bellard 已提交
1593 1594 1595 1596
    }
#endif
}

1597 1598 1599 1600 1601
/* enable or disable low levels log */
void cpu_set_log(int log_flags)
{
    loglevel = log_flags;
    if (loglevel && !logfile) {
P
pbrook 已提交
1602
        logfile = fopen(logfilename, log_append ? "a" : "w");
1603 1604 1605 1606
        if (!logfile) {
            perror(logfilename);
            _exit(1);
        }
1607 1608 1609
#if !defined(CONFIG_SOFTMMU)
        /* must avoid mmap() usage of glibc by setting a buffer "by hand" */
        {
1610
            static char logfile_buf[4096];
1611 1612
            setvbuf(logfile, logfile_buf, _IOLBF, sizeof(logfile_buf));
        }
1613 1614
#elif !defined(_WIN32)
        /* Win32 doesn't support line-buffering and requires size >= 2 */
1615
        setvbuf(logfile, NULL, _IOLBF, 0);
1616
#endif
P
pbrook 已提交
1617 1618 1619 1620 1621
        log_append = 1;
    }
    if (!loglevel && logfile) {
        fclose(logfile);
        logfile = NULL;
1622 1623 1624 1625 1626 1627
    }
}

void cpu_set_log_filename(const char *filename)
{
    logfilename = strdup(filename);
P
pbrook 已提交
1628 1629 1630 1631 1632
    if (logfile) {
        fclose(logfile);
        logfile = NULL;
    }
    cpu_set_log(loglevel);
1633
}
B
bellard 已提交
1634

1635
static void cpu_unlink_tb(CPUState *env)
B
bellard 已提交
1636
{
1637 1638 1639 1640
    /* FIXME: TB unchaining isn't SMP safe.  For now just ignore the
       problem and hope the cpu will stop of its own accord.  For userspace
       emulation this often isn't actually as bad as it sounds.  Often
       signals are used primarily to interrupt blocking syscalls.  */
B
bellard 已提交
1641
    TranslationBlock *tb;
A
Anthony Liguori 已提交
1642
    static spinlock_t interrupt_lock = SPIN_LOCK_UNLOCKED;
1643

R
Riku Voipio 已提交
1644
    spin_lock(&interrupt_lock);
1645 1646 1647
    tb = env->current_tb;
    /* if the cpu is currently executing code, we must unlink it and
       all the potentially executing TB */
1648
    if (tb) {
1649 1650
        env->current_tb = NULL;
        tb_reset_jump_recursive(tb);
1651
    }
R
Riku Voipio 已提交
1652
    spin_unlock(&interrupt_lock);
1653 1654 1655 1656 1657 1658
}

/* mask must never be zero, except for A20 change call */
void cpu_interrupt(CPUState *env, int mask)
{
    int old_mask;
1659

P
pbrook 已提交
1660
    old_mask = env->interrupt_request;
B
bellard 已提交
1661
    env->interrupt_request |= mask;
1662

1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673
#ifndef CONFIG_USER_ONLY
    /*
     * If called from iothread context, wake the target cpu in
     * case its halted.
     */
    if (!qemu_cpu_self(env)) {
        qemu_cpu_kick(env);
        return;
    }
#endif

P
pbrook 已提交
1674
    if (use_icount) {
P
pbrook 已提交
1675
        env->icount_decr.u16.high = 0xffff;
P
pbrook 已提交
1676 1677
#ifndef CONFIG_USER_ONLY
        if (!can_do_io(env)
1678
            && (mask & ~old_mask) != 0) {
P
pbrook 已提交
1679 1680 1681 1682
            cpu_abort(env, "Raised interrupt while not in I/O function");
        }
#endif
    } else {
1683
        cpu_unlink_tb(env);
B
bellard 已提交
1684 1685 1686
    }
}

1687 1688 1689 1690 1691
void cpu_reset_interrupt(CPUState *env, int mask)
{
    env->interrupt_request &= ~mask;
}

1692 1693 1694 1695 1696 1697
void cpu_exit(CPUState *env)
{
    env->exit_request = 1;
    cpu_unlink_tb(env);
}

B
blueswir1 已提交
1698
const CPULogItem cpu_log_items[] = {
1699
    { CPU_LOG_TB_OUT_ASM, "out_asm",
1700 1701 1702
      "show generated host assembly code for each compiled TB" },
    { CPU_LOG_TB_IN_ASM, "in_asm",
      "show target assembly code for each compiled TB" },
1703
    { CPU_LOG_TB_OP, "op",
B
bellard 已提交
1704
      "show micro ops for each compiled TB" },
1705
    { CPU_LOG_TB_OP_OPT, "op_opt",
B
blueswir1 已提交
1706 1707 1708
      "show micro ops "
#ifdef TARGET_I386
      "before eflags optimization and "
1709
#endif
B
blueswir1 已提交
1710
      "after liveness analysis" },
1711 1712 1713 1714
    { CPU_LOG_INT, "int",
      "show interrupts/exceptions in short format" },
    { CPU_LOG_EXEC, "exec",
      "show trace before each executed TB (lots of logs)" },
1715
    { CPU_LOG_TB_CPU, "cpu",
T
ths 已提交
1716
      "show CPU state before block translation" },
1717 1718 1719
#ifdef TARGET_I386
    { CPU_LOG_PCALL, "pcall",
      "show protected mode far calls/returns/exceptions" },
A
aliguori 已提交
1720 1721
    { CPU_LOG_RESET, "cpu_reset",
      "show CPU state before CPU resets" },
1722
#endif
B
bellard 已提交
1723
#ifdef DEBUG_IOPORT
1724 1725
    { CPU_LOG_IOPORT, "ioport",
      "show all i/o ports accesses" },
B
bellard 已提交
1726
#endif
1727 1728 1729
    { 0, NULL, NULL },
};

M
Michael S. Tsirkin 已提交
1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766
#ifndef CONFIG_USER_ONLY
static QLIST_HEAD(memory_client_list, CPUPhysMemoryClient) memory_client_list
    = QLIST_HEAD_INITIALIZER(memory_client_list);

static void cpu_notify_set_memory(target_phys_addr_t start_addr,
				  ram_addr_t size,
				  ram_addr_t phys_offset)
{
    CPUPhysMemoryClient *client;
    QLIST_FOREACH(client, &memory_client_list, list) {
        client->set_memory(client, start_addr, size, phys_offset);
    }
}

static int cpu_notify_sync_dirty_bitmap(target_phys_addr_t start,
					target_phys_addr_t end)
{
    CPUPhysMemoryClient *client;
    QLIST_FOREACH(client, &memory_client_list, list) {
        int r = client->sync_dirty_bitmap(client, start, end);
        if (r < 0)
            return r;
    }
    return 0;
}

static int cpu_notify_migration_log(int enable)
{
    CPUPhysMemoryClient *client;
    QLIST_FOREACH(client, &memory_client_list, list) {
        int r = client->migration_log(client, enable);
        if (r < 0)
            return r;
    }
    return 0;
}

1767 1768
static void phys_page_for_each_1(CPUPhysMemoryClient *client,
                                 int level, void **lp)
M
Michael S. Tsirkin 已提交
1769
{
1770
    int i;
M
Michael S. Tsirkin 已提交
1771

1772 1773 1774 1775 1776
    if (*lp == NULL) {
        return;
    }
    if (level == 0) {
        PhysPageDesc *pd = *lp;
P
Paul Brook 已提交
1777
        for (i = 0; i < L2_SIZE; ++i) {
1778 1779 1780
            if (pd[i].phys_offset != IO_MEM_UNASSIGNED) {
                client->set_memory(client, pd[i].region_offset,
                                   TARGET_PAGE_SIZE, pd[i].phys_offset);
M
Michael S. Tsirkin 已提交
1781
            }
1782 1783 1784
        }
    } else {
        void **pp = *lp;
P
Paul Brook 已提交
1785
        for (i = 0; i < L2_SIZE; ++i) {
1786
            phys_page_for_each_1(client, level - 1, pp + i);
M
Michael S. Tsirkin 已提交
1787 1788 1789 1790 1791 1792
        }
    }
}

static void phys_page_for_each(CPUPhysMemoryClient *client)
{
1793 1794 1795 1796
    int i;
    for (i = 0; i < P_L1_SIZE; ++i) {
        phys_page_for_each_1(client, P_L1_SHIFT / L2_BITS - 1,
                             l1_phys_map + 1);
M
Michael S. Tsirkin 已提交
1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811
    }
}

void cpu_register_phys_memory_client(CPUPhysMemoryClient *client)
{
    QLIST_INSERT_HEAD(&memory_client_list, client, list);
    phys_page_for_each(client);
}

void cpu_unregister_phys_memory_client(CPUPhysMemoryClient *client)
{
    QLIST_REMOVE(client, list);
}
#endif

1812 1813 1814 1815 1816 1817
static int cmp1(const char *s1, int n, const char *s2)
{
    if (strlen(s2) != n)
        return 0;
    return memcmp(s1, s2, n) == 0;
}
1818

1819 1820 1821
/* takes a comma separated list of log masks. Return 0 if error. */
int cpu_str_to_log_mask(const char *str)
{
B
blueswir1 已提交
1822
    const CPULogItem *item;
1823 1824 1825 1826 1827 1828 1829 1830 1831
    int mask;
    const char *p, *p1;

    p = str;
    mask = 0;
    for(;;) {
        p1 = strchr(p, ',');
        if (!p1)
            p1 = p + strlen(p);
B
bellard 已提交
1832 1833 1834 1835 1836
	if(cmp1(p,p1-p,"all")) {
		for(item = cpu_log_items; item->mask != 0; item++) {
			mask |= item->mask;
		}
	} else {
1837 1838 1839 1840 1841
        for(item = cpu_log_items; item->mask != 0; item++) {
            if (cmp1(p, p1 - p, item->name))
                goto found;
        }
        return 0;
B
bellard 已提交
1842
	}
1843 1844 1845 1846 1847 1848 1849 1850
    found:
        mask |= item->mask;
        if (*p1 != ',')
            break;
        p = p1 + 1;
    }
    return mask;
}
B
bellard 已提交
1851

B
bellard 已提交
1852 1853 1854
void cpu_abort(CPUState *env, const char *fmt, ...)
{
    va_list ap;
P
pbrook 已提交
1855
    va_list ap2;
B
bellard 已提交
1856 1857

    va_start(ap, fmt);
P
pbrook 已提交
1858
    va_copy(ap2, ap);
B
bellard 已提交
1859 1860 1861 1862
    fprintf(stderr, "qemu: fatal: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
#ifdef TARGET_I386
B
bellard 已提交
1863 1864 1865
    cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU | X86_DUMP_CCOP);
#else
    cpu_dump_state(env, stderr, fprintf, 0);
B
bellard 已提交
1866
#endif
1867 1868 1869 1870
    if (qemu_log_enabled()) {
        qemu_log("qemu: fatal: ");
        qemu_log_vprintf(fmt, ap2);
        qemu_log("\n");
1871
#ifdef TARGET_I386
1872
        log_cpu_state(env, X86_DUMP_FPU | X86_DUMP_CCOP);
1873
#else
1874
        log_cpu_state(env, 0);
1875
#endif
1876
        qemu_log_flush();
1877
        qemu_log_close();
1878
    }
P
pbrook 已提交
1879
    va_end(ap2);
1880
    va_end(ap);
1881 1882 1883 1884 1885 1886 1887 1888
#if defined(CONFIG_USER_ONLY)
    {
        struct sigaction act;
        sigfillset(&act.sa_mask);
        act.sa_handler = SIG_DFL;
        sigaction(SIGABRT, &act, NULL);
    }
#endif
B
bellard 已提交
1889 1890 1891
    abort();
}

1892 1893
CPUState *cpu_copy(CPUState *env)
{
1894
    CPUState *new_env = cpu_init(env->cpu_model_str);
1895 1896
    CPUState *next_cpu = new_env->next_cpu;
    int cpu_index = new_env->cpu_index;
1897 1898 1899 1900 1901
#if defined(TARGET_HAS_ICE)
    CPUBreakpoint *bp;
    CPUWatchpoint *wp;
#endif

1902
    memcpy(new_env, env, sizeof(CPUState));
1903 1904

    /* Preserve chaining and index. */
1905 1906
    new_env->next_cpu = next_cpu;
    new_env->cpu_index = cpu_index;
1907 1908 1909 1910

    /* Clone all break/watchpoints.
       Note: Once we support ptrace with hw-debug register access, make sure
       BP_CPU break/watchpoints are handled correctly on clone. */
B
Blue Swirl 已提交
1911 1912
    QTAILQ_INIT(&env->breakpoints);
    QTAILQ_INIT(&env->watchpoints);
1913
#if defined(TARGET_HAS_ICE)
B
Blue Swirl 已提交
1914
    QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
1915 1916
        cpu_breakpoint_insert(new_env, bp->pc, bp->flags, NULL);
    }
B
Blue Swirl 已提交
1917
    QTAILQ_FOREACH(wp, &env->watchpoints, entry) {
1918 1919 1920 1921 1922
        cpu_watchpoint_insert(new_env, wp->vaddr, (~wp->len_mask) + 1,
                              wp->flags, NULL);
    }
#endif

1923 1924 1925
    return new_env;
}

1926 1927
#if !defined(CONFIG_USER_ONLY)

1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942
static inline void tlb_flush_jmp_cache(CPUState *env, target_ulong addr)
{
    unsigned int i;

    /* Discard jump cache entries for any tb which might potentially
       overlap the flushed page.  */
    i = tb_jmp_cache_hash_page(addr - TARGET_PAGE_SIZE);
    memset (&env->tb_jmp_cache[i], 0, 
	    TB_JMP_PAGE_SIZE * sizeof(TranslationBlock *));

    i = tb_jmp_cache_hash_page(addr);
    memset (&env->tb_jmp_cache[i], 0, 
	    TB_JMP_PAGE_SIZE * sizeof(TranslationBlock *));
}

I
Igor Kovalenko 已提交
1943 1944 1945 1946 1947 1948 1949
static CPUTLBEntry s_cputlb_empty_entry = {
    .addr_read  = -1,
    .addr_write = -1,
    .addr_code  = -1,
    .addend     = -1,
};

1950 1951 1952
/* NOTE: if flush_global is true, also flush global entries (not
   implemented yet) */
void tlb_flush(CPUState *env, int flush_global)
1953 1954
{
    int i;
1955

1956 1957 1958
#if defined(DEBUG_TLB)
    printf("tlb_flush:\n");
#endif
1959 1960 1961 1962
    /* must reset current TB so that interrupts cannot modify the
       links while we are modifying them */
    env->current_tb = NULL;

1963
    for(i = 0; i < CPU_TLB_SIZE; i++) {
1964 1965
        int mmu_idx;
        for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
I
Igor Kovalenko 已提交
1966
            env->tlb_table[mmu_idx][i] = s_cputlb_empty_entry;
1967
        }
1968
    }
1969

1970
    memset (env->tb_jmp_cache, 0, TB_JMP_CACHE_SIZE * sizeof (void *));
1971

P
Paul Brook 已提交
1972 1973
    env->tlb_flush_addr = -1;
    env->tlb_flush_mask = 0;
B
bellard 已提交
1974
    tlb_flush_count++;
1975 1976
}

B
bellard 已提交
1977
static inline void tlb_flush_entry(CPUTLBEntry *tlb_entry, target_ulong addr)
B
bellard 已提交
1978
{
1979
    if (addr == (tlb_entry->addr_read &
B
bellard 已提交
1980
                 (TARGET_PAGE_MASK | TLB_INVALID_MASK)) ||
1981
        addr == (tlb_entry->addr_write &
B
bellard 已提交
1982
                 (TARGET_PAGE_MASK | TLB_INVALID_MASK)) ||
1983
        addr == (tlb_entry->addr_code &
B
bellard 已提交
1984
                 (TARGET_PAGE_MASK | TLB_INVALID_MASK))) {
I
Igor Kovalenko 已提交
1985
        *tlb_entry = s_cputlb_empty_entry;
B
bellard 已提交
1986
    }
B
bellard 已提交
1987 1988
}

1989
void tlb_flush_page(CPUState *env, target_ulong addr)
1990
{
1991
    int i;
1992
    int mmu_idx;
1993

1994
#if defined(DEBUG_TLB)
1995
    printf("tlb_flush_page: " TARGET_FMT_lx "\n", addr);
1996
#endif
P
Paul Brook 已提交
1997 1998 1999 2000 2001 2002 2003 2004 2005 2006
    /* Check if we need to flush due to large pages.  */
    if ((addr & env->tlb_flush_mask) == env->tlb_flush_addr) {
#if defined(DEBUG_TLB)
        printf("tlb_flush_page: forced full flush ("
               TARGET_FMT_lx "/" TARGET_FMT_lx ")\n",
               env->tlb_flush_addr, env->tlb_flush_mask);
#endif
        tlb_flush(env, 1);
        return;
    }
2007 2008 2009
    /* must reset current TB so that interrupts cannot modify the
       links while we are modifying them */
    env->current_tb = NULL;
B
bellard 已提交
2010 2011 2012

    addr &= TARGET_PAGE_MASK;
    i = (addr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1);
2013 2014
    for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++)
        tlb_flush_entry(&env->tlb_table[mmu_idx][i], addr);
2015

2016
    tlb_flush_jmp_cache(env, addr);
2017 2018 2019 2020
}

/* update the TLBs so that writes to code in the virtual page 'addr'
   can be detected */
A
Anthony Liguori 已提交
2021
static void tlb_protect_code(ram_addr_t ram_addr)
2022
{
2023
    cpu_physical_memory_reset_dirty(ram_addr,
B
bellard 已提交
2024 2025
                                    ram_addr + TARGET_PAGE_SIZE,
                                    CODE_DIRTY_FLAG);
2026 2027 2028
}

/* update the TLB so that writes in physical page 'phys_addr' are no longer
2029
   tested for self modifying code */
A
Anthony Liguori 已提交
2030
static void tlb_unprotect_code_phys(CPUState *env, ram_addr_t ram_addr,
2031
                                    target_ulong vaddr)
2032
{
2033
    cpu_physical_memory_set_dirty_flags(ram_addr, CODE_DIRTY_FLAG);
2034 2035
}

2036
static inline void tlb_reset_dirty_range(CPUTLBEntry *tlb_entry,
2037 2038 2039
                                         unsigned long start, unsigned long length)
{
    unsigned long addr;
B
bellard 已提交
2040 2041
    if ((tlb_entry->addr_write & ~TARGET_PAGE_MASK) == IO_MEM_RAM) {
        addr = (tlb_entry->addr_write & TARGET_PAGE_MASK) + tlb_entry->addend;
2042
        if ((addr - start) < length) {
P
pbrook 已提交
2043
            tlb_entry->addr_write = (tlb_entry->addr_write & TARGET_PAGE_MASK) | TLB_NOTDIRTY;
2044 2045 2046 2047
        }
    }
}

P
pbrook 已提交
2048
/* Note: start and end must be within the same ram block.  */
A
Anthony Liguori 已提交
2049
void cpu_physical_memory_reset_dirty(ram_addr_t start, ram_addr_t end,
B
bellard 已提交
2050
                                     int dirty_flags)
2051 2052
{
    CPUState *env;
B
bellard 已提交
2053
    unsigned long length, start1;
2054
    int i;
2055 2056 2057 2058 2059 2060 2061

    start &= TARGET_PAGE_MASK;
    end = TARGET_PAGE_ALIGN(end);

    length = end - start;
    if (length == 0)
        return;
2062
    cpu_physical_memory_mask_dirty_range(start, length, dirty_flags);
B
bellard 已提交
2063

2064 2065
    /* we modify the TLB cache so that the dirty bit will be set again
       when accessing the range */
P
pbrook 已提交
2066 2067 2068 2069 2070 2071 2072 2073
    start1 = (unsigned long)qemu_get_ram_ptr(start);
    /* Chek that we don't span multiple blocks - this breaks the
       address comparisons below.  */
    if ((unsigned long)qemu_get_ram_ptr(end - 1) - start1
            != (end - 1) - start) {
        abort();
    }

B
bellard 已提交
2074
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
2075 2076 2077 2078 2079 2080
        int mmu_idx;
        for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
            for(i = 0; i < CPU_TLB_SIZE; i++)
                tlb_reset_dirty_range(&env->tlb_table[mmu_idx][i],
                                      start1, length);
        }
B
bellard 已提交
2081
    }
2082 2083
}

A
aliguori 已提交
2084 2085
int cpu_physical_memory_set_dirty_tracking(int enable)
{
M
Michael S. Tsirkin 已提交
2086
    int ret = 0;
A
aliguori 已提交
2087
    in_migration = enable;
M
Michael S. Tsirkin 已提交
2088 2089
    ret = cpu_notify_migration_log(!!enable);
    return ret;
A
aliguori 已提交
2090 2091 2092 2093 2094 2095 2096
}

int cpu_physical_memory_get_dirty_tracking(void)
{
    return in_migration;
}

A
Anthony Liguori 已提交
2097 2098
int cpu_physical_sync_dirty_bitmap(target_phys_addr_t start_addr,
                                   target_phys_addr_t end_addr)
A
aliguori 已提交
2099
{
2100
    int ret;
2101

M
Michael S. Tsirkin 已提交
2102
    ret = cpu_notify_sync_dirty_bitmap(start_addr, end_addr);
2103
    return ret;
A
aliguori 已提交
2104 2105
}

2106 2107
static inline void tlb_update_dirty(CPUTLBEntry *tlb_entry)
{
A
Anthony Liguori 已提交
2108
    ram_addr_t ram_addr;
P
pbrook 已提交
2109
    void *p;
2110

B
bellard 已提交
2111
    if ((tlb_entry->addr_write & ~TARGET_PAGE_MASK) == IO_MEM_RAM) {
P
pbrook 已提交
2112 2113 2114
        p = (void *)(unsigned long)((tlb_entry->addr_write & TARGET_PAGE_MASK)
            + tlb_entry->addend);
        ram_addr = qemu_ram_addr_from_host(p);
2115
        if (!cpu_physical_memory_is_dirty(ram_addr)) {
P
pbrook 已提交
2116
            tlb_entry->addr_write |= TLB_NOTDIRTY;
2117 2118 2119 2120 2121 2122 2123 2124
        }
    }
}

/* update the TLB according to the current state of the dirty bits */
void cpu_tlb_update_dirty(CPUState *env)
{
    int i;
2125 2126 2127 2128 2129
    int mmu_idx;
    for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
        for(i = 0; i < CPU_TLB_SIZE; i++)
            tlb_update_dirty(&env->tlb_table[mmu_idx][i]);
    }
2130 2131
}

P
pbrook 已提交
2132
static inline void tlb_set_dirty1(CPUTLBEntry *tlb_entry, target_ulong vaddr)
2133
{
P
pbrook 已提交
2134 2135
    if (tlb_entry->addr_write == (vaddr | TLB_NOTDIRTY))
        tlb_entry->addr_write = vaddr;
2136 2137
}

P
pbrook 已提交
2138 2139 2140
/* update the TLB corresponding to virtual page vaddr
   so that it is no longer dirty */
static inline void tlb_set_dirty(CPUState *env, target_ulong vaddr)
2141 2142
{
    int i;
2143
    int mmu_idx;
2144

P
pbrook 已提交
2145
    vaddr &= TARGET_PAGE_MASK;
2146
    i = (vaddr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1);
2147 2148
    for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++)
        tlb_set_dirty1(&env->tlb_table[mmu_idx][i], vaddr);
2149 2150
}

P
Paul Brook 已提交
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179
/* Our TLB does not support large pages, so remember the area covered by
   large pages and trigger a full TLB flush if these are invalidated.  */
static void tlb_add_large_page(CPUState *env, target_ulong vaddr,
                               target_ulong size)
{
    target_ulong mask = ~(size - 1);

    if (env->tlb_flush_addr == (target_ulong)-1) {
        env->tlb_flush_addr = vaddr & mask;
        env->tlb_flush_mask = mask;
        return;
    }
    /* Extend the existing region to include the new page.
       This is a compromise between unnecessary flushes and the cost
       of maintaining a full variable size TLB.  */
    mask &= env->tlb_flush_mask;
    while (((env->tlb_flush_addr ^ vaddr) & mask) != 0) {
        mask <<= 1;
    }
    env->tlb_flush_addr &= mask;
    env->tlb_flush_mask = mask;
}

/* Add a new TLB entry. At most one entry for a given virtual address
   is permitted. Only a single TARGET_PAGE_SIZE region is mapped, the
   supplied size is only used by tlb_flush_page.  */
void tlb_set_page(CPUState *env, target_ulong vaddr,
                  target_phys_addr_t paddr, int prot,
                  int mmu_idx, target_ulong size)
2180
{
B
bellard 已提交
2181
    PhysPageDesc *p;
B
bellard 已提交
2182
    unsigned long pd;
2183
    unsigned int index;
B
bellard 已提交
2184
    target_ulong address;
P
pbrook 已提交
2185
    target_ulong code_address;
2186
    unsigned long addend;
B
bellard 已提交
2187
    CPUTLBEntry *te;
2188
    CPUWatchpoint *wp;
A
Anthony Liguori 已提交
2189
    target_phys_addr_t iotlb;
2190

P
Paul Brook 已提交
2191 2192 2193 2194
    assert(size >= TARGET_PAGE_SIZE);
    if (size != TARGET_PAGE_SIZE) {
        tlb_add_large_page(env, vaddr, size);
    }
B
bellard 已提交
2195
    p = phys_page_find(paddr >> TARGET_PAGE_BITS);
2196 2197 2198 2199 2200 2201
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
#if defined(DEBUG_TLB)
2202 2203
    printf("tlb_set_page: vaddr=" TARGET_FMT_lx " paddr=0x%08x prot=%x idx=%d smmu=%d pd=0x%08lx\n",
           vaddr, (int)paddr, prot, mmu_idx, is_softmmu, pd);
2204 2205
#endif

P
pbrook 已提交
2206 2207 2208 2209 2210
    address = vaddr;
    if ((pd & ~TARGET_PAGE_MASK) > IO_MEM_ROM && !(pd & IO_MEM_ROMD)) {
        /* IO memory case (romd handled later) */
        address |= TLB_MMIO;
    }
P
pbrook 已提交
2211
    addend = (unsigned long)qemu_get_ram_ptr(pd & TARGET_PAGE_MASK);
P
pbrook 已提交
2212 2213 2214 2215 2216 2217 2218 2219
    if ((pd & ~TARGET_PAGE_MASK) <= IO_MEM_ROM) {
        /* Normal RAM.  */
        iotlb = pd & TARGET_PAGE_MASK;
        if ((pd & ~TARGET_PAGE_MASK) == IO_MEM_RAM)
            iotlb |= IO_MEM_NOTDIRTY;
        else
            iotlb |= IO_MEM_ROM;
    } else {
S
Stuart Brady 已提交
2220
        /* IO handlers are currently passed a physical address.
P
pbrook 已提交
2221 2222 2223 2224 2225
           It would be nice to pass an offset from the base address
           of that region.  This would avoid having to special case RAM,
           and avoid full address decoding in every device.
           We can't use the high bits of pd for this because
           IO_MEM_ROMD uses these as a ram address.  */
2226 2227 2228 2229 2230 2231
        iotlb = (pd & ~TARGET_PAGE_MASK);
        if (p) {
            iotlb += p->region_offset;
        } else {
            iotlb += paddr;
        }
P
pbrook 已提交
2232 2233 2234 2235 2236
    }

    code_address = address;
    /* Make accesses to pages with watchpoints go via the
       watchpoint trap routines.  */
B
Blue Swirl 已提交
2237
    QTAILQ_FOREACH(wp, &env->watchpoints, entry) {
2238
        if (vaddr == (wp->vaddr & TARGET_PAGE_MASK)) {
P
pbrook 已提交
2239 2240 2241 2242
            iotlb = io_mem_watch + paddr;
            /* TODO: The memory case can be optimized by not trapping
               reads of pages with a write breakpoint.  */
            address |= TLB_MMIO;
2243
        }
P
pbrook 已提交
2244
    }
2245

P
pbrook 已提交
2246 2247 2248 2249 2250 2251 2252 2253 2254
    index = (vaddr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1);
    env->iotlb[mmu_idx][index] = iotlb - vaddr;
    te = &env->tlb_table[mmu_idx][index];
    te->addend = addend - vaddr;
    if (prot & PAGE_READ) {
        te->addr_read = address;
    } else {
        te->addr_read = -1;
    }
2255

P
pbrook 已提交
2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268
    if (prot & PAGE_EXEC) {
        te->addr_code = code_address;
    } else {
        te->addr_code = -1;
    }
    if (prot & PAGE_WRITE) {
        if ((pd & ~TARGET_PAGE_MASK) == IO_MEM_ROM ||
            (pd & IO_MEM_ROMD)) {
            /* Write access calls the I/O callback.  */
            te->addr_write = address | TLB_MMIO;
        } else if ((pd & ~TARGET_PAGE_MASK) == IO_MEM_RAM &&
                   !cpu_physical_memory_is_dirty(pd)) {
            te->addr_write = address | TLB_NOTDIRTY;
2269
        } else {
P
pbrook 已提交
2270
            te->addr_write = address;
2271
        }
P
pbrook 已提交
2272 2273
    } else {
        te->addr_write = -1;
2274 2275 2276
    }
}

2277 2278
#else

2279
void tlb_flush(CPUState *env, int flush_global)
2280 2281 2282
{
}

2283
void tlb_flush_page(CPUState *env, target_ulong addr)
2284 2285 2286
{
}

2287 2288 2289 2290
/*
 * Walks guest process memory "regions" one by one
 * and calls callback function 'fn' for each region.
 */
2291 2292 2293 2294 2295 2296 2297 2298 2299 2300

struct walk_memory_regions_data
{
    walk_memory_regions_fn fn;
    void *priv;
    unsigned long start;
    int prot;
};

static int walk_memory_regions_end(struct walk_memory_regions_data *data,
P
Paul Brook 已提交
2301
                                   abi_ulong end, int new_prot)
2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316
{
    if (data->start != -1ul) {
        int rc = data->fn(data->priv, data->start, end, data->prot);
        if (rc != 0) {
            return rc;
        }
    }

    data->start = (new_prot ? end : -1ul);
    data->prot = new_prot;

    return 0;
}

static int walk_memory_regions_1(struct walk_memory_regions_data *data,
P
Paul Brook 已提交
2317
                                 abi_ulong base, int level, void **lp)
2318
{
P
Paul Brook 已提交
2319
    abi_ulong pa;
2320 2321 2322 2323 2324 2325 2326 2327
    int i, rc;

    if (*lp == NULL) {
        return walk_memory_regions_end(data, base, 0);
    }

    if (level == 0) {
        PageDesc *pd = *lp;
P
Paul Brook 已提交
2328
        for (i = 0; i < L2_SIZE; ++i) {
2329 2330 2331 2332 2333 2334 2335
            int prot = pd[i].flags;

            pa = base | (i << TARGET_PAGE_BITS);
            if (prot != data->prot) {
                rc = walk_memory_regions_end(data, pa, prot);
                if (rc != 0) {
                    return rc;
2336 2337
                }
            }
2338 2339 2340
        }
    } else {
        void **pp = *lp;
P
Paul Brook 已提交
2341
        for (i = 0; i < L2_SIZE; ++i) {
P
Paul Brook 已提交
2342 2343
            pa = base | ((abi_ulong)i <<
                (TARGET_PAGE_BITS + L2_BITS * level));
2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364
            rc = walk_memory_regions_1(data, pa, level - 1, pp + i);
            if (rc != 0) {
                return rc;
            }
        }
    }

    return 0;
}

int walk_memory_regions(void *priv, walk_memory_regions_fn fn)
{
    struct walk_memory_regions_data data;
    unsigned long i;

    data.fn = fn;
    data.priv = priv;
    data.start = -1ul;
    data.prot = 0;

    for (i = 0; i < V_L1_SIZE; i++) {
P
Paul Brook 已提交
2365
        int rc = walk_memory_regions_1(&data, (abi_ulong)i << V_L1_SHIFT,
2366 2367 2368
                                       V_L1_SHIFT / L2_BITS - 1, l1_map + i);
        if (rc != 0) {
            return rc;
2369
        }
2370
    }
2371 2372

    return walk_memory_regions_end(&data, 0, 0);
2373 2374
}

P
Paul Brook 已提交
2375 2376
static int dump_region(void *priv, abi_ulong start,
    abi_ulong end, unsigned long prot)
2377 2378 2379
{
    FILE *f = (FILE *)priv;

P
Paul Brook 已提交
2380 2381
    (void) fprintf(f, TARGET_ABI_FMT_lx"-"TARGET_ABI_FMT_lx
        " "TARGET_ABI_FMT_lx" %c%c%c\n",
2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395
        start, end, end - start,
        ((prot & PAGE_READ) ? 'r' : '-'),
        ((prot & PAGE_WRITE) ? 'w' : '-'),
        ((prot & PAGE_EXEC) ? 'x' : '-'));

    return (0);
}

/* dump memory mappings */
void page_dump(FILE *f)
{
    (void) fprintf(f, "%-8s %-8s %-8s %s\n",
            "start", "end", "size", "prot");
    walk_memory_regions(f, dump_region);
2396 2397
}

2398
int page_get_flags(target_ulong address)
2399
{
2400 2401 2402
    PageDesc *p;

    p = page_find(address >> TARGET_PAGE_BITS);
2403
    if (!p)
2404 2405 2406 2407
        return 0;
    return p->flags;
}

2408 2409 2410
/* Modify the flags of a page and invalidate the code if necessary.
   The flag PAGE_WRITE_ORG is positioned automatically depending
   on PAGE_WRITE.  The mmap_lock should already be held.  */
2411
void page_set_flags(target_ulong start, target_ulong end, int flags)
2412
{
2413 2414 2415 2416 2417
    target_ulong addr, len;

    /* This function should never be called with addresses outside the
       guest address space.  If this assert fires, it probably indicates
       a missing call to h2g_valid.  */
P
Paul Brook 已提交
2418 2419
#if TARGET_ABI_BITS > L1_MAP_ADDR_SPACE_BITS
    assert(end < ((abi_ulong)1 << L1_MAP_ADDR_SPACE_BITS));
2420 2421
#endif
    assert(start < end);
2422 2423 2424

    start = start & TARGET_PAGE_MASK;
    end = TARGET_PAGE_ALIGN(end);
2425 2426

    if (flags & PAGE_WRITE) {
2427
        flags |= PAGE_WRITE_ORG;
2428 2429 2430 2431 2432 2433 2434 2435 2436
    }

    for (addr = start, len = end - start;
         len != 0;
         len -= TARGET_PAGE_SIZE, addr += TARGET_PAGE_SIZE) {
        PageDesc *p = page_find_alloc(addr >> TARGET_PAGE_BITS, 1);

        /* If the write protection bit is set, then we invalidate
           the code inside.  */
2437
        if (!(p->flags & PAGE_WRITE) &&
2438 2439
            (flags & PAGE_WRITE) &&
            p->first_tb) {
B
bellard 已提交
2440
            tb_invalidate_phys_page(addr, 0, NULL);
2441 2442 2443
        }
        p->flags = flags;
    }
2444 2445
}

2446 2447 2448 2449 2450 2451
int page_check_range(target_ulong start, target_ulong len, int flags)
{
    PageDesc *p;
    target_ulong end;
    target_ulong addr;

2452 2453 2454
    /* This function should never be called with addresses outside the
       guest address space.  If this assert fires, it probably indicates
       a missing call to h2g_valid.  */
2455 2456
#if TARGET_ABI_BITS > L1_MAP_ADDR_SPACE_BITS
    assert(start < ((abi_ulong)1 << L1_MAP_ADDR_SPACE_BITS));
2457 2458 2459 2460
#endif

    if (start + len - 1 < start) {
        /* We've wrapped around.  */
2461
        return -1;
2462
    }
2463

2464 2465 2466
    end = TARGET_PAGE_ALIGN(start+len); /* must do before we loose bits in the next step */
    start = start & TARGET_PAGE_MASK;

2467 2468 2469
    for (addr = start, len = end - start;
         len != 0;
         len -= TARGET_PAGE_SIZE, addr += TARGET_PAGE_SIZE) {
2470 2471 2472 2473 2474 2475
        p = page_find(addr >> TARGET_PAGE_BITS);
        if( !p )
            return -1;
        if( !(p->flags & PAGE_VALID) )
            return -1;

2476
        if ((flags & PAGE_READ) && !(p->flags & PAGE_READ))
2477
            return -1;
2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488
        if (flags & PAGE_WRITE) {
            if (!(p->flags & PAGE_WRITE_ORG))
                return -1;
            /* unprotect the page if it was put read-only because it
               contains translated code */
            if (!(p->flags & PAGE_WRITE)) {
                if (!page_unprotect(addr, 0, NULL))
                    return -1;
            }
            return 0;
        }
2489 2490 2491 2492
    }
    return 0;
}

2493
/* called from signal handler: invalidate the code and unprotect the
S
Stuart Brady 已提交
2494
   page. Return TRUE if the fault was successfully handled. */
2495
int page_unprotect(target_ulong address, unsigned long pc, void *puc)
2496
{
2497 2498
    unsigned int prot;
    PageDesc *p;
2499
    target_ulong host_start, host_end, addr;
2500

P
pbrook 已提交
2501 2502 2503 2504 2505
    /* Technically this isn't safe inside a signal handler.  However we
       know this only ever happens in a synchronous SEGV handler, so in
       practice it seems to be ok.  */
    mmap_lock();

2506 2507
    p = page_find(address >> TARGET_PAGE_BITS);
    if (!p) {
P
pbrook 已提交
2508
        mmap_unlock();
2509
        return 0;
P
pbrook 已提交
2510
    }
2511

2512 2513
    /* if the page was really writable, then we change its
       protection back to writable */
2514 2515 2516 2517 2518 2519 2520 2521 2522 2523
    if ((p->flags & PAGE_WRITE_ORG) && !(p->flags & PAGE_WRITE)) {
        host_start = address & qemu_host_page_mask;
        host_end = host_start + qemu_host_page_size;

        prot = 0;
        for (addr = host_start ; addr < host_end ; addr += TARGET_PAGE_SIZE) {
            p = page_find(addr >> TARGET_PAGE_BITS);
            p->flags |= PAGE_WRITE;
            prot |= p->flags;

2524 2525
            /* and since the content will be modified, we must invalidate
               the corresponding translated code. */
2526
            tb_invalidate_phys_page(addr, pc, puc);
2527
#ifdef DEBUG_TB_CHECK
2528
            tb_invalidate_check(addr);
2529 2530
#endif
        }
2531 2532 2533 2534 2535
        mprotect((void *)g2h(host_start), qemu_host_page_size,
                 prot & PAGE_BITS);

        mmap_unlock();
        return 1;
2536
    }
P
pbrook 已提交
2537
    mmap_unlock();
2538 2539 2540
    return 0;
}

B
bellard 已提交
2541 2542
static inline void tlb_set_dirty(CPUState *env,
                                 unsigned long addr, target_ulong vaddr)
2543 2544
{
}
2545 2546
#endif /* defined(CONFIG_USER_ONLY) */

2547
#if !defined(CONFIG_USER_ONLY)
2548

P
Paul Brook 已提交
2549 2550 2551 2552 2553 2554 2555 2556 2557
#define SUBPAGE_IDX(addr) ((addr) & ~TARGET_PAGE_MASK)
typedef struct subpage_t {
    target_phys_addr_t base;
    CPUReadMemoryFunc * const *mem_read[TARGET_PAGE_SIZE][4];
    CPUWriteMemoryFunc * const *mem_write[TARGET_PAGE_SIZE][4];
    void *opaque[TARGET_PAGE_SIZE][2][4];
    ram_addr_t region_offset[TARGET_PAGE_SIZE][2][4];
} subpage_t;

A
Anthony Liguori 已提交
2558 2559 2560 2561
static int subpage_register (subpage_t *mmio, uint32_t start, uint32_t end,
                             ram_addr_t memory, ram_addr_t region_offset);
static void *subpage_init (target_phys_addr_t base, ram_addr_t *phys,
                           ram_addr_t orig_memory, ram_addr_t region_offset);
2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572
#define CHECK_SUBPAGE(addr, start_addr, start_addr2, end_addr, end_addr2, \
                      need_subpage)                                     \
    do {                                                                \
        if (addr > start_addr)                                          \
            start_addr2 = 0;                                            \
        else {                                                          \
            start_addr2 = start_addr & ~TARGET_PAGE_MASK;               \
            if (start_addr2 > 0)                                        \
                need_subpage = 1;                                       \
        }                                                               \
                                                                        \
2573
        if ((start_addr + orig_size) - addr >= TARGET_PAGE_SIZE)        \
2574 2575 2576 2577 2578 2579 2580 2581
            end_addr2 = TARGET_PAGE_SIZE - 1;                           \
        else {                                                          \
            end_addr2 = (start_addr + orig_size - 1) & ~TARGET_PAGE_MASK; \
            if (end_addr2 < TARGET_PAGE_SIZE - 1)                       \
                need_subpage = 1;                                       \
        }                                                               \
    } while (0)

2582 2583 2584
/* register physical memory.
   For RAM, 'size' must be a multiple of the target page size.
   If (phys_offset & ~TARGET_PAGE_MASK) != 0, then it is an
2585 2586
   io memory page.  The address used when calling the IO function is
   the offset from the start of the region, plus region_offset.  Both
S
Stuart Brady 已提交
2587
   start_addr and region_offset are rounded down to a page boundary
2588 2589
   before calculating this offset.  This should not be a problem unless
   the low bits of start_addr and region_offset differ.  */
A
Anthony Liguori 已提交
2590 2591 2592 2593
void cpu_register_physical_memory_offset(target_phys_addr_t start_addr,
                                         ram_addr_t size,
                                         ram_addr_t phys_offset,
                                         ram_addr_t region_offset)
2594
{
A
Anthony Liguori 已提交
2595
    target_phys_addr_t addr, end_addr;
B
bellard 已提交
2596
    PhysPageDesc *p;
2597
    CPUState *env;
A
Anthony Liguori 已提交
2598
    ram_addr_t orig_size = size;
2599
    void *subpage;
2600

M
Michael S. Tsirkin 已提交
2601 2602
    cpu_notify_set_memory(start_addr, size, phys_offset);

P
pbrook 已提交
2603 2604 2605
    if (phys_offset == IO_MEM_UNASSIGNED) {
        region_offset = start_addr;
    }
2606
    region_offset &= TARGET_PAGE_MASK;
B
bellard 已提交
2607
    size = (size + TARGET_PAGE_SIZE - 1) & TARGET_PAGE_MASK;
A
Anthony Liguori 已提交
2608
    end_addr = start_addr + (target_phys_addr_t)size;
2609
    for(addr = start_addr; addr != end_addr; addr += TARGET_PAGE_SIZE) {
2610 2611
        p = phys_page_find(addr >> TARGET_PAGE_BITS);
        if (p && p->phys_offset != IO_MEM_UNASSIGNED) {
A
Anthony Liguori 已提交
2612 2613
            ram_addr_t orig_memory = p->phys_offset;
            target_phys_addr_t start_addr2, end_addr2;
2614 2615 2616 2617
            int need_subpage = 0;

            CHECK_SUBPAGE(addr, start_addr, start_addr2, end_addr, end_addr2,
                          need_subpage);
2618
            if (need_subpage || phys_offset & IO_MEM_SUBWIDTH) {
2619 2620
                if (!(orig_memory & IO_MEM_SUBPAGE)) {
                    subpage = subpage_init((addr & TARGET_PAGE_MASK),
2621 2622
                                           &p->phys_offset, orig_memory,
                                           p->region_offset);
2623 2624 2625 2626
                } else {
                    subpage = io_mem_opaque[(orig_memory & ~TARGET_PAGE_MASK)
                                            >> IO_MEM_SHIFT];
                }
2627 2628 2629
                subpage_register(subpage, start_addr2, end_addr2, phys_offset,
                                 region_offset);
                p->region_offset = 0;
2630 2631 2632 2633 2634 2635 2636 2637 2638
            } else {
                p->phys_offset = phys_offset;
                if ((phys_offset & ~TARGET_PAGE_MASK) <= IO_MEM_ROM ||
                    (phys_offset & IO_MEM_ROMD))
                    phys_offset += TARGET_PAGE_SIZE;
            }
        } else {
            p = phys_page_find_alloc(addr >> TARGET_PAGE_BITS, 1);
            p->phys_offset = phys_offset;
2639
            p->region_offset = region_offset;
2640
            if ((phys_offset & ~TARGET_PAGE_MASK) <= IO_MEM_ROM ||
2641
                (phys_offset & IO_MEM_ROMD)) {
2642
                phys_offset += TARGET_PAGE_SIZE;
P
pbrook 已提交
2643
            } else {
A
Anthony Liguori 已提交
2644
                target_phys_addr_t start_addr2, end_addr2;
2645 2646 2647 2648 2649
                int need_subpage = 0;

                CHECK_SUBPAGE(addr, start_addr, start_addr2, end_addr,
                              end_addr2, need_subpage);

2650
                if (need_subpage || phys_offset & IO_MEM_SUBWIDTH) {
2651
                    subpage = subpage_init((addr & TARGET_PAGE_MASK),
2652
                                           &p->phys_offset, IO_MEM_UNASSIGNED,
P
pbrook 已提交
2653
                                           addr & TARGET_PAGE_MASK);
2654
                    subpage_register(subpage, start_addr2, end_addr2,
2655 2656
                                     phys_offset, region_offset);
                    p->region_offset = 0;
2657 2658 2659
                }
            }
        }
2660
        region_offset += TARGET_PAGE_SIZE;
2661
    }
2662

2663 2664 2665 2666 2667 2668
    /* since each CPU stores ram addresses in its TLB cache, we must
       reset the modified entries */
    /* XXX: slow ! */
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
        tlb_flush(env, 1);
    }
2669 2670
}

B
bellard 已提交
2671
/* XXX: temporary until new memory mapping API */
A
Anthony Liguori 已提交
2672
ram_addr_t cpu_get_physical_page_desc(target_phys_addr_t addr)
B
bellard 已提交
2673 2674 2675 2676 2677 2678 2679 2680 2681
{
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p)
        return IO_MEM_UNASSIGNED;
    return p->phys_offset;
}

A
Anthony Liguori 已提交
2682
void qemu_register_coalesced_mmio(target_phys_addr_t addr, ram_addr_t size)
A
aliguori 已提交
2683 2684 2685 2686 2687
{
    if (kvm_enabled())
        kvm_coalesce_mmio_region(addr, size);
}

A
Anthony Liguori 已提交
2688
void qemu_unregister_coalesced_mmio(target_phys_addr_t addr, ram_addr_t size)
A
aliguori 已提交
2689 2690 2691 2692 2693
{
    if (kvm_enabled())
        kvm_uncoalesce_mmio_region(addr, size);
}

2694 2695 2696 2697 2698 2699
void qemu_flush_coalesced_mmio_buffer(void)
{
    if (kvm_enabled())
        kvm_flush_coalesced_mmio_buffer();
}

2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715
#if defined(__linux__) && !defined(TARGET_S390X)

#include <sys/vfs.h>

#define HUGETLBFS_MAGIC       0x958458f6

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

    do {
	    ret = statfs(path, &fs);
    } while (ret != 0 && errno == EINTR);

    if (ret != 0) {
2716
	    perror(path);
2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755
	    return 0;
    }

    if (fs.f_type != HUGETLBFS_MAGIC)
	    fprintf(stderr, "Warning: path not on HugeTLBFS: %s\n", path);

    return fs.f_bsize;
}

static void *file_ram_alloc(ram_addr_t memory, const char *path)
{
    char *filename;
    void *area;
    int fd;
#ifdef MAP_POPULATE
    int flags;
#endif
    unsigned long hpagesize;

    hpagesize = gethugepagesize(path);
    if (!hpagesize) {
	return NULL;
    }

    if (memory < hpagesize) {
        return NULL;
    }

    if (kvm_enabled() && !kvm_has_sync_mmu()) {
        fprintf(stderr, "host lacks kvm mmu notifiers, -mem-path unsupported\n");
        return NULL;
    }

    if (asprintf(&filename, "%s/qemu_back_mem.XXXXXX", path) == -1) {
	return NULL;
    }

    fd = mkstemp(filename);
    if (fd < 0) {
2756
	perror("unable to create backing store for hugepages");
2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792
	free(filename);
	return NULL;
    }
    unlink(filename);
    free(filename);

    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))
	perror("ftruncate");

#ifdef MAP_POPULATE
    /* NB: MAP_POPULATE won't exhaustively alloc all phys pages in the case
     * MAP_PRIVATE is requested.  For mem_prealloc we mmap as MAP_SHARED
     * to sidestep this quirk.
     */
    flags = mem_prealloc ? MAP_POPULATE | MAP_SHARED : MAP_PRIVATE;
    area = mmap(0, memory, PROT_READ | PROT_WRITE, flags, fd, 0);
#else
    area = mmap(0, memory, PROT_READ | PROT_WRITE, MAP_PRIVATE, fd, 0);
#endif
    if (area == MAP_FAILED) {
	perror("file_ram_alloc: can't mmap RAM pages");
	close(fd);
	return (NULL);
    }
    return area;
}
#endif

A
Anthony Liguori 已提交
2793
ram_addr_t qemu_ram_alloc(ram_addr_t size)
P
pbrook 已提交
2794 2795 2796 2797 2798 2799
{
    RAMBlock *new_block;

    size = TARGET_PAGE_ALIGN(size);
    new_block = qemu_malloc(sizeof(*new_block));

2800 2801 2802 2803 2804 2805 2806 2807 2808 2809
    if (mem_path) {
#if defined (__linux__) && !defined(TARGET_S390X)
        new_block->host = file_ram_alloc(size, mem_path);
        if (!new_block->host)
            exit(1);
#else
        fprintf(stderr, "-mem-path option unsupported\n");
        exit(1);
#endif
    } else {
2810
#if defined(TARGET_S390X) && defined(CONFIG_KVM)
2811 2812 2813 2814
        /* XXX S390 KVM requires the topmost vma of the RAM to be < 256GB */
        new_block->host = mmap((void*)0x1000000, size,
                                PROT_EXEC|PROT_READ|PROT_WRITE,
                                MAP_SHARED | MAP_ANONYMOUS, -1, 0);
2815
#else
2816
        new_block->host = qemu_vmalloc(size);
2817
#endif
I
Izik Eidus 已提交
2818
#ifdef MADV_MERGEABLE
2819
        madvise(new_block->host, size, MADV_MERGEABLE);
I
Izik Eidus 已提交
2820
#endif
2821
    }
P
pbrook 已提交
2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834
    new_block->offset = last_ram_offset;
    new_block->length = size;

    new_block->next = ram_blocks;
    ram_blocks = new_block;

    phys_ram_dirty = qemu_realloc(phys_ram_dirty,
        (last_ram_offset + size) >> TARGET_PAGE_BITS);
    memset(phys_ram_dirty + (last_ram_offset >> TARGET_PAGE_BITS),
           0xff, size >> TARGET_PAGE_BITS);

    last_ram_offset += size;

2835 2836 2837
    if (kvm_enabled())
        kvm_setup_guest_memory(new_block->host, size);

P
pbrook 已提交
2838 2839
    return new_block->offset;
}
B
bellard 已提交
2840

A
Anthony Liguori 已提交
2841
void qemu_ram_free(ram_addr_t addr)
B
bellard 已提交
2842
{
P
pbrook 已提交
2843
    /* TODO: implement this.  */
B
bellard 已提交
2844 2845
}

2846
/* Return a host pointer to ram allocated with qemu_ram_alloc.
P
pbrook 已提交
2847 2848 2849 2850 2851 2852 2853
   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.
 */
A
Anthony Liguori 已提交
2854
void *qemu_get_ram_ptr(ram_addr_t addr)
2855
{
P
pbrook 已提交
2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880
    RAMBlock *prev;
    RAMBlock **prevp;
    RAMBlock *block;

    prev = NULL;
    prevp = &ram_blocks;
    block = ram_blocks;
    while (block && (block->offset > addr
                     || block->offset + block->length <= addr)) {
        if (prev)
          prevp = &prev->next;
        prev = block;
        block = block->next;
    }
    if (!block) {
        fprintf(stderr, "Bad ram offset %" PRIx64 "\n", (uint64_t)addr);
        abort();
    }
    /* Move this entry to to start of the list.  */
    if (prev) {
        prev->next = block->next;
        block->next = *prevp;
        *prevp = block;
    }
    return block->host + (addr - block->offset);
2881 2882
}

P
pbrook 已提交
2883 2884
/* Some of the softmmu routines need to translate from a host pointer
   (typically a TLB entry) back to a ram offset.  */
A
Anthony Liguori 已提交
2885
ram_addr_t qemu_ram_addr_from_host(void *ptr)
P
pbrook 已提交
2886
{
P
pbrook 已提交
2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902
    RAMBlock *prev;
    RAMBlock *block;
    uint8_t *host = ptr;

    prev = NULL;
    block = ram_blocks;
    while (block && (block->host > host
                     || block->host + block->length <= host)) {
        prev = block;
        block = block->next;
    }
    if (!block) {
        fprintf(stderr, "Bad ram pointer %p\n", ptr);
        abort();
    }
    return block->offset + (host - block->host);
P
pbrook 已提交
2903 2904
}

A
Anthony Liguori 已提交
2905
static uint32_t unassigned_mem_readb(void *opaque, target_phys_addr_t addr)
2906
{
P
pbrook 已提交
2907
#ifdef DEBUG_UNASSIGNED
B
blueswir1 已提交
2908
    printf("Unassigned mem read " TARGET_FMT_plx "\n", addr);
2909
#endif
2910
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2911 2912 2913 2914 2915
    do_unassigned_access(addr, 0, 0, 0, 1);
#endif
    return 0;
}

A
Anthony Liguori 已提交
2916
static uint32_t unassigned_mem_readw(void *opaque, target_phys_addr_t addr)
2917 2918 2919 2920
{
#ifdef DEBUG_UNASSIGNED
    printf("Unassigned mem read " TARGET_FMT_plx "\n", addr);
#endif
2921
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2922 2923 2924 2925 2926
    do_unassigned_access(addr, 0, 0, 0, 2);
#endif
    return 0;
}

A
Anthony Liguori 已提交
2927
static uint32_t unassigned_mem_readl(void *opaque, target_phys_addr_t addr)
2928 2929 2930 2931
{
#ifdef DEBUG_UNASSIGNED
    printf("Unassigned mem read " TARGET_FMT_plx "\n", addr);
#endif
2932
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2933
    do_unassigned_access(addr, 0, 0, 0, 4);
P
pbrook 已提交
2934
#endif
2935 2936 2937
    return 0;
}

A
Anthony Liguori 已提交
2938
static void unassigned_mem_writeb(void *opaque, target_phys_addr_t addr, uint32_t val)
2939
{
P
pbrook 已提交
2940
#ifdef DEBUG_UNASSIGNED
B
blueswir1 已提交
2941
    printf("Unassigned mem write " TARGET_FMT_plx " = 0x%x\n", addr, val);
P
pbrook 已提交
2942
#endif
2943
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2944 2945 2946 2947
    do_unassigned_access(addr, 1, 0, 0, 1);
#endif
}

A
Anthony Liguori 已提交
2948
static void unassigned_mem_writew(void *opaque, target_phys_addr_t addr, uint32_t val)
2949 2950 2951 2952
{
#ifdef DEBUG_UNASSIGNED
    printf("Unassigned mem write " TARGET_FMT_plx " = 0x%x\n", addr, val);
#endif
2953
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2954 2955 2956 2957
    do_unassigned_access(addr, 1, 0, 0, 2);
#endif
}

A
Anthony Liguori 已提交
2958
static void unassigned_mem_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
2959 2960 2961 2962
{
#ifdef DEBUG_UNASSIGNED
    printf("Unassigned mem write " TARGET_FMT_plx " = 0x%x\n", addr, val);
#endif
2963
#if defined(TARGET_SPARC) || defined(TARGET_MICROBLAZE)
2964
    do_unassigned_access(addr, 1, 0, 0, 4);
2965
#endif
2966 2967
}

2968
static CPUReadMemoryFunc * const unassigned_mem_read[3] = {
2969
    unassigned_mem_readb,
2970 2971
    unassigned_mem_readw,
    unassigned_mem_readl,
2972 2973
};

2974
static CPUWriteMemoryFunc * const unassigned_mem_write[3] = {
2975
    unassigned_mem_writeb,
2976 2977
    unassigned_mem_writew,
    unassigned_mem_writel,
2978 2979
};

A
Anthony Liguori 已提交
2980
static void notdirty_mem_writeb(void *opaque, target_phys_addr_t ram_addr,
P
pbrook 已提交
2981
                                uint32_t val)
2982
{
2983
    int dirty_flags;
2984
    dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
2985
    if (!(dirty_flags & CODE_DIRTY_FLAG)) {
2986
#if !defined(CONFIG_USER_ONLY)
2987
        tb_invalidate_phys_page_fast(ram_addr, 1);
2988
        dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
2989
#endif
2990
    }
P
pbrook 已提交
2991
    stb_p(qemu_get_ram_ptr(ram_addr), val);
B
bellard 已提交
2992
    dirty_flags |= (0xff & ~CODE_DIRTY_FLAG);
2993
    cpu_physical_memory_set_dirty_flags(ram_addr, dirty_flags);
B
bellard 已提交
2994 2995 2996
    /* we remove the notdirty callback only if the code has been
       flushed */
    if (dirty_flags == 0xff)
P
pbrook 已提交
2997
        tlb_set_dirty(cpu_single_env, cpu_single_env->mem_io_vaddr);
2998 2999
}

A
Anthony Liguori 已提交
3000
static void notdirty_mem_writew(void *opaque, target_phys_addr_t ram_addr,
P
pbrook 已提交
3001
                                uint32_t val)
3002
{
3003
    int dirty_flags;
3004
    dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
3005
    if (!(dirty_flags & CODE_DIRTY_FLAG)) {
3006
#if !defined(CONFIG_USER_ONLY)
3007
        tb_invalidate_phys_page_fast(ram_addr, 2);
3008
        dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
3009
#endif
3010
    }
P
pbrook 已提交
3011
    stw_p(qemu_get_ram_ptr(ram_addr), val);
B
bellard 已提交
3012
    dirty_flags |= (0xff & ~CODE_DIRTY_FLAG);
3013
    cpu_physical_memory_set_dirty_flags(ram_addr, dirty_flags);
B
bellard 已提交
3014 3015 3016
    /* we remove the notdirty callback only if the code has been
       flushed */
    if (dirty_flags == 0xff)
P
pbrook 已提交
3017
        tlb_set_dirty(cpu_single_env, cpu_single_env->mem_io_vaddr);
3018 3019
}

A
Anthony Liguori 已提交
3020
static void notdirty_mem_writel(void *opaque, target_phys_addr_t ram_addr,
P
pbrook 已提交
3021
                                uint32_t val)
3022
{
3023
    int dirty_flags;
3024
    dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
3025
    if (!(dirty_flags & CODE_DIRTY_FLAG)) {
3026
#if !defined(CONFIG_USER_ONLY)
3027
        tb_invalidate_phys_page_fast(ram_addr, 4);
3028
        dirty_flags = cpu_physical_memory_get_dirty_flags(ram_addr);
3029
#endif
3030
    }
P
pbrook 已提交
3031
    stl_p(qemu_get_ram_ptr(ram_addr), val);
B
bellard 已提交
3032
    dirty_flags |= (0xff & ~CODE_DIRTY_FLAG);
3033
    cpu_physical_memory_set_dirty_flags(ram_addr, dirty_flags);
B
bellard 已提交
3034 3035 3036
    /* we remove the notdirty callback only if the code has been
       flushed */
    if (dirty_flags == 0xff)
P
pbrook 已提交
3037
        tlb_set_dirty(cpu_single_env, cpu_single_env->mem_io_vaddr);
3038 3039
}

3040
static CPUReadMemoryFunc * const error_mem_read[3] = {
3041 3042 3043 3044 3045
    NULL, /* never used */
    NULL, /* never used */
    NULL, /* never used */
};

3046
static CPUWriteMemoryFunc * const notdirty_mem_write[3] = {
3047 3048 3049 3050 3051
    notdirty_mem_writeb,
    notdirty_mem_writew,
    notdirty_mem_writel,
};

P
pbrook 已提交
3052
/* Generate a debug exception if a watchpoint has been hit.  */
3053
static void check_watchpoint(int offset, int len_mask, int flags)
P
pbrook 已提交
3054 3055
{
    CPUState *env = cpu_single_env;
3056 3057
    target_ulong pc, cs_base;
    TranslationBlock *tb;
P
pbrook 已提交
3058
    target_ulong vaddr;
3059
    CPUWatchpoint *wp;
3060
    int cpu_flags;
P
pbrook 已提交
3061

3062 3063 3064 3065 3066 3067 3068
    if (env->watchpoint_hit) {
        /* We re-entered the check after replacing the TB. Now raise
         * the debug interrupt so that is will trigger after the
         * current instruction. */
        cpu_interrupt(env, CPU_INTERRUPT_DEBUG);
        return;
    }
P
pbrook 已提交
3069
    vaddr = (env->mem_io_vaddr & TARGET_PAGE_MASK) + offset;
B
Blue Swirl 已提交
3070
    QTAILQ_FOREACH(wp, &env->watchpoints, entry) {
3071 3072
        if ((vaddr == (wp->vaddr & len_mask) ||
             (vaddr & wp->len_mask) == wp->vaddr) && (wp->flags & flags)) {
3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089
            wp->flags |= BP_WATCHPOINT_HIT;
            if (!env->watchpoint_hit) {
                env->watchpoint_hit = wp;
                tb = tb_find_pc(env->mem_io_pc);
                if (!tb) {
                    cpu_abort(env, "check_watchpoint: could not find TB for "
                              "pc=%p", (void *)env->mem_io_pc);
                }
                cpu_restore_state(tb, env, env->mem_io_pc, NULL);
                tb_phys_invalidate(tb, -1);
                if (wp->flags & BP_STOP_BEFORE_ACCESS) {
                    env->exception_index = EXCP_DEBUG;
                } else {
                    cpu_get_tb_cpu_state(env, &pc, &cs_base, &cpu_flags);
                    tb_gen_code(env, pc, cs_base, cpu_flags, 1);
                }
                cpu_resume_from_signal(env, NULL);
3090
            }
3091 3092
        } else {
            wp->flags &= ~BP_WATCHPOINT_HIT;
P
pbrook 已提交
3093 3094 3095 3096
        }
    }
}

3097 3098 3099
/* 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
Anthony Liguori 已提交
3100
static uint32_t watch_mem_readb(void *opaque, target_phys_addr_t addr)
3101
{
3102
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x0, BP_MEM_READ);
3103 3104 3105
    return ldub_phys(addr);
}

A
Anthony Liguori 已提交
3106
static uint32_t watch_mem_readw(void *opaque, target_phys_addr_t addr)
3107
{
3108
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x1, BP_MEM_READ);
3109 3110 3111
    return lduw_phys(addr);
}

A
Anthony Liguori 已提交
3112
static uint32_t watch_mem_readl(void *opaque, target_phys_addr_t addr)
3113
{
3114
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x3, BP_MEM_READ);
3115 3116 3117
    return ldl_phys(addr);
}

A
Anthony Liguori 已提交
3118
static void watch_mem_writeb(void *opaque, target_phys_addr_t addr,
3119 3120
                             uint32_t val)
{
3121
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x0, BP_MEM_WRITE);
3122 3123 3124
    stb_phys(addr, val);
}

A
Anthony Liguori 已提交
3125
static void watch_mem_writew(void *opaque, target_phys_addr_t addr,
3126 3127
                             uint32_t val)
{
3128
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x1, BP_MEM_WRITE);
3129 3130 3131
    stw_phys(addr, val);
}

A
Anthony Liguori 已提交
3132
static void watch_mem_writel(void *opaque, target_phys_addr_t addr,
3133 3134
                             uint32_t val)
{
3135
    check_watchpoint(addr & ~TARGET_PAGE_MASK, ~0x3, BP_MEM_WRITE);
3136 3137 3138
    stl_phys(addr, val);
}

3139
static CPUReadMemoryFunc * const watch_mem_read[3] = {
3140 3141 3142 3143 3144
    watch_mem_readb,
    watch_mem_readw,
    watch_mem_readl,
};

3145
static CPUWriteMemoryFunc * const watch_mem_write[3] = {
3146 3147 3148 3149 3150
    watch_mem_writeb,
    watch_mem_writew,
    watch_mem_writel,
};

A
Anthony Liguori 已提交
3151
static inline uint32_t subpage_readlen (subpage_t *mmio, target_phys_addr_t addr,
3152 3153 3154 3155 3156
                                 unsigned int len)
{
    uint32_t ret;
    unsigned int idx;

3157
    idx = SUBPAGE_IDX(addr);
3158 3159 3160 3161
#if defined(DEBUG_SUBPAGE)
    printf("%s: subpage %p len %d addr " TARGET_FMT_plx " idx %d\n", __func__,
           mmio, len, addr, idx);
#endif
3162 3163
    ret = (**mmio->mem_read[idx][len])(mmio->opaque[idx][0][len],
                                       addr + mmio->region_offset[idx][0][len]);
3164 3165 3166 3167

    return ret;
}

A
Anthony Liguori 已提交
3168
static inline void subpage_writelen (subpage_t *mmio, target_phys_addr_t addr,
3169 3170 3171 3172
                              uint32_t value, unsigned int len)
{
    unsigned int idx;

3173
    idx = SUBPAGE_IDX(addr);
3174 3175 3176 3177
#if defined(DEBUG_SUBPAGE)
    printf("%s: subpage %p len %d addr " TARGET_FMT_plx " idx %d value %08x\n", __func__,
           mmio, len, addr, idx, value);
#endif
3178 3179 3180
    (**mmio->mem_write[idx][len])(mmio->opaque[idx][1][len],
                                  addr + mmio->region_offset[idx][1][len],
                                  value);
3181 3182
}

A
Anthony Liguori 已提交
3183
static uint32_t subpage_readb (void *opaque, target_phys_addr_t addr)
3184 3185 3186 3187 3188 3189 3190 3191
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx "\n", __func__, addr);
#endif

    return subpage_readlen(opaque, addr, 0);
}

A
Anthony Liguori 已提交
3192
static void subpage_writeb (void *opaque, target_phys_addr_t addr,
3193 3194 3195 3196 3197 3198 3199 3200
                            uint32_t value)
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx " val %08x\n", __func__, addr, value);
#endif
    subpage_writelen(opaque, addr, value, 0);
}

A
Anthony Liguori 已提交
3201
static uint32_t subpage_readw (void *opaque, target_phys_addr_t addr)
3202 3203 3204 3205 3206 3207 3208 3209
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx "\n", __func__, addr);
#endif

    return subpage_readlen(opaque, addr, 1);
}

A
Anthony Liguori 已提交
3210
static void subpage_writew (void *opaque, target_phys_addr_t addr,
3211 3212 3213 3214 3215 3216 3217 3218
                            uint32_t value)
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx " val %08x\n", __func__, addr, value);
#endif
    subpage_writelen(opaque, addr, value, 1);
}

A
Anthony Liguori 已提交
3219
static uint32_t subpage_readl (void *opaque, target_phys_addr_t addr)
3220 3221 3222 3223 3224 3225 3226 3227 3228
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx "\n", __func__, addr);
#endif

    return subpage_readlen(opaque, addr, 2);
}

static void subpage_writel (void *opaque,
A
Anthony Liguori 已提交
3229
                         target_phys_addr_t addr, uint32_t value)
3230 3231 3232 3233 3234 3235 3236
{
#if defined(DEBUG_SUBPAGE)
    printf("%s: addr " TARGET_FMT_plx " val %08x\n", __func__, addr, value);
#endif
    subpage_writelen(opaque, addr, value, 2);
}

3237
static CPUReadMemoryFunc * const subpage_read[] = {
3238 3239 3240 3241 3242
    &subpage_readb,
    &subpage_readw,
    &subpage_readl,
};

3243
static CPUWriteMemoryFunc * const subpage_write[] = {
3244 3245 3246 3247 3248
    &subpage_writeb,
    &subpage_writew,
    &subpage_writel,
};

A
Anthony Liguori 已提交
3249 3250
static int subpage_register (subpage_t *mmio, uint32_t start, uint32_t end,
                             ram_addr_t memory, ram_addr_t region_offset)
3251 3252
{
    int idx, eidx;
3253
    unsigned int i;
3254 3255 3256 3257 3258 3259

    if (start >= TARGET_PAGE_SIZE || end >= TARGET_PAGE_SIZE)
        return -1;
    idx = SUBPAGE_IDX(start);
    eidx = SUBPAGE_IDX(end);
#if defined(DEBUG_SUBPAGE)
3260
    printf("%s: %p start %08x end %08x idx %08x eidx %08x mem %ld\n", __func__,
3261 3262 3263 3264
           mmio, start, end, idx, eidx, memory);
#endif
    memory >>= IO_MEM_SHIFT;
    for (; idx <= eidx; idx++) {
3265
        for (i = 0; i < 4; i++) {
3266 3267 3268
            if (io_mem_read[memory][i]) {
                mmio->mem_read[idx][i] = &io_mem_read[memory][i];
                mmio->opaque[idx][0][i] = io_mem_opaque[memory];
3269
                mmio->region_offset[idx][0][i] = region_offset;
3270 3271 3272 3273
            }
            if (io_mem_write[memory][i]) {
                mmio->mem_write[idx][i] = &io_mem_write[memory][i];
                mmio->opaque[idx][1][i] = io_mem_opaque[memory];
3274
                mmio->region_offset[idx][1][i] = region_offset;
3275
            }
3276
        }
3277 3278 3279 3280 3281
    }

    return 0;
}

A
Anthony Liguori 已提交
3282 3283
static void *subpage_init (target_phys_addr_t base, ram_addr_t *phys,
                           ram_addr_t orig_memory, ram_addr_t region_offset)
3284
{
A
Anthony Liguori 已提交
3285
    subpage_t *mmio;
3286 3287
    int subpage_memory;

A
Anthony Liguori 已提交
3288
    mmio = qemu_mallocz(sizeof(subpage_t));
3289 3290

    mmio->base = base;
3291
    subpage_memory = cpu_register_io_memory(subpage_read, subpage_write, mmio);
3292
#if defined(DEBUG_SUBPAGE)
3293 3294
    printf("%s: %p base " TARGET_FMT_plx " len %08x %d\n", __func__,
           mmio, base, TARGET_PAGE_SIZE, subpage_memory);
3295
#endif
3296 3297
    *phys = subpage_memory | IO_MEM_SUBPAGE;
    subpage_register(mmio, 0, TARGET_PAGE_SIZE - 1, orig_memory,
3298
                         region_offset);
3299 3300 3301 3302

    return mmio;
}

3303 3304 3305 3306 3307 3308 3309 3310 3311
static int get_free_io_mem_idx(void)
{
    int i;

    for (i = 0; i<IO_MEM_NB_ENTRIES; i++)
        if (!io_mem_used[i]) {
            io_mem_used[i] = 1;
            return i;
        }
3312
    fprintf(stderr, "RAN out out io_mem_idx, max %d !\n", IO_MEM_NB_ENTRIES);
3313 3314 3315
    return -1;
}

3316 3317
/* mem_read and mem_write are arrays of functions containing the
   function to access byte (index 0), word (index 1) and dword (index
3318
   2). Functions can be omitted with a NULL function pointer.
3319
   If io_index is non zero, the corresponding io zone is
3320 3321 3322
   modified. If it is zero, a new io zone is allocated. The return
   value can be used with cpu_register_physical_memory(). (-1) is
   returned if error. */
3323
static int cpu_register_io_memory_fixed(int io_index,
3324 3325
                                        CPUReadMemoryFunc * const *mem_read,
                                        CPUWriteMemoryFunc * const *mem_write,
3326
                                        void *opaque)
3327
{
3328
    int i, subwidth = 0;
3329 3330

    if (io_index <= 0) {
3331 3332 3333
        io_index = get_free_io_mem_idx();
        if (io_index == -1)
            return io_index;
3334
    } else {
3335
        io_index >>= IO_MEM_SHIFT;
3336 3337 3338
        if (io_index >= IO_MEM_NB_ENTRIES)
            return -1;
    }
B
bellard 已提交
3339

3340
    for(i = 0;i < 3; i++) {
3341 3342
        if (!mem_read[i] || !mem_write[i])
            subwidth = IO_MEM_SUBWIDTH;
3343 3344 3345
        io_mem_read[io_index][i] = mem_read[i];
        io_mem_write[io_index][i] = mem_write[i];
    }
B
bellard 已提交
3346
    io_mem_opaque[io_index] = opaque;
3347
    return (io_index << IO_MEM_SHIFT) | subwidth;
3348
}
B
bellard 已提交
3349

3350 3351
int cpu_register_io_memory(CPUReadMemoryFunc * const *mem_read,
                           CPUWriteMemoryFunc * const *mem_write,
3352 3353 3354 3355 3356
                           void *opaque)
{
    return cpu_register_io_memory_fixed(0, mem_read, mem_write, opaque);
}

3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369
void cpu_unregister_io_memory(int io_table_address)
{
    int i;
    int io_index = io_table_address >> IO_MEM_SHIFT;

    for (i=0;i < 3; i++) {
        io_mem_read[io_index][i] = unassigned_mem_read[i];
        io_mem_write[io_index][i] = unassigned_mem_write[i];
    }
    io_mem_opaque[io_index] = NULL;
    io_mem_used[io_index] = 0;
}

A
Avi Kivity 已提交
3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383
static void io_mem_init(void)
{
    int i;

    cpu_register_io_memory_fixed(IO_MEM_ROM, error_mem_read, unassigned_mem_write, NULL);
    cpu_register_io_memory_fixed(IO_MEM_UNASSIGNED, unassigned_mem_read, unassigned_mem_write, NULL);
    cpu_register_io_memory_fixed(IO_MEM_NOTDIRTY, error_mem_read, notdirty_mem_write, NULL);
    for (i=0; i<5; i++)
        io_mem_used[i] = 1;

    io_mem_watch = cpu_register_io_memory(watch_mem_read,
                                          watch_mem_write, NULL);
}

3384 3385
#endif /* !defined(CONFIG_USER_ONLY) */

B
bellard 已提交
3386 3387
/* physical memory access (slow version, mainly for debug) */
#if defined(CONFIG_USER_ONLY)
P
Paul Brook 已提交
3388 3389
int cpu_memory_rw_debug(CPUState *env, target_ulong addr,
                        uint8_t *buf, int len, int is_write)
B
bellard 已提交
3390 3391 3392
{
    int l, flags;
    target_ulong page;
3393
    void * p;
B
bellard 已提交
3394 3395 3396 3397 3398 3399 3400 3401

    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 已提交
3402
            return -1;
B
bellard 已提交
3403 3404
        if (is_write) {
            if (!(flags & PAGE_WRITE))
P
Paul Brook 已提交
3405
                return -1;
3406
            /* XXX: this code should not depend on lock_user */
A
aurel32 已提交
3407
            if (!(p = lock_user(VERIFY_WRITE, addr, l, 0)))
P
Paul Brook 已提交
3408
                return -1;
A
aurel32 已提交
3409 3410
            memcpy(p, buf, l);
            unlock_user(p, addr, l);
B
bellard 已提交
3411 3412
        } else {
            if (!(flags & PAGE_READ))
P
Paul Brook 已提交
3413
                return -1;
3414
            /* XXX: this code should not depend on lock_user */
A
aurel32 已提交
3415
            if (!(p = lock_user(VERIFY_READ, addr, l, 1)))
P
Paul Brook 已提交
3416
                return -1;
A
aurel32 已提交
3417
            memcpy(buf, p, l);
A
aurel32 已提交
3418
            unlock_user(p, addr, 0);
B
bellard 已提交
3419 3420 3421 3422 3423
        }
        len -= l;
        buf += l;
        addr += l;
    }
P
Paul Brook 已提交
3424
    return 0;
B
bellard 已提交
3425
}
B
bellard 已提交
3426

B
bellard 已提交
3427
#else
A
Anthony Liguori 已提交
3428
void cpu_physical_memory_rw(target_phys_addr_t addr, uint8_t *buf,
B
bellard 已提交
3429 3430 3431 3432 3433
                            int len, int is_write)
{
    int l, io_index;
    uint8_t *ptr;
    uint32_t val;
A
Anthony Liguori 已提交
3434
    target_phys_addr_t page;
3435
    unsigned long pd;
B
bellard 已提交
3436
    PhysPageDesc *p;
3437

B
bellard 已提交
3438 3439 3440 3441 3442
    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
        l = (page + TARGET_PAGE_SIZE) - addr;
        if (l > len)
            l = len;
B
bellard 已提交
3443
        p = phys_page_find(page >> TARGET_PAGE_BITS);
B
bellard 已提交
3444 3445 3446 3447 3448
        if (!p) {
            pd = IO_MEM_UNASSIGNED;
        } else {
            pd = p->phys_offset;
        }
3449

B
bellard 已提交
3450
        if (is_write) {
3451
            if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM) {
A
Anthony Liguori 已提交
3452
                target_phys_addr_t addr1 = addr;
B
bellard 已提交
3453
                io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3454
                if (p)
3455
                    addr1 = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
B
bellard 已提交
3456 3457
                /* XXX: could force cpu_single_env to NULL to avoid
                   potential bugs */
3458
                if (l >= 4 && ((addr1 & 3) == 0)) {
B
bellard 已提交
3459
                    /* 32 bit write access */
B
bellard 已提交
3460
                    val = ldl_p(buf);
3461
                    io_mem_write[io_index][2](io_mem_opaque[io_index], addr1, val);
B
bellard 已提交
3462
                    l = 4;
3463
                } else if (l >= 2 && ((addr1 & 1) == 0)) {
B
bellard 已提交
3464
                    /* 16 bit write access */
B
bellard 已提交
3465
                    val = lduw_p(buf);
3466
                    io_mem_write[io_index][1](io_mem_opaque[io_index], addr1, val);
B
bellard 已提交
3467 3468
                    l = 2;
                } else {
B
bellard 已提交
3469
                    /* 8 bit write access */
B
bellard 已提交
3470
                    val = ldub_p(buf);
3471
                    io_mem_write[io_index][0](io_mem_opaque[io_index], addr1, val);
B
bellard 已提交
3472 3473 3474
                    l = 1;
                }
            } else {
3475 3476
                unsigned long addr1;
                addr1 = (pd & TARGET_PAGE_MASK) + (addr & ~TARGET_PAGE_MASK);
B
bellard 已提交
3477
                /* RAM case */
P
pbrook 已提交
3478
                ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
3479
                memcpy(ptr, buf, l);
3480 3481 3482 3483
                if (!cpu_physical_memory_is_dirty(addr1)) {
                    /* invalidate code */
                    tb_invalidate_phys_page_range(addr1, addr1 + l, 0);
                    /* set dirty bit */
3484 3485
                    cpu_physical_memory_set_dirty_flags(
                        addr1, (0xff & ~CODE_DIRTY_FLAG));
3486
                }
B
bellard 已提交
3487 3488
            }
        } else {
3489
            if ((pd & ~TARGET_PAGE_MASK) > IO_MEM_ROM &&
3490
                !(pd & IO_MEM_ROMD)) {
A
Anthony Liguori 已提交
3491
                target_phys_addr_t addr1 = addr;
B
bellard 已提交
3492 3493
                /* I/O case */
                io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3494
                if (p)
3495 3496
                    addr1 = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
                if (l >= 4 && ((addr1 & 3) == 0)) {
B
bellard 已提交
3497
                    /* 32 bit read access */
3498
                    val = io_mem_read[io_index][2](io_mem_opaque[io_index], addr1);
B
bellard 已提交
3499
                    stl_p(buf, val);
B
bellard 已提交
3500
                    l = 4;
3501
                } else if (l >= 2 && ((addr1 & 1) == 0)) {
B
bellard 已提交
3502
                    /* 16 bit read access */
3503
                    val = io_mem_read[io_index][1](io_mem_opaque[io_index], addr1);
B
bellard 已提交
3504
                    stw_p(buf, val);
B
bellard 已提交
3505 3506
                    l = 2;
                } else {
B
bellard 已提交
3507
                    /* 8 bit read access */
3508
                    val = io_mem_read[io_index][0](io_mem_opaque[io_index], addr1);
B
bellard 已提交
3509
                    stb_p(buf, val);
B
bellard 已提交
3510 3511 3512 3513
                    l = 1;
                }
            } else {
                /* RAM case */
P
pbrook 已提交
3514
                ptr = qemu_get_ram_ptr(pd & TARGET_PAGE_MASK) +
B
bellard 已提交
3515 3516 3517 3518 3519 3520 3521 3522 3523
                    (addr & ~TARGET_PAGE_MASK);
                memcpy(buf, ptr, l);
            }
        }
        len -= l;
        buf += l;
        addr += l;
    }
}
B
bellard 已提交
3524

B
bellard 已提交
3525
/* used for ROM loading : can write in RAM and ROM */
A
Anthony Liguori 已提交
3526
void cpu_physical_memory_write_rom(target_phys_addr_t addr,
B
bellard 已提交
3527 3528 3529 3530
                                   const uint8_t *buf, int len)
{
    int l;
    uint8_t *ptr;
A
Anthony Liguori 已提交
3531
    target_phys_addr_t page;
B
bellard 已提交
3532 3533
    unsigned long pd;
    PhysPageDesc *p;
3534

B
bellard 已提交
3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545
    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
        l = (page + TARGET_PAGE_SIZE) - addr;
        if (l > len)
            l = len;
        p = phys_page_find(page >> TARGET_PAGE_BITS);
        if (!p) {
            pd = IO_MEM_UNASSIGNED;
        } else {
            pd = p->phys_offset;
        }
3546

B
bellard 已提交
3547
        if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM &&
3548 3549
            (pd & ~TARGET_PAGE_MASK) != IO_MEM_ROM &&
            !(pd & IO_MEM_ROMD)) {
B
bellard 已提交
3550 3551 3552 3553 3554
            /* do nothing */
        } else {
            unsigned long addr1;
            addr1 = (pd & TARGET_PAGE_MASK) + (addr & ~TARGET_PAGE_MASK);
            /* ROM/RAM case */
P
pbrook 已提交
3555
            ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
3556 3557 3558 3559 3560 3561 3562 3563
            memcpy(ptr, buf, l);
        }
        len -= l;
        buf += l;
        addr += l;
    }
}

3564 3565
typedef struct {
    void *buffer;
A
Anthony Liguori 已提交
3566 3567
    target_phys_addr_t addr;
    target_phys_addr_t len;
3568 3569 3570 3571
} BounceBuffer;

static BounceBuffer bounce;

3572 3573 3574
typedef struct MapClient {
    void *opaque;
    void (*callback)(void *opaque);
B
Blue Swirl 已提交
3575
    QLIST_ENTRY(MapClient) link;
3576 3577
} MapClient;

B
Blue Swirl 已提交
3578 3579
static QLIST_HEAD(map_client_list, MapClient) map_client_list
    = QLIST_HEAD_INITIALIZER(map_client_list);
3580 3581 3582 3583 3584 3585 3586

void *cpu_register_map_client(void *opaque, void (*callback)(void *opaque))
{
    MapClient *client = qemu_malloc(sizeof(*client));

    client->opaque = opaque;
    client->callback = callback;
B
Blue Swirl 已提交
3587
    QLIST_INSERT_HEAD(&map_client_list, client, link);
3588 3589 3590 3591 3592 3593 3594
    return client;
}

void cpu_unregister_map_client(void *_client)
{
    MapClient *client = (MapClient *)_client;

B
Blue Swirl 已提交
3595
    QLIST_REMOVE(client, link);
3596
    qemu_free(client);
3597 3598 3599 3600 3601 3602
}

static void cpu_notify_map_clients(void)
{
    MapClient *client;

B
Blue Swirl 已提交
3603 3604
    while (!QLIST_EMPTY(&map_client_list)) {
        client = QLIST_FIRST(&map_client_list);
3605
        client->callback(client->opaque);
3606
        cpu_unregister_map_client(client);
3607 3608 3609
    }
}

3610 3611 3612 3613
/* 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.
3614 3615
 * Use cpu_register_map_client() to know when retrying the map operation is
 * likely to succeed.
3616
 */
A
Anthony Liguori 已提交
3617 3618
void *cpu_physical_memory_map(target_phys_addr_t addr,
                              target_phys_addr_t *plen,
3619 3620
                              int is_write)
{
A
Anthony Liguori 已提交
3621 3622
    target_phys_addr_t len = *plen;
    target_phys_addr_t done = 0;
3623 3624 3625
    int l;
    uint8_t *ret = NULL;
    uint8_t *ptr;
A
Anthony Liguori 已提交
3626
    target_phys_addr_t page;
3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655
    unsigned long pd;
    PhysPageDesc *p;
    unsigned long addr1;

    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
        l = (page + TARGET_PAGE_SIZE) - addr;
        if (l > len)
            l = len;
        p = phys_page_find(page >> TARGET_PAGE_BITS);
        if (!p) {
            pd = IO_MEM_UNASSIGNED;
        } else {
            pd = p->phys_offset;
        }

        if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM) {
            if (done || bounce.buffer) {
                break;
            }
            bounce.buffer = qemu_memalign(TARGET_PAGE_SIZE, TARGET_PAGE_SIZE);
            bounce.addr = addr;
            bounce.len = l;
            if (!is_write) {
                cpu_physical_memory_rw(addr, bounce.buffer, l, 0);
            }
            ptr = bounce.buffer;
        } else {
            addr1 = (pd & TARGET_PAGE_MASK) + (addr & ~TARGET_PAGE_MASK);
P
pbrook 已提交
3656
            ptr = qemu_get_ram_ptr(addr1);
3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675
        }
        if (!done) {
            ret = ptr;
        } else if (ret + done != ptr) {
            break;
        }

        len -= l;
        addr += l;
        done += l;
    }
    *plen = done;
    return ret;
}

/* Unmaps a memory region previously mapped by cpu_physical_memory_map().
 * 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
Anthony Liguori 已提交
3676 3677
void cpu_physical_memory_unmap(void *buffer, target_phys_addr_t len,
                               int is_write, target_phys_addr_t access_len)
3678 3679 3680
{
    if (buffer != bounce.buffer) {
        if (is_write) {
A
Anthony Liguori 已提交
3681
            ram_addr_t addr1 = qemu_ram_addr_from_host(buffer);
3682 3683 3684 3685 3686 3687 3688 3689 3690
            while (access_len) {
                unsigned l;
                l = TARGET_PAGE_SIZE;
                if (l > access_len)
                    l = access_len;
                if (!cpu_physical_memory_is_dirty(addr1)) {
                    /* invalidate code */
                    tb_invalidate_phys_page_range(addr1, addr1 + l, 0);
                    /* set dirty bit */
3691 3692
                    cpu_physical_memory_set_dirty_flags(
                        addr1, (0xff & ~CODE_DIRTY_FLAG));
3693 3694 3695 3696 3697 3698 3699 3700 3701 3702
                }
                addr1 += l;
                access_len -= l;
            }
        }
        return;
    }
    if (is_write) {
        cpu_physical_memory_write(bounce.addr, bounce.buffer, access_len);
    }
3703
    qemu_vfree(bounce.buffer);
3704
    bounce.buffer = NULL;
3705
    cpu_notify_map_clients();
3706
}
B
bellard 已提交
3707

B
bellard 已提交
3708
/* warning: addr must be aligned */
A
Anthony Liguori 已提交
3709
uint32_t ldl_phys(target_phys_addr_t addr)
B
bellard 已提交
3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722
{
    int io_index;
    uint8_t *ptr;
    uint32_t val;
    unsigned long pd;
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
3723

3724
    if ((pd & ~TARGET_PAGE_MASK) > IO_MEM_ROM &&
3725
        !(pd & IO_MEM_ROMD)) {
B
bellard 已提交
3726 3727
        /* I/O case */
        io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3728 3729
        if (p)
            addr = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
B
bellard 已提交
3730 3731 3732
        val = io_mem_read[io_index][2](io_mem_opaque[io_index], addr);
    } else {
        /* RAM case */
P
pbrook 已提交
3733
        ptr = qemu_get_ram_ptr(pd & TARGET_PAGE_MASK) +
B
bellard 已提交
3734 3735 3736 3737 3738 3739
            (addr & ~TARGET_PAGE_MASK);
        val = ldl_p(ptr);
    }
    return val;
}

B
bellard 已提交
3740
/* warning: addr must be aligned */
A
Anthony Liguori 已提交
3741
uint64_t ldq_phys(target_phys_addr_t addr)
B
bellard 已提交
3742 3743 3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754
{
    int io_index;
    uint8_t *ptr;
    uint64_t val;
    unsigned long pd;
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
3755

3756 3757
    if ((pd & ~TARGET_PAGE_MASK) > IO_MEM_ROM &&
        !(pd & IO_MEM_ROMD)) {
B
bellard 已提交
3758 3759
        /* I/O case */
        io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3760 3761
        if (p)
            addr = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
B
bellard 已提交
3762 3763 3764 3765 3766 3767 3768 3769 3770
#ifdef TARGET_WORDS_BIGENDIAN
        val = (uint64_t)io_mem_read[io_index][2](io_mem_opaque[io_index], addr) << 32;
        val |= io_mem_read[io_index][2](io_mem_opaque[io_index], addr + 4);
#else
        val = io_mem_read[io_index][2](io_mem_opaque[io_index], addr);
        val |= (uint64_t)io_mem_read[io_index][2](io_mem_opaque[io_index], addr + 4) << 32;
#endif
    } else {
        /* RAM case */
P
pbrook 已提交
3771
        ptr = qemu_get_ram_ptr(pd & TARGET_PAGE_MASK) +
B
bellard 已提交
3772 3773 3774 3775 3776 3777
            (addr & ~TARGET_PAGE_MASK);
        val = ldq_p(ptr);
    }
    return val;
}

B
bellard 已提交
3778
/* XXX: optimize */
A
Anthony Liguori 已提交
3779
uint32_t ldub_phys(target_phys_addr_t addr)
B
bellard 已提交
3780 3781 3782 3783 3784 3785 3786
{
    uint8_t val;
    cpu_physical_memory_read(addr, &val, 1);
    return val;
}

/* XXX: optimize */
A
Anthony Liguori 已提交
3787
uint32_t lduw_phys(target_phys_addr_t addr)
B
bellard 已提交
3788 3789 3790 3791 3792 3793
{
    uint16_t val;
    cpu_physical_memory_read(addr, (uint8_t *)&val, 2);
    return tswap16(val);
}

B
bellard 已提交
3794 3795 3796
/* 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 */
A
Anthony Liguori 已提交
3797
void stl_phys_notdirty(target_phys_addr_t addr, uint32_t val)
B
bellard 已提交
3798 3799 3800 3801 3802 3803 3804 3805 3806 3807 3808 3809
{
    int io_index;
    uint8_t *ptr;
    unsigned long pd;
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
3810

3811
    if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM) {
B
bellard 已提交
3812
        io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3813 3814
        if (p)
            addr = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
B
bellard 已提交
3815 3816
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr, val);
    } else {
A
aliguori 已提交
3817
        unsigned long addr1 = (pd & TARGET_PAGE_MASK) + (addr & ~TARGET_PAGE_MASK);
P
pbrook 已提交
3818
        ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
3819
        stl_p(ptr, val);
A
aliguori 已提交
3820 3821 3822 3823 3824 3825

        if (unlikely(in_migration)) {
            if (!cpu_physical_memory_is_dirty(addr1)) {
                /* invalidate code */
                tb_invalidate_phys_page_range(addr1, addr1 + 4, 0);
                /* set dirty bit */
3826 3827
                cpu_physical_memory_set_dirty_flags(
                    addr1, (0xff & ~CODE_DIRTY_FLAG));
A
aliguori 已提交
3828 3829
            }
        }
B
bellard 已提交
3830 3831 3832
    }
}

A
Anthony Liguori 已提交
3833
void stq_phys_notdirty(target_phys_addr_t addr, uint64_t val)
J
j_mayer 已提交
3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845
{
    int io_index;
    uint8_t *ptr;
    unsigned long pd;
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
3846

J
j_mayer 已提交
3847 3848
    if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM) {
        io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3849 3850
        if (p)
            addr = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
J
j_mayer 已提交
3851 3852 3853 3854 3855 3856 3857 3858
#ifdef TARGET_WORDS_BIGENDIAN
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr, val >> 32);
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr + 4, val);
#else
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr, val);
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr + 4, val >> 32);
#endif
    } else {
P
pbrook 已提交
3859
        ptr = qemu_get_ram_ptr(pd & TARGET_PAGE_MASK) +
J
j_mayer 已提交
3860 3861 3862 3863 3864
            (addr & ~TARGET_PAGE_MASK);
        stq_p(ptr, val);
    }
}

B
bellard 已提交
3865
/* warning: addr must be aligned */
A
Anthony Liguori 已提交
3866
void stl_phys(target_phys_addr_t addr, uint32_t val)
B
bellard 已提交
3867 3868 3869 3870 3871 3872 3873 3874 3875 3876 3877 3878
{
    int io_index;
    uint8_t *ptr;
    unsigned long pd;
    PhysPageDesc *p;

    p = phys_page_find(addr >> TARGET_PAGE_BITS);
    if (!p) {
        pd = IO_MEM_UNASSIGNED;
    } else {
        pd = p->phys_offset;
    }
3879

3880
    if ((pd & ~TARGET_PAGE_MASK) != IO_MEM_RAM) {
B
bellard 已提交
3881
        io_index = (pd >> IO_MEM_SHIFT) & (IO_MEM_NB_ENTRIES - 1);
3882 3883
        if (p)
            addr = (addr & ~TARGET_PAGE_MASK) + p->region_offset;
B
bellard 已提交
3884 3885 3886 3887 3888
        io_mem_write[io_index][2](io_mem_opaque[io_index], addr, val);
    } else {
        unsigned long addr1;
        addr1 = (pd & TARGET_PAGE_MASK) + (addr & ~TARGET_PAGE_MASK);
        /* RAM case */
P
pbrook 已提交
3889
        ptr = qemu_get_ram_ptr(addr1);
B
bellard 已提交
3890
        stl_p(ptr, val);
3891 3892 3893 3894
        if (!cpu_physical_memory_is_dirty(addr1)) {
            /* invalidate code */
            tb_invalidate_phys_page_range(addr1, addr1 + 4, 0);
            /* set dirty bit */
3895 3896
            cpu_physical_memory_set_dirty_flags(addr1,
                (0xff & ~CODE_DIRTY_FLAG));
3897
        }
B
bellard 已提交
3898 3899 3900
    }
}

B
bellard 已提交
3901
/* XXX: optimize */
A
Anthony Liguori 已提交
3902
void stb_phys(target_phys_addr_t addr, uint32_t val)
B
bellard 已提交
3903 3904 3905 3906 3907 3908
{
    uint8_t v = val;
    cpu_physical_memory_write(addr, &v, 1);
}

/* XXX: optimize */
A
Anthony Liguori 已提交
3909
void stw_phys(target_phys_addr_t addr, uint32_t val)
B
bellard 已提交
3910 3911 3912 3913 3914 3915
{
    uint16_t v = tswap16(val);
    cpu_physical_memory_write(addr, (const uint8_t *)&v, 2);
}

/* XXX: optimize */
A
Anthony Liguori 已提交
3916
void stq_phys(target_phys_addr_t addr, uint64_t val)
B
bellard 已提交
3917 3918 3919 3920 3921
{
    val = tswap64(val);
    cpu_physical_memory_write(addr, (const uint8_t *)&val, 8);
}

3922
/* virtual memory access for debug (includes writing to ROM) */
3923
int cpu_memory_rw_debug(CPUState *env, target_ulong addr,
3924
                        uint8_t *buf, int len, int is_write)
B
bellard 已提交
3925 3926
{
    int l;
A
Anthony Liguori 已提交
3927
    target_phys_addr_t phys_addr;
3928
    target_ulong page;
B
bellard 已提交
3929 3930 3931 3932 3933 3934 3935 3936 3937 3938

    while (len > 0) {
        page = addr & TARGET_PAGE_MASK;
        phys_addr = cpu_get_phys_page_debug(env, page);
        /* 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;
3939 3940 3941 3942 3943
        phys_addr += (addr & ~TARGET_PAGE_MASK);
        if (is_write)
            cpu_physical_memory_write_rom(phys_addr, buf, l);
        else
            cpu_physical_memory_rw(phys_addr, buf, l, is_write);
B
bellard 已提交
3944 3945 3946 3947 3948 3949
        len -= l;
        buf += l;
        addr += l;
    }
    return 0;
}
P
Paul Brook 已提交
3950
#endif
B
bellard 已提交
3951

P
pbrook 已提交
3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968
/* in deterministic execution mode, instructions doing device I/Os
   must be at the end of the TB */
void cpu_io_recompile(CPUState *env, void *retaddr)
{
    TranslationBlock *tb;
    uint32_t n, cflags;
    target_ulong pc, cs_base;
    uint64_t flags;

    tb = tb_find_pc((unsigned long)retaddr);
    if (!tb) {
        cpu_abort(env, "cpu_io_recompile: could not find TB for pc=%p", 
                  retaddr);
    }
    n = env->icount_decr.u16.low + tb->icount;
    cpu_restore_state(tb, env, (unsigned long)retaddr, NULL);
    /* Calculate how many instructions had been executed before the fault
T
ths 已提交
3969
       occurred.  */
P
pbrook 已提交
3970 3971 3972 3973 3974
    n = n - env->icount_decr.u16.low;
    /* Generate a new TB ending on the I/O insn.  */
    n++;
    /* On MIPS and SH, delay slot instructions can only be restarted if
       they were already the first instruction in the TB.  If this is not
T
ths 已提交
3975
       the first instruction in a TB then re-execute the preceding
P
pbrook 已提交
3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002
       branch.  */
#if defined(TARGET_MIPS)
    if ((env->hflags & MIPS_HFLAG_BMASK) != 0 && n > 1) {
        env->active_tc.PC -= 4;
        env->icount_decr.u16.low++;
        env->hflags &= ~MIPS_HFLAG_BMASK;
    }
#elif defined(TARGET_SH4)
    if ((env->flags & ((DELAY_SLOT | DELAY_SLOT_CONDITIONAL))) != 0
            && n > 1) {
        env->pc -= 2;
        env->icount_decr.u16.low++;
        env->flags &= ~(DELAY_SLOT | DELAY_SLOT_CONDITIONAL);
    }
#endif
    /* This should never happen.  */
    if (n > CF_COUNT_MASK)
        cpu_abort(env, "TB too big during recompile");

    cflags = n | CF_LAST_IO;
    pc = tb->pc;
    cs_base = tb->cs_base;
    flags = tb->flags;
    tb_phys_invalidate(tb, -1);
    /* FIXME: In theory this could raise an exception.  In practice
       we have already translated the block once so it's probably ok.  */
    tb_gen_code(env, pc, cs_base, flags, cflags);
T
ths 已提交
4003
    /* TODO: If env->pc != tb->pc (i.e. the faulting instruction was not
P
pbrook 已提交
4004 4005 4006 4007 4008 4009 4010
       the first in the TB) then we end up generating a whole new TB and
       repeating the fault, which is horribly inefficient.
       Better would be to execute just this insn uncached, or generate a
       second new TB.  */
    cpu_resume_from_signal(env, NULL);
}

4011 4012
#if !defined(CONFIG_USER_ONLY)

B
bellard 已提交
4013 4014 4015 4016 4017 4018
void dump_exec_info(FILE *f,
                    int (*cpu_fprintf)(FILE *f, const char *fmt, ...))
{
    int i, target_code_size, max_target_code_size;
    int direct_jmp_count, direct_jmp2_count, cross_page;
    TranslationBlock *tb;
4019

B
bellard 已提交
4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038 4039
    target_code_size = 0;
    max_target_code_size = 0;
    cross_page = 0;
    direct_jmp_count = 0;
    direct_jmp2_count = 0;
    for(i = 0; i < nb_tbs; i++) {
        tb = &tbs[i];
        target_code_size += tb->size;
        if (tb->size > max_target_code_size)
            max_target_code_size = tb->size;
        if (tb->page_addr[1] != -1)
            cross_page++;
        if (tb->tb_next_offset[0] != 0xffff) {
            direct_jmp_count++;
            if (tb->tb_next_offset[1] != 0xffff) {
                direct_jmp2_count++;
            }
        }
    }
    /* XXX: avoid using doubles ? */
B
bellard 已提交
4040
    cpu_fprintf(f, "Translation buffer state:\n");
4041 4042 4043 4044
    cpu_fprintf(f, "gen code size       %ld/%ld\n",
                code_gen_ptr - code_gen_buffer, code_gen_buffer_max_size);
    cpu_fprintf(f, "TB count            %d/%d\n", 
                nb_tbs, code_gen_max_blocks);
4045
    cpu_fprintf(f, "TB avg target size  %d max=%d bytes\n",
B
bellard 已提交
4046 4047
                nb_tbs ? target_code_size / nb_tbs : 0,
                max_target_code_size);
4048
    cpu_fprintf(f, "TB avg host size    %d bytes (expansion ratio: %0.1f)\n",
B
bellard 已提交
4049 4050
                nb_tbs ? (code_gen_ptr - code_gen_buffer) / nb_tbs : 0,
                target_code_size ? (double) (code_gen_ptr - code_gen_buffer) / target_code_size : 0);
4051 4052
    cpu_fprintf(f, "cross page TB count %d (%d%%)\n",
            cross_page,
B
bellard 已提交
4053 4054
            nb_tbs ? (cross_page * 100) / nb_tbs : 0);
    cpu_fprintf(f, "direct jump count   %d (%d%%) (2 jumps=%d %d%%)\n",
4055
                direct_jmp_count,
B
bellard 已提交
4056 4057 4058
                nb_tbs ? (direct_jmp_count * 100) / nb_tbs : 0,
                direct_jmp2_count,
                nb_tbs ? (direct_jmp2_count * 100) / nb_tbs : 0);
B
bellard 已提交
4059
    cpu_fprintf(f, "\nStatistics:\n");
B
bellard 已提交
4060 4061 4062
    cpu_fprintf(f, "TB flush count      %d\n", tb_flush_count);
    cpu_fprintf(f, "TB invalidate count %d\n", tb_phys_invalidate_count);
    cpu_fprintf(f, "TLB flush count     %d\n", tlb_flush_count);
B
bellard 已提交
4063
    tcg_dump_info(f, cpu_fprintf);
B
bellard 已提交
4064 4065
}

B
bellard 已提交
4066 4067 4068
#define MMUSUFFIX _cmmu
#define GETPC() NULL
#define env cpu_single_env
B
bellard 已提交
4069
#define SOFTMMU_CODE_ACCESS
B
bellard 已提交
4070 4071 4072 4073 4074 4075 4076 4077 4078 4079 4080 4081 4082 4083 4084 4085

#define SHIFT 0
#include "softmmu_template.h"

#define SHIFT 1
#include "softmmu_template.h"

#define SHIFT 2
#include "softmmu_template.h"

#define SHIFT 3
#include "softmmu_template.h"

#undef env

#endif