mips_malta.c 48.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * QEMU Malta board support
 *
 * Copyright (c) 2006 Aurelien Jarno
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

P
Peter Maydell 已提交
25
#include "qemu/osdep.h"
26
#include "qemu/units.h"
27 28
#include "qemu-common.h"
#include "cpu.h"
29
#include "hw/hw.h"
P
Paolo Bonzini 已提交
30
#include "hw/i386/pc.h"
31
#include "hw/isa/superio.h"
32
#include "hw/dma/i8257.h"
P
Paolo Bonzini 已提交
33
#include "hw/char/serial.h"
P
Paolo Bonzini 已提交
34
#include "net/net.h"
35
#include "hw/boards.h"
P
Paolo Bonzini 已提交
36 37 38 39
#include "hw/i2c/smbus.h"
#include "hw/block/flash.h"
#include "hw/mips/mips.h"
#include "hw/mips/cpudevs.h"
40
#include "hw/pci/pci.h"
41 42
#include "sysemu/sysemu.h"
#include "sysemu/arch_init.h"
43
#include "qemu/log.h"
P
Paolo Bonzini 已提交
44
#include "hw/mips/bios.h"
45 46
#include "hw/ide.h"
#include "hw/loader.h"
B
Blue Swirl 已提交
47
#include "elf.h"
P
Paolo Bonzini 已提交
48 49
#include "hw/timer/mc146818rtc.h"
#include "hw/timer/i8254.h"
50
#include "exec/address-spaces.h"
51
#include "hw/sysbus.h"             /* SysBusDevice */
52
#include "qemu/host-utils.h"
53
#include "sysemu/qtest.h"
54
#include "qapi/error.h"
55
#include "qemu/error-report.h"
56
#include "hw/empty_slot.h"
J
James Hogan 已提交
57
#include "sysemu/kvm.h"
58
#include "exec/semihost.h"
59
#include "hw/mips/cps.h"
60

T
ths 已提交
61 62
//#define DEBUG_BOARD_INIT

63
#define ENVP_ADDR		0x80002000l
64 65 66
#define ENVP_NB_ENTRIES	 	16
#define ENVP_ENTRY_SIZE	 	256

67 68 69 70 71 72 73
/* Hardware addresses */
#define FLASH_ADDRESS 0x1e000000ULL
#define FPGA_ADDRESS  0x1f000000ULL
#define RESET_ADDRESS 0x1fc00000ULL

#define FLASH_SIZE    0x400000

T
ths 已提交
74 75
#define MAX_IDE_BUS 2

76
typedef struct {
A
Avi Kivity 已提交
77 78 79
    MemoryRegion iomem;
    MemoryRegion iomem_lo; /* 0 - 0x900 */
    MemoryRegion iomem_hi; /* 0xa00 - 0x100000 */
80 81 82
    uint32_t leds;
    uint32_t brk;
    uint32_t gpout;
83
    uint32_t i2cin;
84 85 86
    uint32_t i2coe;
    uint32_t i2cout;
    uint32_t i2csel;
87
    CharBackend display;
88
    char display_text[9];
T
ths 已提交
89
    SerialState *uart;
90
    bool display_inited;
91 92
} MaltaFPGAState;

A
Andreas Färber 已提交
93 94 95
#define TYPE_MIPS_MALTA "mips-malta"
#define MIPS_MALTA(obj) OBJECT_CHECK(MaltaState, (obj), TYPE_MIPS_MALTA)

96
typedef struct {
A
Andreas Färber 已提交
97 98
    SysBusDevice parent_obj;

99
    MIPSCPSState *cps;
100 101 102
    qemu_irq *i8259;
} MaltaState;

B
Blue Swirl 已提交
103
static ISADevice *pit;
104

105
static struct _loaderparams {
106
    int ram_size, ram_low_size;
107 108 109 110 111
    const char *kernel_filename;
    const char *kernel_cmdline;
    const char *initrd_filename;
} loaderparams;

112 113 114 115 116 117 118
/* Malta FPGA */
static void malta_fpga_update_display(void *opaque)
{
    char leds_text[9];
    int i;
    MaltaFPGAState *s = opaque;

T
ths 已提交
119 120 121 122 123
    for (i = 7 ; i >= 0 ; i--) {
        if (s->leds & (1 << i))
            leds_text[i] = '#';
        else
            leds_text[i] = ' ';
124
    }
T
ths 已提交
125 126
    leds_text[8] = '\0';

127
    qemu_chr_fe_printf(&s->display, "\e[H\n\n|\e[32m%-8.8s\e[00m|\r\n",
128
                       leds_text);
129
    qemu_chr_fe_printf(&s->display, "\n\n\n\n|\e[31m%-8.8s\e[00m|",
130
                       s->display_text);
131 132
}

133 134 135 136 137 138 139 140 141 142 143 144 145
/*
 * EEPROM 24C01 / 24C02 emulation.
 *
 * Emulation for serial EEPROMs:
 * 24C01 - 1024 bit (128 x 8)
 * 24C02 - 2048 bit (256 x 8)
 *
 * Typical device names include Microchip 24C02SC or SGS Thomson ST24C02.
 */

//~ #define DEBUG

#if defined(DEBUG)
146
#  define logout(fmt, ...) fprintf(stderr, "MALTA\t%-24s" fmt, __func__, ## __VA_ARGS__)
147
#else
148
#  define logout(fmt, ...) ((void)0)
149 150
#endif

A
Anthony Liguori 已提交
151
struct _eeprom24c0x_t {
152 153 154 155 156 157 158 159 160 161 162
  uint8_t tick;
  uint8_t address;
  uint8_t command;
  uint8_t ack;
  uint8_t scl;
  uint8_t sda;
  uint8_t data;
  //~ uint16_t size;
  uint8_t contents[256];
};

A
Anthony Liguori 已提交
163
typedef struct _eeprom24c0x_t eeprom24c0x_t;
164

165
static eeprom24c0x_t spd_eeprom = {
166
    .contents = {
167
        /* 00000000: */ 0x80,0x08,0xFF,0x0D,0x0A,0xFF,0x40,0x00,
168
        /* 00000008: */ 0x01,0x75,0x54,0x00,0x82,0x08,0x00,0x01,
169 170
        /* 00000010: */ 0x8F,0x04,0x02,0x01,0x01,0x00,0x00,0x00,
        /* 00000018: */ 0x00,0x00,0x00,0x14,0x0F,0x14,0x2D,0xFF,
171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
        /* 00000020: */ 0x15,0x08,0x15,0x08,0x00,0x00,0x00,0x00,
        /* 00000028: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000030: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000038: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x12,0xD0,
        /* 00000040: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000048: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000050: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000058: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000060: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000068: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000070: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
        /* 00000078: */ 0x00,0x00,0x00,0x00,0x00,0x00,0x64,0xF4,
    },
};

186
static void generate_eeprom_spd(uint8_t *eeprom, ram_addr_t ram_size)
187 188
{
    enum { SDR = 0x4, DDR2 = 0x8 } type;
189
    uint8_t *spd = spd_eeprom.contents;
190 191 192 193 194
    uint8_t nbanks = 0;
    uint16_t density = 0;
    int i;

    /* work in terms of MB */
195
    ram_size /= MiB;
196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219

    while ((ram_size >= 4) && (nbanks <= 2)) {
        int sz_log2 = MIN(31 - clz32(ram_size), 14);
        nbanks++;
        density |= 1 << (sz_log2 - 2);
        ram_size -= 1 << sz_log2;
    }

    /* split to 2 banks if possible */
    if ((nbanks == 1) && (density > 1)) {
        nbanks++;
        density >>= 1;
    }

    if (density & 0xff00) {
        density = (density & 0xe0) | ((density >> 8) & 0x1f);
        type = DDR2;
    } else if (!(density & 0x1f)) {
        type = DDR2;
    } else {
        type = SDR;
    }

    if (ram_size) {
A
Alistair Francis 已提交
220 221
        warn_report("SPD cannot represent final " RAM_ADDR_FMT "MB"
                    " of SDRAM", ram_size);
222 223 224 225 226 227 228 229 230 231 232 233
    }

    /* fill in SPD memory information */
    spd[2] = type;
    spd[5] = nbanks;
    spd[31] = density;

    /* checksum */
    spd[63] = 0;
    for (i = 0; i < 63; i++) {
        spd[63] += spd[i];
    }
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267

    /* copy for SMBUS */
    memcpy(eeprom, spd, sizeof(spd_eeprom.contents));
}

static void generate_eeprom_serial(uint8_t *eeprom)
{
    int i, pos = 0;
    uint8_t mac[6] = { 0x00 };
    uint8_t sn[5] = { 0x01, 0x23, 0x45, 0x67, 0x89 };

    /* version */
    eeprom[pos++] = 0x01;

    /* count */
    eeprom[pos++] = 0x02;

    /* MAC address */
    eeprom[pos++] = 0x01; /* MAC */
    eeprom[pos++] = 0x06; /* length */
    memcpy(&eeprom[pos], mac, sizeof(mac));
    pos += sizeof(mac);

    /* serial number */
    eeprom[pos++] = 0x02; /* serial */
    eeprom[pos++] = 0x05; /* length */
    memcpy(&eeprom[pos], sn, sizeof(sn));
    pos += sizeof(sn);

    /* checksum */
    eeprom[pos] = 0;
    for (i = 0; i < pos; i++) {
        eeprom[pos] += eeprom[i];
    }
268 269
}

270
static uint8_t eeprom24c0x_read(eeprom24c0x_t *eeprom)
271 272
{
    logout("%u: scl = %u, sda = %u, data = 0x%02x\n",
273 274
        eeprom->tick, eeprom->scl, eeprom->sda, eeprom->data);
    return eeprom->sda;
275 276
}

277
static void eeprom24c0x_write(eeprom24c0x_t *eeprom, int scl, int sda)
278
{
279
    if (eeprom->scl && scl && (eeprom->sda != sda)) {
280
        logout("%u: scl = %u->%u, sda = %u->%u i2c %s\n",
281 282
                eeprom->tick, eeprom->scl, scl, eeprom->sda, sda,
                sda ? "stop" : "start");
283
        if (!sda) {
284 285
            eeprom->tick = 1;
            eeprom->command = 0;
286
        }
287
    } else if (eeprom->tick == 0 && !eeprom->ack) {
288 289
        /* Waiting for start. */
        logout("%u: scl = %u->%u, sda = %u->%u wait for i2c start\n",
290 291
                eeprom->tick, eeprom->scl, scl, eeprom->sda, sda);
    } else if (!eeprom->scl && scl) {
292
        logout("%u: scl = %u->%u, sda = %u->%u trigger bit\n",
293 294
                eeprom->tick, eeprom->scl, scl, eeprom->sda, sda);
        if (eeprom->ack) {
295 296
            logout("\ti2c ack bit = 0\n");
            sda = 0;
297 298
            eeprom->ack = 0;
        } else if (eeprom->sda == sda) {
299 300
            uint8_t bit = (sda != 0);
            logout("\ti2c bit = %d\n", bit);
301 302 303 304 305 306 307 308
            if (eeprom->tick < 9) {
                eeprom->command <<= 1;
                eeprom->command += bit;
                eeprom->tick++;
                if (eeprom->tick == 9) {
                    logout("\tcommand 0x%04x, %s\n", eeprom->command,
                           bit ? "read" : "write");
                    eeprom->ack = 1;
309
                }
310 311 312
            } else if (eeprom->tick < 17) {
                if (eeprom->command & 1) {
                    sda = ((eeprom->data & 0x80) != 0);
313
                }
314 315 316 317 318 319 320 321 322 323
                eeprom->address <<= 1;
                eeprom->address += bit;
                eeprom->tick++;
                eeprom->data <<= 1;
                if (eeprom->tick == 17) {
                    eeprom->data = eeprom->contents[eeprom->address];
                    logout("\taddress 0x%04x, data 0x%02x\n",
                           eeprom->address, eeprom->data);
                    eeprom->ack = 1;
                    eeprom->tick = 0;
324
                }
325
            } else if (eeprom->tick >= 17) {
326 327 328 329 330 331
                sda = 0;
            }
        } else {
            logout("\tsda changed with raising scl\n");
        }
    } else {
332 333
        logout("%u: scl = %u->%u, sda = %u->%u\n", eeprom->tick, eeprom->scl,
               scl, eeprom->sda, sda);
334
    }
335 336
    eeprom->scl = scl;
    eeprom->sda = sda;
337 338
}

A
Avi Kivity 已提交
339
static uint64_t malta_fpga_read(void *opaque, hwaddr addr,
A
Avi Kivity 已提交
340
                                unsigned size)
341 342 343 344 345 346 347 348 349 350 351 352
{
    MaltaFPGAState *s = opaque;
    uint32_t val = 0;
    uint32_t saddr;

    saddr = (addr & 0xfffff);

    switch (saddr) {

    /* SWITCH Register */
    case 0x00200:
        val = 0x00000000;		/* All switches closed */
A
Aurelien Jarno 已提交
353
        break;
354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378

    /* STATUS Register */
    case 0x00208:
#ifdef TARGET_WORDS_BIGENDIAN
        val = 0x00000012;
#else
        val = 0x00000010;
#endif
        break;

    /* JMPRS Register */
    case 0x00210:
        val = 0x00;
        break;

    /* LEDBAR Register */
    case 0x00408:
        val = s->leds;
        break;

    /* BRKRES Register */
    case 0x00508:
        val = s->brk;
        break;

T
ths 已提交
379
    /* UART Registers are handled directly by the serial device */
T
ths 已提交
380

381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398
    /* GPOUT Register */
    case 0x00a00:
        val = s->gpout;
        break;

    /* XXX: implement a real I2C controller */

    /* GPINP Register */
    case 0x00a08:
        /* IN = OUT until a real I2C control is implemented */
        if (s->i2csel)
            val = s->i2cout;
        else
            val = 0x00;
        break;

    /* I2CINP Register */
    case 0x00b00:
399
        val = ((s->i2cin & ~1) | eeprom24c0x_read(&spd_eeprom));
400 401 402 403 404 405 406 407 408 409 410 411 412 413
        break;

    /* I2COE Register */
    case 0x00b08:
        val = s->i2coe;
        break;

    /* I2COUT Register */
    case 0x00b10:
        val = s->i2cout;
        break;

    /* I2CSEL Register */
    case 0x00b18:
414
        val = s->i2csel;
415 416 417 418
        break;

    default:
#if 0
T
ths 已提交
419
        printf ("malta_fpga_read: Bad register offset 0x" TARGET_FMT_lx "\n",
A
Aurelien Jarno 已提交
420
                addr);
421 422 423 424 425 426
#endif
        break;
    }
    return val;
}

A
Avi Kivity 已提交
427
static void malta_fpga_write(void *opaque, hwaddr addr,
A
Avi Kivity 已提交
428
                             uint64_t val, unsigned size)
429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447
{
    MaltaFPGAState *s = opaque;
    uint32_t saddr;

    saddr = (addr & 0xfffff);

    switch (saddr) {

    /* SWITCH Register */
    case 0x00200:
        break;

    /* JMPRS Register */
    case 0x00210:
        break;

    /* LEDBAR Register */
    case 0x00408:
        s->leds = val & 0xff;
S
Stefan Weil 已提交
448
        malta_fpga_update_display(s);
449 450 451 452
        break;

    /* ASCIIWORD Register */
    case 0x00410:
A
Avi Kivity 已提交
453
        snprintf(s->display_text, 9, "%08X", (uint32_t)val);
454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472
        malta_fpga_update_display(s);
        break;

    /* ASCIIPOS0 to ASCIIPOS7 Registers */
    case 0x00418:
    case 0x00420:
    case 0x00428:
    case 0x00430:
    case 0x00438:
    case 0x00440:
    case 0x00448:
    case 0x00450:
        s->display_text[(saddr - 0x00418) >> 3] = (char) val;
        malta_fpga_update_display(s);
        break;

    /* SOFTRES Register */
    case 0x00500:
        if (val == 0x42)
473
            qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
474 475 476 477 478 479 480
        break;

    /* BRKRES Register */
    case 0x00508:
        s->brk = val & 0xff;
        break;

T
ths 已提交
481
    /* UART Registers are handled directly by the serial device */
T
ths 已提交
482

483 484 485 486 487 488 489 490 491 492 493 494
    /* GPOUT Register */
    case 0x00a00:
        s->gpout = val & 0xff;
        break;

    /* I2COE Register */
    case 0x00b08:
        s->i2coe = val & 0x03;
        break;

    /* I2COUT Register */
    case 0x00b10:
495
        eeprom24c0x_write(&spd_eeprom, val & 0x02, val & 0x01);
496
        s->i2cout = val;
497 498 499 500
        break;

    /* I2CSEL Register */
    case 0x00b18:
501
        s->i2csel = val & 0x01;
502 503 504 505
        break;

    default:
#if 0
T
ths 已提交
506
        printf ("malta_fpga_write: Bad register offset 0x" TARGET_FMT_lx "\n",
A
Aurelien Jarno 已提交
507
                addr);
508 509 510 511 512
#endif
        break;
    }
}

A
Avi Kivity 已提交
513 514 515 516
static const MemoryRegionOps malta_fpga_ops = {
    .read = malta_fpga_read,
    .write = malta_fpga_write,
    .endianness = DEVICE_NATIVE_ENDIAN,
517 518
};

519
static void malta_fpga_reset(void *opaque)
520 521 522 523 524 525
{
    MaltaFPGAState *s = opaque;

    s->leds   = 0x00;
    s->brk    = 0x0a;
    s->gpout  = 0x00;
526
    s->i2cin  = 0x3;
527 528 529 530 531 532
    s->i2coe  = 0x0;
    s->i2cout = 0x3;
    s->i2csel = 0x1;

    s->display_text[8] = '\0';
    snprintf(s->display_text, 9, "        ");
533 534
}

535
static void malta_fgpa_display_event(void *opaque, int event)
536
{
537 538 539
    MaltaFPGAState *s = opaque;

    if (event == CHR_EVENT_OPENED && !s->display_inited) {
540 541 542 543 544 545 546 547 548
        qemu_chr_fe_printf(&s->display, "\e[HMalta LEDBAR\r\n");
        qemu_chr_fe_printf(&s->display, "+--------+\r\n");
        qemu_chr_fe_printf(&s->display, "+        +\r\n");
        qemu_chr_fe_printf(&s->display, "+--------+\r\n");
        qemu_chr_fe_printf(&s->display, "\n");
        qemu_chr_fe_printf(&s->display, "Malta ASCII\r\n");
        qemu_chr_fe_printf(&s->display, "+--------+\r\n");
        qemu_chr_fe_printf(&s->display, "+        +\r\n");
        qemu_chr_fe_printf(&s->display, "+--------+\r\n");
549 550
        s->display_inited = true;
    }
551 552
}

A
Avi Kivity 已提交
553
static MaltaFPGAState *malta_fpga_init(MemoryRegion *address_space,
554
         hwaddr base, qemu_irq uart_irq, Chardev *uart_chr)
555 556
{
    MaltaFPGAState *s;
557
    Chardev *chr;
558

559
    s = (MaltaFPGAState *)g_malloc0(sizeof(MaltaFPGAState));
560

561
    memory_region_init_io(&s->iomem, NULL, &malta_fpga_ops, s,
A
Avi Kivity 已提交
562
                          "malta-fpga", 0x100000);
563
    memory_region_init_alias(&s->iomem_lo, NULL, "malta-fpga",
A
Avi Kivity 已提交
564
                             &s->iomem, 0, 0x900);
565
    memory_region_init_alias(&s->iomem_hi, NULL, "malta-fpga",
A
Avi Kivity 已提交
566
                             &s->iomem, 0xa00, 0x10000-0xa00);
T
ths 已提交
567

A
Avi Kivity 已提交
568 569
    memory_region_add_subregion(address_space, base, &s->iomem_lo);
    memory_region_add_subregion(address_space, base + 0xa00, &s->iomem_hi);
570

571
    chr = qemu_chr_new("fpga", "vc:320x200");
572 573
    qemu_chr_fe_init(&s->display, chr, NULL);
    qemu_chr_fe_set_handlers(&s->display, NULL, NULL,
574
                             malta_fgpa_display_event, NULL, s, NULL, true);
575

576 577
    s->uart = serial_mm_init(address_space, base + 0x900, 3, uart_irq,
                             230400, uart_chr, DEVICE_NATIVE_ENDIAN);
T
ths 已提交
578

579
    malta_fpga_reset(s);
580
    qemu_register_reset(malta_fpga_reset, s);
581 582 583 584 585

    return s;
}

/* Network support */
586
static void network_init(PCIBus *pci_bus)
587 588 589 590
{
    int i;

    for(i = 0; i < nb_nics; i++) {
591
        NICInfo *nd = &nd_table[i];
592
        const char *default_devaddr = NULL;
593 594

        if (i == 0 && (!nd->model || strcmp(nd->model, "pcnet") == 0))
595
            /* The malta board has a PCNet card using PCI SLOT 11 */
596
            default_devaddr = "0b";
597

598
        pci_nic_init_nofail(nd, pci_bus, "pcnet", default_devaddr);
599 600 601
    }
}

602 603 604 605 606 607 608 609 610 611
static void write_bootloader_nanomips(uint8_t *base, int64_t run_addr,
                                      int64_t kernel_entry)
{
    uint16_t *p;

    /* Small bootloader */
    p = (uint16_t *)base;

#define NM_HI1(VAL) (((VAL) >> 16) & 0x1f)
#define NM_HI2(VAL) \
612
          (((VAL) & 0xf000) | (((VAL) >> 19) & 0xffc) | (((VAL) >> 31) & 0x1))
613 614
#define NM_LO(VAL)  ((VAL) & 0xfff)

615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630
    stw_p(p++, 0x2800); stw_p(p++, 0x001c);
                                /* bc to_here */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
    stw_p(p++, 0x8000); stw_p(p++, 0xc000);
                                /* nop */
631 632

    /* to_here: */
633 634 635
    stw_p(p++, 0x0080); stw_p(p++, 0x0002);
                                /* li a0,2                      */

636
    stw_p(p++, 0xe3a0 | NM_HI1(ENVP_ADDR - 64));
637

638
    stw_p(p++, NM_HI2(ENVP_ADDR - 64));
639 640
                                /* lui sp,%hi(ENVP_ADDR - 64)   */

641 642
    stw_p(p++, 0x83bd); stw_p(p++, NM_LO(ENVP_ADDR - 64));
                                /* ori sp,sp,%lo(ENVP_ADDR - 64) */
643

644
    stw_p(p++, 0xe0a0 | NM_HI1(ENVP_ADDR));
645

646
    stw_p(p++, NM_HI2(ENVP_ADDR));
647 648
                                /* lui a1,%hi(ENVP_ADDR)        */

649
    stw_p(p++, 0x80a5); stw_p(p++, NM_LO(ENVP_ADDR));
650 651
                                /* ori a1,a1,%lo(ENVP_ADDR)     */

652
    stw_p(p++, 0xe0c0 | NM_HI1(ENVP_ADDR + 8));
653

654
    stw_p(p++, NM_HI2(ENVP_ADDR + 8));
655 656
                                /* lui a2,%hi(ENVP_ADDR + 8)    */

657 658
    stw_p(p++, 0x80c6); stw_p(p++, NM_LO(ENVP_ADDR + 8));
                                /* ori a2,a2,%lo(ENVP_ADDR + 8) */
659

660
    stw_p(p++, 0xe0e0 | NM_HI1(loaderparams.ram_low_size));
661

662 663
    stw_p(p++, NM_HI2(loaderparams.ram_low_size));
                                /* lui a3,%hi(loaderparams.ram_low_size) */
664

665 666
    stw_p(p++, 0x80e7); stw_p(p++, NM_LO(loaderparams.ram_low_size));
                                /* ori a3,a3,%lo(loaderparams.ram_low_size) */
667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785

    /*
     * Load BAR registers as done by YAMON:
     *
     *  - set up PCI0 I/O BARs from 0x18000000 to 0x181fffff
     *  - set up PCI0 MEM0 at 0x10000000, size 0x8000000
     *  - set up PCI0 MEM1 at 0x18200000, size 0xbe00000
     *
     */
    stw_p(p++, 0xe040); stw_p(p++, 0x0681);
                                /* lui t1, %hi(0xb4000000)      */

#ifdef TARGET_WORDS_BIGENDIAN

    stw_p(p++, 0xe020); stw_p(p++, 0x0be1);
                                /* lui t0, %hi(0xdf000000)      */

    /* 0x68 corresponds to GT_ISD (from hw/mips/gt64xxx_pci.c)  */
    stw_p(p++, 0x8422); stw_p(p++, 0x9068);
                                /* sw t0, 0x68(t1)              */

    stw_p(p++, 0xe040); stw_p(p++, 0x077d);
                                /* lui t1, %hi(0xbbe00000)      */

    stw_p(p++, 0xe020); stw_p(p++, 0x0801);
                                /* lui t0, %hi(0xc0000000)      */

    /* 0x48 corresponds to GT_PCI0IOLD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9048);
                                /* sw t0, 0x48(t1)              */

    stw_p(p++, 0xe020); stw_p(p++, 0x0800);
                                /* lui t0, %hi(0x40000000)      */

    /* 0x50 corresponds to GT_PCI0IOHD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9050);
                                /* sw t0, 0x50(t1)              */

    stw_p(p++, 0xe020); stw_p(p++, 0x0001);
                                /* lui t0, %hi(0x80000000)      */

    /* 0x58 corresponds to GT_PCI0M0LD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9058);
                                /* sw t0, 0x58(t1)              */

    stw_p(p++, 0xe020); stw_p(p++, 0x07e0);
                                /* lui t0, %hi(0x3f000000)      */

    /* 0x60 corresponds to GT_PCI0M0HD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9060);
                                /* sw t0, 0x60(t1)              */

    stw_p(p++, 0xe020); stw_p(p++, 0x0821);
                                /* lui t0, %hi(0xc1000000)      */

    /* 0x80 corresponds to GT_PCI0M1LD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9080);
                                /* sw t0, 0x80(t1)              */

    stw_p(p++, 0xe020); stw_p(p++, 0x0bc0);
                                /* lui t0, %hi(0x5e000000)      */

#else

    stw_p(p++, 0x0020); stw_p(p++, 0x00df);
                                /* addiu[32] t0, $0, 0xdf       */

    /* 0x68 corresponds to GT_ISD                               */
    stw_p(p++, 0x8422); stw_p(p++, 0x9068);
                                /* sw t0, 0x68(t1)              */

    /* Use kseg2 remapped address 0x1be00000                    */
    stw_p(p++, 0xe040); stw_p(p++, 0x077d);
                                /* lui t1, %hi(0xbbe00000)      */

    stw_p(p++, 0x0020); stw_p(p++, 0x00c0);
                                /* addiu[32] t0, $0, 0xc0       */

    /* 0x48 corresponds to GT_PCI0IOLD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9048);
                                /* sw t0, 0x48(t1)              */

    stw_p(p++, 0x0020); stw_p(p++, 0x0040);
                                /* addiu[32] t0, $0, 0x40       */

    /* 0x50 corresponds to GT_PCI0IOHD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9050);
                                /* sw t0, 0x50(t1)              */

    stw_p(p++, 0x0020); stw_p(p++, 0x0080);
                                /* addiu[32] t0, $0, 0x80       */

    /* 0x58 corresponds to GT_PCI0M0LD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9058);
                                /* sw t0, 0x58(t1)              */

    stw_p(p++, 0x0020); stw_p(p++, 0x003f);
                                /* addiu[32] t0, $0, 0x3f       */

    /* 0x60 corresponds to GT_PCI0M0HD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9060);
                                /* sw t0, 0x60(t1)              */

    stw_p(p++, 0x0020); stw_p(p++, 0x00c1);
                                /* addiu[32] t0, $0, 0xc1       */

    /* 0x80 corresponds to GT_PCI0M1LD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9080);
                                /* sw t0, 0x80(t1)              */

    stw_p(p++, 0x0020); stw_p(p++, 0x005e);
                                /* addiu[32] t0, $0, 0x5e       */

#endif

    /* 0x88 corresponds to GT_PCI0M1HD                          */
    stw_p(p++, 0x8422); stw_p(p++, 0x9088);
                                /* sw t0, 0x88(t1)              */

786
    stw_p(p++, 0xe320 | NM_HI1(kernel_entry));
787

788
    stw_p(p++, NM_HI2(kernel_entry));
789 790
                                /* lui t9,%hi(kernel_entry)     */

791
    stw_p(p++, 0x8339); stw_p(p++, NM_LO(kernel_entry));
792 793
                                /* ori t9,t9,%lo(kernel_entry)  */

794
    stw_p(p++, 0x4bf9); stw_p(p++, 0x0000);
795
                                /* jalrc   t8                   */
796 797
}

798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
/* ROM and pseudo bootloader

   The following code implements a very very simple bootloader. It first
   loads the registers a0 to a3 to the values expected by the OS, and
   then jump at the kernel address.

   The bootloader should pass the locations of the kernel arguments and
   environment variables tables. Those tables contain the 32-bit address
   of NULL terminated strings. The environment variables table should be
   terminated by a NULL address.

   For a simpler implementation, the number of kernel arguments is fixed
   to two (the name of the kernel and the command line), and the two
   tables are actually the same one.

   The registers a0 to a3 should contain the following values:
     a0 - number of kernel arguments
     a1 - 32-bit address of the kernel arguments table
     a2 - 32-bit address of the environment variables table
     a3 - RAM size in bytes
*/
819 820
static void write_bootloader(uint8_t *base, int64_t run_addr,
                             int64_t kernel_entry)
821 822 823 824
{
    uint32_t *p;

    /* Small bootloader */
P
pbrook 已提交
825
    p = (uint32_t *)base;
J
James Hogan 已提交
826 827 828

    stl_p(p++, 0x08000000 |                                      /* j 0x1fc00580 */
                 ((run_addr + 0x580) & 0x0fffffff) >> 2);
829
    stl_p(p++, 0x00000000);                                      /* nop */
830

831
    /* YAMON service vector */
J
James Hogan 已提交
832 833 834 835 836 837 838 839 840 841 842 843 844
    stl_p(base + 0x500, run_addr + 0x0580);      /* start: */
    stl_p(base + 0x504, run_addr + 0x083c);      /* print_count: */
    stl_p(base + 0x520, run_addr + 0x0580);      /* start: */
    stl_p(base + 0x52c, run_addr + 0x0800);      /* flush_cache: */
    stl_p(base + 0x534, run_addr + 0x0808);      /* print: */
    stl_p(base + 0x538, run_addr + 0x0800);      /* reg_cpu_isr: */
    stl_p(base + 0x53c, run_addr + 0x0800);      /* unred_cpu_isr: */
    stl_p(base + 0x540, run_addr + 0x0800);      /* reg_ic_isr: */
    stl_p(base + 0x544, run_addr + 0x0800);      /* unred_ic_isr: */
    stl_p(base + 0x548, run_addr + 0x0800);      /* reg_esr: */
    stl_p(base + 0x54c, run_addr + 0x0800);      /* unreg_esr: */
    stl_p(base + 0x550, run_addr + 0x0800);      /* getchar: */
    stl_p(base + 0x554, run_addr + 0x0800);      /* syscon_read: */
845 846


847
    /* Second part of the bootloader */
P
pbrook 已提交
848
    p = (uint32_t *) (base + 0x580);
849 850 851 852 853 854 855

    if (semihosting_get_argc()) {
        /* Preserve a0 content as arguments have been passed */
        stl_p(p++, 0x00000000);                         /* nop */
    } else {
        stl_p(p++, 0x24040002);                         /* addiu a0, zero, 2 */
    }
856 857 858 859 860 861
    stl_p(p++, 0x3c1d0000 | (((ENVP_ADDR - 64) >> 16) & 0xffff)); /* lui sp, high(ENVP_ADDR) */
    stl_p(p++, 0x37bd0000 | ((ENVP_ADDR - 64) & 0xffff));        /* ori sp, sp, low(ENVP_ADDR) */
    stl_p(p++, 0x3c050000 | ((ENVP_ADDR >> 16) & 0xffff));       /* lui a1, high(ENVP_ADDR) */
    stl_p(p++, 0x34a50000 | (ENVP_ADDR & 0xffff));               /* ori a1, a1, low(ENVP_ADDR) */
    stl_p(p++, 0x3c060000 | (((ENVP_ADDR + 8) >> 16) & 0xffff)); /* lui a2, high(ENVP_ADDR + 8) */
    stl_p(p++, 0x34c60000 | ((ENVP_ADDR + 8) & 0xffff));         /* ori a2, a2, low(ENVP_ADDR + 8) */
862 863
    stl_p(p++, 0x3c070000 | (loaderparams.ram_low_size >> 16));     /* lui a3, high(ram_low_size) */
    stl_p(p++, 0x34e70000 | (loaderparams.ram_low_size & 0xffff));  /* ori a3, a3, low(ram_low_size) */
864 865

    /* Load BAR registers as done by YAMON */
866
    stl_p(p++, 0x3c09b400);                                      /* lui t1, 0xb400 */
T
ths 已提交
867 868

#ifdef TARGET_WORDS_BIGENDIAN
869
    stl_p(p++, 0x3c08df00);                                      /* lui t0, 0xdf00 */
T
ths 已提交
870
#else
871
    stl_p(p++, 0x340800df);                                      /* ori t0, r0, 0x00df */
T
ths 已提交
872
#endif
873
    stl_p(p++, 0xad280068);                                      /* sw t0, 0x0068(t1) */
T
ths 已提交
874

875
    stl_p(p++, 0x3c09bbe0);                                      /* lui t1, 0xbbe0 */
876 877

#ifdef TARGET_WORDS_BIGENDIAN
878
    stl_p(p++, 0x3c08c000);                                      /* lui t0, 0xc000 */
879
#else
880
    stl_p(p++, 0x340800c0);                                      /* ori t0, r0, 0x00c0 */
881
#endif
882
    stl_p(p++, 0xad280048);                                      /* sw t0, 0x0048(t1) */
883
#ifdef TARGET_WORDS_BIGENDIAN
884
    stl_p(p++, 0x3c084000);                                      /* lui t0, 0x4000 */
885
#else
886
    stl_p(p++, 0x34080040);                                      /* ori t0, r0, 0x0040 */
887
#endif
888
    stl_p(p++, 0xad280050);                                      /* sw t0, 0x0050(t1) */
889 890

#ifdef TARGET_WORDS_BIGENDIAN
891
    stl_p(p++, 0x3c088000);                                      /* lui t0, 0x8000 */
892
#else
893
    stl_p(p++, 0x34080080);                                      /* ori t0, r0, 0x0080 */
894
#endif
895
    stl_p(p++, 0xad280058);                                      /* sw t0, 0x0058(t1) */
896
#ifdef TARGET_WORDS_BIGENDIAN
897
    stl_p(p++, 0x3c083f00);                                      /* lui t0, 0x3f00 */
898
#else
899
    stl_p(p++, 0x3408003f);                                      /* ori t0, r0, 0x003f */
900
#endif
901
    stl_p(p++, 0xad280060);                                      /* sw t0, 0x0060(t1) */
902 903

#ifdef TARGET_WORDS_BIGENDIAN
904
    stl_p(p++, 0x3c08c100);                                      /* lui t0, 0xc100 */
905
#else
906
    stl_p(p++, 0x340800c1);                                      /* ori t0, r0, 0x00c1 */
907
#endif
908
    stl_p(p++, 0xad280080);                                      /* sw t0, 0x0080(t1) */
909
#ifdef TARGET_WORDS_BIGENDIAN
910
    stl_p(p++, 0x3c085e00);                                      /* lui t0, 0x5e00 */
911
#else
912
    stl_p(p++, 0x3408005e);                                      /* ori t0, r0, 0x005e */
913
#endif
914
    stl_p(p++, 0xad280088);                                      /* sw t0, 0x0088(t1) */
915 916

    /* Jump to kernel code */
917 918
    stl_p(p++, 0x3c1f0000 | ((kernel_entry >> 16) & 0xffff));    /* lui ra, high(kernel_entry) */
    stl_p(p++, 0x37ff0000 | (kernel_entry & 0xffff));            /* ori ra, ra, low(kernel_entry) */
919
    stl_p(p++, 0x03e00009);                                      /* jalr ra */
920
    stl_p(p++, 0x00000000);                                      /* nop */
921 922

    /* YAMON subroutines */
P
pbrook 已提交
923
    p = (uint32_t *) (base + 0x800);
924
    stl_p(p++, 0x03e00009);                                     /* jalr ra */
925
    stl_p(p++, 0x24020000);                                     /* li v0,0 */
J
James Hogan 已提交
926
    /* 808 YAMON print */
927 928 929 930 931 932 933 934 935
    stl_p(p++, 0x03e06821);                                     /* move t5,ra */
    stl_p(p++, 0x00805821);                                     /* move t3,a0 */
    stl_p(p++, 0x00a05021);                                     /* move t2,a1 */
    stl_p(p++, 0x91440000);                                     /* lbu a0,0(t2) */
    stl_p(p++, 0x254a0001);                                     /* addiu t2,t2,1 */
    stl_p(p++, 0x10800005);                                     /* beqz a0,834 */
    stl_p(p++, 0x00000000);                                     /* nop */
    stl_p(p++, 0x0ff0021c);                                     /* jal 870 */
    stl_p(p++, 0x00000000);                                     /* nop */
936
    stl_p(p++, 0x1000fff9);                                     /* b 814 */
937
    stl_p(p++, 0x00000000);                                     /* nop */
938
    stl_p(p++, 0x01a00009);                                     /* jalr t5 */
939
    stl_p(p++, 0x01602021);                                     /* move a0,t3 */
940
    /* 0x83c YAMON print_count */
941 942 943 944 945 946 947 948 949 950 951
    stl_p(p++, 0x03e06821);                                     /* move t5,ra */
    stl_p(p++, 0x00805821);                                     /* move t3,a0 */
    stl_p(p++, 0x00a05021);                                     /* move t2,a1 */
    stl_p(p++, 0x00c06021);                                     /* move t4,a2 */
    stl_p(p++, 0x91440000);                                     /* lbu a0,0(t2) */
    stl_p(p++, 0x0ff0021c);                                     /* jal 870 */
    stl_p(p++, 0x00000000);                                     /* nop */
    stl_p(p++, 0x254a0001);                                     /* addiu t2,t2,1 */
    stl_p(p++, 0x258cffff);                                     /* addiu t4,t4,-1 */
    stl_p(p++, 0x1580fffa);                                     /* bnez t4,84c */
    stl_p(p++, 0x00000000);                                     /* nop */
952
    stl_p(p++, 0x01a00009);                                     /* jalr t5 */
953
    stl_p(p++, 0x01602021);                                     /* move a0,t3 */
954
    /* 0x870 */
955 956 957 958 959 960 961
    stl_p(p++, 0x3c08b800);                                     /* lui t0,0xb400 */
    stl_p(p++, 0x350803f8);                                     /* ori t0,t0,0x3f8 */
    stl_p(p++, 0x91090005);                                     /* lbu t1,5(t0) */
    stl_p(p++, 0x00000000);                                     /* nop */
    stl_p(p++, 0x31290040);                                     /* andi t1,t1,0x40 */
    stl_p(p++, 0x1120fffc);                                     /* beqz t1,878 <outch+0x8> */
    stl_p(p++, 0x00000000);                                     /* nop */
962
    stl_p(p++, 0x03e00009);                                     /* jalr ra */
963
    stl_p(p++, 0xa1040000);                                     /* sb a0,0(t0) */
964

965 966
}

S
Stefan Weil 已提交
967 968
static void GCC_FMT_ATTR(3, 4) prom_set(uint32_t* prom_buf, int index,
                                        const char *string, ...)
969 970
{
    va_list ap;
971
    int32_t table_addr;
972 973 974 975 976

    if (index >= ENVP_NB_ENTRIES)
        return;

    if (string == NULL) {
A
Aurelien Jarno 已提交
977
        prom_buf[index] = 0;
978 979 980
        return;
    }

A
Aurelien Jarno 已提交
981 982
    table_addr = sizeof(int32_t) * ENVP_NB_ENTRIES + index * ENVP_ENTRY_SIZE;
    prom_buf[index] = tswap32(ENVP_ADDR + table_addr);
983 984

    va_start(ap, string);
A
Aurelien Jarno 已提交
985
    vsnprintf((char *)prom_buf + table_addr, ENVP_ENTRY_SIZE, string, ap);
986 987 988 989
    va_end(ap);
}

/* Kernel */
A
Aurelien Jarno 已提交
990
static int64_t load_kernel (void)
991
{
992
    int64_t kernel_entry, kernel_high;
993
    long kernel_size, initrd_size;
A
Anthony Liguori 已提交
994
    ram_addr_t initrd_offset;
B
Blue Swirl 已提交
995
    int big_endian;
A
Aurelien Jarno 已提交
996 997 998
    uint32_t *prom_buf;
    long prom_size;
    int prom_index = 0;
J
James Hogan 已提交
999
    uint64_t (*xlate_to_kseg0) (void *opaque, uint64_t addr);
B
Blue Swirl 已提交
1000 1001 1002 1003 1004 1005

#ifdef TARGET_WORDS_BIGENDIAN
    big_endian = 1;
#else
    big_endian = 0;
#endif
1006

1007 1008 1009 1010
    kernel_size = load_elf(loaderparams.kernel_filename, cpu_mips_kseg0_to_phys,
                           NULL, (uint64_t *)&kernel_entry, NULL,
                           (uint64_t *)&kernel_high, big_endian, EM_MIPS, 1, 0);
    if (kernel_size < 0) {
1011
        error_report("could not load kernel '%s': %s",
1012 1013
                     loaderparams.kernel_filename,
                     load_elf_strerror(kernel_size));
T
ths 已提交
1014
        exit(1);
1015
    }
1016

1017 1018 1019
    /* Check where the kernel has been linked */
    if (kernel_entry & 0x80000000ll) {
        if (kvm_enabled()) {
1020 1021 1022 1023 1024
            error_report("KVM guest kernels must be linked in useg. "
                         "Did you forget to enable CONFIG_KVM_GUEST?");
            exit(1);
        }

1025
        xlate_to_kseg0 = cpu_mips_phys_to_kseg0;
J
James Hogan 已提交
1026
    } else {
1027 1028
        /* if kernel entry is in useg it is probably a KVM T&E kernel */
        mips_um_ksegs_enable();
1029

1030
        xlate_to_kseg0 = cpu_mips_kvm_um_phys_to_kseg0;
J
James Hogan 已提交
1031
    }
1032 1033 1034

    /* load initrd */
    initrd_size = 0;
T
ths 已提交
1035
    initrd_offset = 0;
1036 1037
    if (loaderparams.initrd_filename) {
        initrd_size = get_image_size (loaderparams.initrd_filename);
T
ths 已提交
1038
        if (initrd_size > 0) {
1039 1040 1041
            /* The kernel allocates the bootmap memory in the low memory after
               the initrd.  It takes at most 128kiB for 2GB RAM and 4kiB
               pages.  */
1042 1043
            initrd_offset = (loaderparams.ram_low_size - initrd_size
                             - (128 * KiB)
1044 1045
                             - ~INITRD_PAGE_MASK) & INITRD_PAGE_MASK;
            if (kernel_high >= initrd_offset) {
1046 1047
                error_report("memory too small for initial ram disk '%s'",
                             loaderparams.initrd_filename);
T
ths 已提交
1048 1049
                exit(1);
            }
1050 1051 1052
            initrd_size = load_image_targphys(loaderparams.initrd_filename,
                                              initrd_offset,
                                              ram_size - initrd_offset);
T
ths 已提交
1053
        }
1054
        if (initrd_size == (target_ulong) -1) {
1055 1056
            error_report("could not load initial ram disk '%s'",
                         loaderparams.initrd_filename);
1057 1058 1059 1060
            exit(1);
        }
    }

A
Aurelien Jarno 已提交
1061 1062
    /* Setup prom parameters. */
    prom_size = ENVP_NB_ENTRIES * (sizeof(int32_t) + ENVP_ENTRY_SIZE);
1063
    prom_buf = g_malloc(prom_size);
A
Aurelien Jarno 已提交
1064

S
Stefan Weil 已提交
1065
    prom_set(prom_buf, prom_index++, "%s", loaderparams.kernel_filename);
A
Aurelien Jarno 已提交
1066
    if (initrd_size > 0) {
1067
        prom_set(prom_buf, prom_index++, "rd_start=0x%" PRIx64 " rd_size=%li %s",
J
James Hogan 已提交
1068
                 xlate_to_kseg0(NULL, initrd_offset), initrd_size,
1069
                 loaderparams.kernel_cmdline);
A
Aurelien Jarno 已提交
1070
    } else {
S
Stefan Weil 已提交
1071
        prom_set(prom_buf, prom_index++, "%s", loaderparams.kernel_cmdline);
A
Aurelien Jarno 已提交
1072 1073 1074
    }

    prom_set(prom_buf, prom_index++, "memsize");
1075 1076 1077 1078
    prom_set(prom_buf, prom_index++, "%u", loaderparams.ram_low_size);

    prom_set(prom_buf, prom_index++, "ememsize");
    prom_set(prom_buf, prom_index++, "%u", loaderparams.ram_size);
J
James Hogan 已提交
1079

A
Aurelien Jarno 已提交
1080 1081 1082 1083 1084
    prom_set(prom_buf, prom_index++, "modetty0");
    prom_set(prom_buf, prom_index++, "38400n8r");
    prom_set(prom_buf, prom_index++, NULL);

    rom_add_blob_fixed("prom", prom_buf, prom_size,
1085
                       cpu_mips_kseg0_to_phys(NULL, ENVP_ADDR));
1086

G
Gonglei 已提交
1087
    g_free(prom_buf);
T
ths 已提交
1088
    return kernel_entry;
1089 1090
}

1091
static void malta_mips_config(MIPSCPU *cpu)
1092
{
1093 1094 1095
    CPUMIPSState *env = &cpu->env;
    CPUState *cs = CPU(cpu);

1096
    env->mvp->CP0_MVPConf0 |= ((smp_cpus - 1) << CP0MVPC0_PVPE) |
1097
                         ((smp_cpus * cs->nr_threads - 1) << CP0MVPC0_PTC);
1098 1099
}

1100 1101
static void main_cpu_reset(void *opaque)
{
1102 1103 1104 1105
    MIPSCPU *cpu = opaque;
    CPUMIPSState *env = &cpu->env;

    cpu_reset(CPU(cpu));
1106

A
Aurelien Jarno 已提交
1107
    /* The bootloader does not need to be rewritten as it is located in a
1108 1109
       read only location. The kernel location and the arguments table
       location does not change. */
1110
    if (loaderparams.kernel_filename) {
1111
        env->CP0_Status &= ~(1 << CP0St_ERL);
T
ths 已提交
1112
    }
1113

1114
    malta_mips_config(cpu);
J
James Hogan 已提交
1115 1116 1117

    if (kvm_enabled()) {
        /* Start running from the bootloader we wrote to end of RAM */
1118
        env->active_tc.PC = 0x40000000 + loaderparams.ram_low_size;
J
James Hogan 已提交
1119
    }
1120 1121
}

1122
static void create_cpu_without_cps(const char *cpu_type,
1123
                                   qemu_irq *cbus_irq, qemu_irq *i8259_irq)
1124 1125 1126 1127 1128 1129
{
    CPUMIPSState *env;
    MIPSCPU *cpu;
    int i;

    for (i = 0; i < smp_cpus; i++) {
1130
        cpu = MIPS_CPU(cpu_create(cpu_type));
1131 1132

        /* Init internal devices */
1133 1134
        cpu_mips_irq_init_cpu(cpu);
        cpu_mips_clock_init(cpu);
1135 1136 1137 1138 1139 1140 1141 1142 1143
        qemu_register_reset(main_cpu_reset, cpu);
    }

    cpu = MIPS_CPU(first_cpu);
    env = &cpu->env;
    *i8259_irq = env->irq[2];
    *cbus_irq = env->irq[4];
}

1144
static void create_cps(MaltaState *s, const char *cpu_type,
1145 1146 1147 1148
                       qemu_irq *cbus_irq, qemu_irq *i8259_irq)
{
    Error *err = NULL;

1149
    s->cps = MIPS_CPS(object_new(TYPE_MIPS_CPS));
1150 1151
    qdev_set_parent_bus(DEVICE(s->cps), sysbus_get_default());

1152
    object_property_set_str(OBJECT(s->cps), cpu_type, "cpu-type", &err);
1153 1154 1155 1156 1157 1158 1159 1160 1161
    object_property_set_int(OBJECT(s->cps), smp_cpus, "num-vp", &err);
    object_property_set_bool(OBJECT(s->cps), true, "realized", &err);
    if (err != NULL) {
        error_report("%s", error_get_pretty(err));
        exit(1);
    }

    sysbus_mmio_map_overlap(SYS_BUS_DEVICE(s->cps), 0, 0, 1);

1162
    *i8259_irq = get_cps_irq(s->cps, 3);
1163 1164 1165
    *cbus_irq = NULL;
}

1166 1167
static void mips_create_cpu(MaltaState *s, const char *cpu_type,
                            qemu_irq *cbus_irq, qemu_irq *i8259_irq)
1168
{
1169 1170
    if ((smp_cpus > 1) && cpu_supports_cps_smp(cpu_type)) {
        create_cps(s, cpu_type, cbus_irq, i8259_irq);
1171
    } else {
1172
        create_cpu_without_cps(cpu_type, cbus_irq, i8259_irq);
1173 1174 1175
    }
}

1176
static
1177
void mips_malta_init(MachineState *machine)
1178
{
1179
    ram_addr_t ram_size = machine->ram_size;
J
James Hogan 已提交
1180
    ram_addr_t ram_low_size;
1181 1182 1183
    const char *kernel_filename = machine->kernel_filename;
    const char *kernel_cmdline = machine->kernel_cmdline;
    const char *initrd_filename = machine->initrd_filename;
P
Paul Brook 已提交
1184
    char *filename;
1185 1186
    pflash_t *fl;
    MemoryRegion *system_memory = get_system_memory();
P
Paul Burton 已提交
1187 1188 1189
    MemoryRegion *ram_high = g_new(MemoryRegion, 1);
    MemoryRegion *ram_low_preio = g_new(MemoryRegion, 1);
    MemoryRegion *ram_low_postio;
1190
    MemoryRegion *bios, *bios_copy = g_new(MemoryRegion, 1);
1191
    target_long bios_size = FLASH_SIZE;
1192 1193
    const size_t smbus_eeprom_size = 8 * 256;
    uint8_t *smbus_eeprom_buf = g_malloc0(smbus_eeprom_size);
J
James Hogan 已提交
1194
    int64_t kernel_entry, bootloader_run_addr;
1195
    PCIBus *pci_bus;
1196
    ISABus *isa_bus;
1197
    qemu_irq *isa_irq;
1198
    qemu_irq cbus_irq, i8259_irq;
T
ths 已提交
1199
    int piix4_devfn;
A
Andreas Färber 已提交
1200
    I2CBus *smbus;
G
Gerd Hoffmann 已提交
1201
    DriveInfo *dinfo;
1202
    DriveInfo *hd[MAX_IDE_BUS * MAX_IDE_DEVS];
T
ths 已提交
1203
    int fl_idx = 0;
1204
    int fl_sectors = bios_size >> 16;
1205
    int be;
1206

A
Andreas Färber 已提交
1207 1208
    DeviceState *dev = qdev_create(NULL, TYPE_MIPS_MALTA);
    MaltaState *s = MIPS_MALTA(dev);
1209

1210 1211 1212 1213 1214
    /* The whole address space decoded by the GT-64120A doesn't generate
       exception when accessing invalid memory. Create an empty slot to
       emulate this feature. */
    empty_slot_init(0, 0x20000000);

1215 1216
    qdev_init_nofail(dev);

1217
    /* create CPU */
1218
    mips_create_cpu(s, machine->cpu_type, &cbus_irq, &i8259_irq);
1219 1220

    /* allocate RAM */
1221 1222 1223
    if (ram_size > 2 * GiB) {
        error_report("Too much memory for this machine: %" PRId64 "MB,"
                     " maximum 2048MB", ram_size / MiB);
1224 1225
        exit(1);
    }
P
Paul Burton 已提交
1226 1227

    /* register RAM at high address where it is undisturbed by IO */
1228 1229
    memory_region_allocate_system_memory(ram_high, NULL, "mips_malta.ram",
                                         ram_size);
P
Paul Burton 已提交
1230 1231 1232 1233
    memory_region_add_subregion(system_memory, 0x80000000, ram_high);

    /* alias for pre IO hole access */
    memory_region_init_alias(ram_low_preio, NULL, "mips_malta_low_preio.ram",
1234
                             ram_high, 0, MIN(ram_size, 256 * MiB));
P
Paul Burton 已提交
1235 1236 1237
    memory_region_add_subregion(system_memory, 0, ram_low_preio);

    /* alias for post IO hole access, if there is enough RAM */
1238
    if (ram_size > 512 * MiB) {
P
Paul Burton 已提交
1239 1240 1241
        ram_low_postio = g_new(MemoryRegion, 1);
        memory_region_init_alias(ram_low_postio, NULL,
                                 "mips_malta_low_postio.ram",
1242 1243 1244 1245
                                 ram_high, 512 * MiB,
                                 ram_size - 512 * MiB);
        memory_region_add_subregion(system_memory, 512 * MiB,
                                    ram_low_postio);
P
Paul Burton 已提交
1246
    }
1247

1248 1249 1250 1251 1252
#ifdef TARGET_WORDS_BIGENDIAN
    be = 1;
#else
    be = 0;
#endif
1253

1254
    /* FPGA */
1255

1256
    /* The CBUS UART is attached to the MIPS CPU INT2 pin, ie interrupt 4 */
1257
    malta_fpga_init(system_memory, FPGA_ADDRESS, cbus_irq, serial_hd(2));
1258

1259 1260 1261 1262 1263 1264
    /* Load firmware in flash / BIOS. */
    dinfo = drive_get(IF_PFLASH, 0, fl_idx);
#ifdef DEBUG_BOARD_INIT
    if (dinfo) {
        printf("Register parallel flash %d size " TARGET_FMT_lx " at "
               "addr %08llx '%s' %x\n",
1265
               fl_idx, bios_size, FLASH_ADDRESS,
1266
               blk_name(dinfo->bdrv), fl_sectors);
1267 1268
    }
#endif
1269
    fl = pflash_cfi01_register(FLASH_ADDRESS, NULL, "mips_malta.bios",
1270
                               BIOS_SIZE,
1271
                               dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
1272 1273 1274 1275
                               65536, fl_sectors,
                               4, 0x0000, 0x0000, 0x0000, 0x0000, be);
    bios = pflash_cfi01_get_memory(fl);
    fl_idx++;
T
ths 已提交
1276
    if (kernel_filename) {
1277
        ram_low_size = MIN(ram_size, 256 * MiB);
1278
        /* For KVM we reserve 1MB of RAM for running bootloader */
J
James Hogan 已提交
1279 1280 1281 1282 1283 1284 1285
        if (kvm_enabled()) {
            ram_low_size -= 0x100000;
            bootloader_run_addr = 0x40000000 + ram_low_size;
        } else {
            bootloader_run_addr = 0xbfc00000;
        }

T
ths 已提交
1286
        /* Write a small bootloader to the flash location. */
1287 1288
        loaderparams.ram_size = ram_size;
        loaderparams.ram_low_size = ram_low_size;
T
ths 已提交
1289 1290 1291
        loaderparams.kernel_filename = kernel_filename;
        loaderparams.kernel_cmdline = kernel_cmdline;
        loaderparams.initrd_filename = initrd_filename;
A
Aurelien Jarno 已提交
1292
        kernel_entry = load_kernel();
J
James Hogan 已提交
1293

1294 1295 1296 1297 1298 1299 1300
        if (!cpu_supports_isa(machine->cpu_type, ISA_NANOMIPS32)) {
            write_bootloader(memory_region_get_ram_ptr(bios),
                             bootloader_run_addr, kernel_entry);
        } else {
            write_bootloader_nanomips(memory_region_get_ram_ptr(bios),
                                      bootloader_run_addr, kernel_entry);
        }
J
James Hogan 已提交
1301 1302
        if (kvm_enabled()) {
            /* Write the bootloader code @ the end of RAM, 1MB reserved */
1303
            write_bootloader(memory_region_get_ram_ptr(ram_low_preio) +
J
James Hogan 已提交
1304 1305 1306
                                    ram_low_size,
                             bootloader_run_addr, kernel_entry);
        }
T
ths 已提交
1307
    } else {
1308
        /* The flash region isn't executable from a KVM guest */
1309 1310
        if (kvm_enabled()) {
            error_report("KVM enabled but no -kernel argument was specified. "
1311
                         "Booting from flash is not supported with KVM.");
1312 1313
            exit(1);
        }
1314 1315
        /* Load firmware from flash. */
        if (!dinfo) {
T
ths 已提交
1316
            /* Load a BIOS image. */
1317
            if (bios_name == NULL) {
T
ths 已提交
1318
                bios_name = BIOS_FILENAME;
1319
            }
P
Paul Brook 已提交
1320 1321
            filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
            if (filename) {
1322
                bios_size = load_image_targphys(filename, FLASH_ADDRESS,
P
Paul Brook 已提交
1323
                                                BIOS_SIZE);
1324
                g_free(filename);
P
Paul Brook 已提交
1325 1326 1327
            } else {
                bios_size = -1;
            }
1328 1329
            if ((bios_size < 0 || bios_size > BIOS_SIZE) &&
                !kernel_filename && !qtest_enabled()) {
1330 1331 1332
                error_report("Could not load MIPS bios '%s', and no "
                             "-kernel argument was specified", bios_name);
                exit(1);
T
ths 已提交
1333
            }
1334
        }
T
ths 已提交
1335 1336 1337 1338
        /* In little endian mode the 32bit words in the bios are swapped,
           a neat trick which allows bi-endian firmware. */
#ifndef TARGET_WORDS_BIGENDIAN
        {
1339 1340 1341
            uint32_t *end, *addr;
            const size_t swapsize = MIN(bios_size, 0x3e0000);
            addr = rom_ptr(FLASH_ADDRESS, swapsize);
1342 1343 1344
            if (!addr) {
                addr = memory_region_get_ram_ptr(bios);
            }
1345
            end = (void *)addr + swapsize;
P
pbrook 已提交
1346 1347
            while (addr < end) {
                bswap32s(addr);
1348
                addr++;
T
ths 已提交
1349 1350 1351
            }
        }
#endif
1352 1353
    }

1354 1355 1356 1357 1358 1359
    /*
     * Map the BIOS at a 2nd physical location, as on the real board.
     * Copy it so that we can patch in the MIPS revision, which cannot be
     * handled by an overlapping region as the resulting ROM code subpage
     * regions are not executable.
     */
1360
    memory_region_init_ram(bios_copy, NULL, "bios.1fc", BIOS_SIZE,
1361
                           &error_fatal);
1362
    if (!rom_copy(memory_region_get_ram_ptr(bios_copy),
1363
                  FLASH_ADDRESS, BIOS_SIZE)) {
1364
        memcpy(memory_region_get_ram_ptr(bios_copy),
1365
               memory_region_get_ram_ptr(bios), BIOS_SIZE);
1366 1367 1368
    }
    memory_region_set_readonly(bios_copy, true);
    memory_region_add_subregion(system_memory, RESET_ADDRESS, bios_copy);
1369

1370 1371
    /* Board ID = 0x420 (Malta Board with CoreLV) */
    stl_p(memory_region_get_ram_ptr(bios_copy) + 0x10, 0x00000420);
1372

1373 1374 1375 1376 1377 1378 1379
    /*
     * We have a circular dependency problem: pci_bus depends on isa_irq,
     * isa_irq is provided by i8259, i8259 depends on ISA, ISA depends
     * on piix4, and piix4 depends on pci_bus.  To stop the cycle we have
     * qemu_irq_proxy() adds an extra bit of indirection, allowing us
     * to resolve the isa_irq -> i8259 dependency after i8259 is initialized.
     */
1380
    isa_irq = qemu_irq_proxy(&s->i8259, 16);
1381 1382

    /* Northbridge */
1383
    pci_bus = gt64120_register(isa_irq);
1384 1385

    /* Southbridge */
1386
    ide_drive_get(hd, ARRAY_SIZE(hd));
T
ths 已提交
1387

1388
    piix4_devfn = piix4_init(pci_bus, &isa_bus, 80);
1389 1390 1391

    /* Interrupt controller */
    /* The 8259 is attached to the MIPS CPU INT0 pin, ie interrupt 2 */
1392
    s->i8259 = i8259_init(isa_bus, i8259_irq);
1393

1394
    isa_bus_irqs(isa_bus, s->i8259);
1395
    pci_piix4_ide_init(pci_bus, hd, piix4_devfn + 1);
1396
    pci_create_simple(pci_bus, piix4_devfn + 2, "piix4-usb-uhci");
1397
    smbus = piix4_pm_init(pci_bus, piix4_devfn + 3, 0x1100,
1398
                          isa_get_irq(NULL, 9), NULL, 0, NULL);
1399
    pit = i8254_pit_init(isa_bus, 0x40, 0, NULL);
1400
    i8257_dma_init(isa_bus, 0);
1401 1402 1403 1404 1405 1406 1407
    mc146818_rtc_init(isa_bus, 2000, NULL);

    /* generate SPD EEPROM data */
    generate_eeprom_spd(&smbus_eeprom_buf[0 * 256], ram_size);
    generate_eeprom_serial(&smbus_eeprom_buf[6 * 256]);
    smbus_eeprom_init(smbus, 8, smbus_eeprom_buf, smbus_eeprom_size);
    g_free(smbus_eeprom_buf);
1408

1409 1410
    /* Super I/O: SMS FDC37M817 */
    isa_create_simple(isa_bus, TYPE_FDC37M81X_SUPERIO);
1411 1412

    /* Network card */
1413
    network_init(pci_bus);
T
ths 已提交
1414 1415

    /* Optional PCI video card */
1416
    pci_vga_init(pci_bus);
1417 1418
}

1419 1420 1421 1422 1423
static int mips_malta_sysbus_device_init(SysBusDevice *sysbusdev)
{
    return 0;
}

1424 1425 1426 1427 1428 1429 1430
static void mips_malta_class_init(ObjectClass *klass, void *data)
{
    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);

    k->init = mips_malta_sysbus_device_init;
}

1431
static const TypeInfo mips_malta_device = {
A
Andreas Färber 已提交
1432
    .name          = TYPE_MIPS_MALTA,
1433 1434 1435
    .parent        = TYPE_SYS_BUS_DEVICE,
    .instance_size = sizeof(MaltaState),
    .class_init    = mips_malta_class_init,
1436 1437
};

1438
static void mips_malta_machine_init(MachineClass *mc)
1439
{
1440 1441
    mc->desc = "MIPS Malta Core LV";
    mc->init = mips_malta_init;
1442
    mc->block_default_type = IF_IDE;
1443 1444
    mc->max_cpus = 16;
    mc->is_default = 1;
1445 1446 1447 1448 1449
#ifdef TARGET_MIPS64
    mc->default_cpu_type = MIPS_CPU_TYPE_NAME("20Kc");
#else
    mc->default_cpu_type = MIPS_CPU_TYPE_NAME("24Kf");
#endif
1450 1451
}

1452 1453 1454
DEFINE_MACHINE("malta", mips_malta_machine_init)

static void mips_malta_register_types(void)
1455
{
1456
    type_register_static(&mips_malta_device);
1457 1458
}

A
Andreas Färber 已提交
1459
type_init(mips_malta_register_types)