2022-06-06 14:43:20 +02:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
|
|
|
/*
|
|
|
|
* QEMU loongson 3a5000 develop board emulation
|
|
|
|
*
|
|
|
|
* Copyright (c) 2021 Loongson Technology Corporation Limited
|
|
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
|
|
#include "qemu/units.h"
|
|
|
|
#include "qemu/datadir.h"
|
|
|
|
#include "qapi/error.h"
|
|
|
|
#include "hw/boards.h"
|
2022-06-06 14:43:27 +02:00
|
|
|
#include "hw/char/serial.h"
|
2022-06-06 14:43:20 +02:00
|
|
|
#include "sysemu/sysemu.h"
|
|
|
|
#include "sysemu/qtest.h"
|
|
|
|
#include "sysemu/runstate.h"
|
|
|
|
#include "sysemu/reset.h"
|
|
|
|
#include "sysemu/rtc.h"
|
|
|
|
#include "hw/loongarch/virt.h"
|
|
|
|
#include "exec/address-spaces.h"
|
2022-06-06 14:43:27 +02:00
|
|
|
#include "hw/irq.h"
|
|
|
|
#include "net/net.h"
|
2022-06-06 14:43:29 +02:00
|
|
|
#include "hw/loader.h"
|
|
|
|
#include "elf.h"
|
2022-06-06 14:43:25 +02:00
|
|
|
#include "hw/intc/loongarch_ipi.h"
|
|
|
|
#include "hw/intc/loongarch_extioi.h"
|
|
|
|
#include "hw/intc/loongarch_pch_pic.h"
|
|
|
|
#include "hw/intc/loongarch_pch_msi.h"
|
|
|
|
#include "hw/pci-host/ls7a.h"
|
2022-06-06 14:43:27 +02:00
|
|
|
#include "hw/pci-host/gpex.h"
|
|
|
|
#include "hw/misc/unimp.h"
|
2022-06-06 14:43:25 +02:00
|
|
|
|
2022-06-06 14:43:20 +02:00
|
|
|
#include "target/loongarch/cpu.h"
|
|
|
|
|
2022-06-06 14:43:29 +02:00
|
|
|
static struct _loaderparams {
|
|
|
|
uint64_t ram_size;
|
|
|
|
const char *kernel_filename;
|
|
|
|
} loaderparams;
|
|
|
|
|
|
|
|
static uint64_t cpu_loongarch_virt_to_phys(void *opaque, uint64_t addr)
|
|
|
|
{
|
|
|
|
return addr & 0x1fffffffll;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int64_t load_kernel_info(void)
|
|
|
|
{
|
|
|
|
uint64_t kernel_entry, kernel_low, kernel_high;
|
|
|
|
ssize_t kernel_size;
|
|
|
|
|
|
|
|
kernel_size = load_elf(loaderparams.kernel_filename, NULL,
|
|
|
|
cpu_loongarch_virt_to_phys, NULL,
|
|
|
|
&kernel_entry, &kernel_low,
|
|
|
|
&kernel_high, NULL, 0,
|
|
|
|
EM_LOONGARCH, 1, 0);
|
|
|
|
|
|
|
|
if (kernel_size < 0) {
|
|
|
|
error_report("could not load kernel '%s': %s",
|
|
|
|
loaderparams.kernel_filename,
|
|
|
|
load_elf_strerror(kernel_size));
|
|
|
|
exit(1);
|
|
|
|
}
|
|
|
|
return kernel_entry;
|
|
|
|
}
|
|
|
|
|
2022-06-06 14:43:27 +02:00
|
|
|
static void loongarch_devices_init(DeviceState *pch_pic)
|
|
|
|
{
|
|
|
|
DeviceState *gpex_dev;
|
|
|
|
SysBusDevice *d;
|
|
|
|
PCIBus *pci_bus;
|
|
|
|
MemoryRegion *ecam_alias, *ecam_reg, *pio_alias, *pio_reg;
|
|
|
|
MemoryRegion *mmio_alias, *mmio_reg;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
gpex_dev = qdev_new(TYPE_GPEX_HOST);
|
|
|
|
d = SYS_BUS_DEVICE(gpex_dev);
|
|
|
|
sysbus_realize_and_unref(d, &error_fatal);
|
|
|
|
pci_bus = PCI_HOST_BRIDGE(gpex_dev)->bus;
|
|
|
|
|
|
|
|
/* Map only part size_ecam bytes of ECAM space */
|
|
|
|
ecam_alias = g_new0(MemoryRegion, 1);
|
|
|
|
ecam_reg = sysbus_mmio_get_region(d, 0);
|
|
|
|
memory_region_init_alias(ecam_alias, OBJECT(gpex_dev), "pcie-ecam",
|
|
|
|
ecam_reg, 0, LS_PCIECFG_SIZE);
|
|
|
|
memory_region_add_subregion(get_system_memory(), LS_PCIECFG_BASE,
|
|
|
|
ecam_alias);
|
|
|
|
|
|
|
|
/* Map PCI mem space */
|
|
|
|
mmio_alias = g_new0(MemoryRegion, 1);
|
|
|
|
mmio_reg = sysbus_mmio_get_region(d, 1);
|
|
|
|
memory_region_init_alias(mmio_alias, OBJECT(gpex_dev), "pcie-mmio",
|
|
|
|
mmio_reg, LS7A_PCI_MEM_BASE, LS7A_PCI_MEM_SIZE);
|
|
|
|
memory_region_add_subregion(get_system_memory(), LS7A_PCI_MEM_BASE,
|
|
|
|
mmio_alias);
|
|
|
|
|
|
|
|
/* Map PCI IO port space. */
|
|
|
|
pio_alias = g_new0(MemoryRegion, 1);
|
|
|
|
pio_reg = sysbus_mmio_get_region(d, 2);
|
|
|
|
memory_region_init_alias(pio_alias, OBJECT(gpex_dev), "pcie-io", pio_reg,
|
|
|
|
LS7A_PCI_IO_OFFSET, LS7A_PCI_IO_SIZE);
|
|
|
|
memory_region_add_subregion(get_system_memory(), LS7A_PCI_IO_BASE,
|
|
|
|
pio_alias);
|
|
|
|
|
|
|
|
for (i = 0; i < GPEX_NUM_IRQS; i++) {
|
|
|
|
sysbus_connect_irq(d, i,
|
|
|
|
qdev_get_gpio_in(pch_pic, 16 + i));
|
|
|
|
gpex_set_irq_num(GPEX_HOST(gpex_dev), i, 16 + i);
|
|
|
|
}
|
|
|
|
|
|
|
|
serial_mm_init(get_system_memory(), LS7A_UART_BASE, 0,
|
|
|
|
qdev_get_gpio_in(pch_pic,
|
|
|
|
LS7A_UART_IRQ - PCH_PIC_IRQ_OFFSET),
|
|
|
|
115200, serial_hd(0), DEVICE_LITTLE_ENDIAN);
|
|
|
|
|
|
|
|
/* Network init */
|
|
|
|
for (i = 0; i < nb_nics; i++) {
|
|
|
|
NICInfo *nd = &nd_table[i];
|
|
|
|
|
|
|
|
if (!nd->model) {
|
|
|
|
nd->model = g_strdup("virtio");
|
|
|
|
}
|
|
|
|
|
|
|
|
pci_nic_init_nofail(nd, pci_bus, nd->model, NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* VGA setup */
|
|
|
|
pci_vga_init(pci_bus);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* There are some invalid guest memory access.
|
|
|
|
* Create some unimplemented devices to emulate this.
|
|
|
|
*/
|
|
|
|
create_unimplemented_device("pci-dma-cfg", 0x1001041c, 0x4);
|
2022-06-06 14:43:28 +02:00
|
|
|
sysbus_create_simple("ls7a_rtc", LS7A_RTC_REG_BASE,
|
|
|
|
qdev_get_gpio_in(pch_pic,
|
|
|
|
LS7A_RTC_IRQ - PCH_PIC_IRQ_OFFSET));
|
2022-06-06 14:43:27 +02:00
|
|
|
}
|
|
|
|
|
2022-06-06 14:43:25 +02:00
|
|
|
static void loongarch_irq_init(LoongArchMachineState *lams)
|
|
|
|
{
|
|
|
|
MachineState *ms = MACHINE(lams);
|
|
|
|
DeviceState *pch_pic, *pch_msi, *cpudev;
|
|
|
|
DeviceState *ipi, *extioi;
|
|
|
|
SysBusDevice *d;
|
|
|
|
LoongArchCPU *lacpu;
|
|
|
|
CPULoongArchState *env;
|
|
|
|
CPUState *cpu_state;
|
|
|
|
int cpu, pin, i;
|
|
|
|
|
|
|
|
ipi = qdev_new(TYPE_LOONGARCH_IPI);
|
|
|
|
sysbus_realize_and_unref(SYS_BUS_DEVICE(ipi), &error_fatal);
|
|
|
|
|
|
|
|
extioi = qdev_new(TYPE_LOONGARCH_EXTIOI);
|
|
|
|
sysbus_realize_and_unref(SYS_BUS_DEVICE(extioi), &error_fatal);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The connection of interrupts:
|
|
|
|
* +-----+ +---------+ +-------+
|
|
|
|
* | IPI |--> | CPUINTC | <-- | Timer |
|
|
|
|
* +-----+ +---------+ +-------+
|
|
|
|
* ^
|
|
|
|
* |
|
|
|
|
* +---------+
|
|
|
|
* | EIOINTC |
|
|
|
|
* +---------+
|
|
|
|
* ^ ^
|
|
|
|
* | |
|
|
|
|
* +---------+ +---------+
|
|
|
|
* | PCH-PIC | | PCH-MSI |
|
|
|
|
* +---------+ +---------+
|
|
|
|
* ^ ^ ^
|
|
|
|
* | | |
|
|
|
|
* +--------+ +---------+ +---------+
|
|
|
|
* | UARTs | | Devices | | Devices |
|
|
|
|
* +--------+ +---------+ +---------+
|
|
|
|
*/
|
|
|
|
for (cpu = 0; cpu < ms->smp.cpus; cpu++) {
|
|
|
|
cpu_state = qemu_get_cpu(cpu);
|
|
|
|
cpudev = DEVICE(cpu_state);
|
|
|
|
lacpu = LOONGARCH_CPU(cpu_state);
|
|
|
|
env = &(lacpu->env);
|
|
|
|
|
|
|
|
/* connect ipi irq to cpu irq */
|
|
|
|
qdev_connect_gpio_out(ipi, cpu, qdev_get_gpio_in(cpudev, IRQ_IPI));
|
|
|
|
/* IPI iocsr memory region */
|
|
|
|
memory_region_add_subregion(&env->system_iocsr, SMP_IPI_MAILBOX,
|
|
|
|
sysbus_mmio_get_region(SYS_BUS_DEVICE(ipi),
|
|
|
|
cpu));
|
|
|
|
/* extioi iocsr memory region */
|
|
|
|
memory_region_add_subregion(&env->system_iocsr, APIC_BASE,
|
|
|
|
sysbus_mmio_get_region(SYS_BUS_DEVICE(extioi),
|
|
|
|
cpu));
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* connect ext irq to the cpu irq
|
|
|
|
* cpu_pin[9:2] <= intc_pin[7:0]
|
|
|
|
*/
|
|
|
|
for (cpu = 0; cpu < ms->smp.cpus; cpu++) {
|
|
|
|
cpudev = DEVICE(qemu_get_cpu(cpu));
|
|
|
|
for (pin = 0; pin < LS3A_INTC_IP; pin++) {
|
|
|
|
qdev_connect_gpio_out(extioi, (cpu * 8 + pin),
|
|
|
|
qdev_get_gpio_in(cpudev, pin + 2));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
pch_pic = qdev_new(TYPE_LOONGARCH_PCH_PIC);
|
|
|
|
d = SYS_BUS_DEVICE(pch_pic);
|
|
|
|
sysbus_realize_and_unref(d, &error_fatal);
|
|
|
|
memory_region_add_subregion(get_system_memory(), LS7A_IOAPIC_REG_BASE,
|
|
|
|
sysbus_mmio_get_region(d, 0));
|
|
|
|
memory_region_add_subregion(get_system_memory(),
|
|
|
|
LS7A_IOAPIC_REG_BASE + PCH_PIC_ROUTE_ENTRY_OFFSET,
|
|
|
|
sysbus_mmio_get_region(d, 1));
|
|
|
|
memory_region_add_subregion(get_system_memory(),
|
|
|
|
LS7A_IOAPIC_REG_BASE + PCH_PIC_INT_STATUS_LO,
|
|
|
|
sysbus_mmio_get_region(d, 2));
|
|
|
|
|
|
|
|
/* Connect 64 pch_pic irqs to extioi */
|
|
|
|
for (int i = 0; i < PCH_PIC_IRQ_NUM; i++) {
|
|
|
|
qdev_connect_gpio_out(DEVICE(d), i, qdev_get_gpio_in(extioi, i));
|
|
|
|
}
|
|
|
|
|
|
|
|
pch_msi = qdev_new(TYPE_LOONGARCH_PCH_MSI);
|
|
|
|
d = SYS_BUS_DEVICE(pch_msi);
|
|
|
|
sysbus_realize_and_unref(d, &error_fatal);
|
|
|
|
sysbus_mmio_map(d, 0, LS7A_PCH_MSI_ADDR_LOW);
|
|
|
|
for (i = 0; i < PCH_MSI_IRQ_NUM; i++) {
|
|
|
|
/* Connect 192 pch_msi irqs to extioi */
|
|
|
|
qdev_connect_gpio_out(DEVICE(d), i,
|
|
|
|
qdev_get_gpio_in(extioi, i + PCH_MSI_IRQ_START));
|
|
|
|
}
|
2022-06-06 14:43:27 +02:00
|
|
|
|
|
|
|
loongarch_devices_init(pch_pic);
|
2022-06-06 14:43:25 +02:00
|
|
|
}
|
|
|
|
|
2022-06-06 14:43:29 +02:00
|
|
|
static void reset_load_elf(void *opaque)
|
|
|
|
{
|
|
|
|
LoongArchCPU *cpu = opaque;
|
|
|
|
CPULoongArchState *env = &cpu->env;
|
|
|
|
|
|
|
|
cpu_reset(CPU(cpu));
|
|
|
|
if (env->load_elf) {
|
|
|
|
cpu_set_pc(CPU(cpu), env->elf_address);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-06-06 14:43:20 +02:00
|
|
|
static void loongarch_init(MachineState *machine)
|
|
|
|
{
|
|
|
|
const char *cpu_model = machine->cpu_type;
|
2022-06-06 14:43:29 +02:00
|
|
|
const char *kernel_filename = machine->kernel_filename;
|
2022-06-06 14:43:20 +02:00
|
|
|
ram_addr_t offset = 0;
|
|
|
|
ram_addr_t ram_size = machine->ram_size;
|
|
|
|
uint64_t highram_size = 0;
|
|
|
|
MemoryRegion *address_space_mem = get_system_memory();
|
|
|
|
LoongArchMachineState *lams = LOONGARCH_MACHINE(machine);
|
2022-06-06 14:43:29 +02:00
|
|
|
LoongArchCPU *lacpu;
|
2022-06-06 14:43:20 +02:00
|
|
|
int i;
|
2022-06-06 14:43:29 +02:00
|
|
|
int64_t kernel_addr = 0;
|
2022-06-06 14:43:20 +02:00
|
|
|
|
|
|
|
if (!cpu_model) {
|
|
|
|
cpu_model = LOONGARCH_CPU_TYPE_NAME("la464");
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!strstr(cpu_model, "la464")) {
|
|
|
|
error_report("LoongArch/TCG needs cpu type la464");
|
|
|
|
exit(1);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ram_size < 1 * GiB) {
|
|
|
|
error_report("ram_size must be greater than 1G.");
|
|
|
|
exit(1);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Init CPUs */
|
|
|
|
for (i = 0; i < machine->smp.cpus; i++) {
|
|
|
|
cpu_create(machine->cpu_type);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Add memory region */
|
|
|
|
memory_region_init_alias(&lams->lowmem, NULL, "loongarch.lowram",
|
|
|
|
machine->ram, 0, 256 * MiB);
|
|
|
|
memory_region_add_subregion(address_space_mem, offset, &lams->lowmem);
|
|
|
|
offset += 256 * MiB;
|
|
|
|
highram_size = ram_size - 256 * MiB;
|
|
|
|
memory_region_init_alias(&lams->highmem, NULL, "loongarch.highmem",
|
|
|
|
machine->ram, offset, highram_size);
|
|
|
|
memory_region_add_subregion(address_space_mem, 0x90000000, &lams->highmem);
|
|
|
|
/* Add isa io region */
|
|
|
|
memory_region_init_alias(&lams->isa_io, NULL, "isa-io",
|
|
|
|
get_system_io(), 0, LOONGARCH_ISA_IO_SIZE);
|
|
|
|
memory_region_add_subregion(address_space_mem, LOONGARCH_ISA_IO_BASE,
|
|
|
|
&lams->isa_io);
|
2022-06-06 14:43:29 +02:00
|
|
|
if (kernel_filename) {
|
|
|
|
loaderparams.ram_size = ram_size;
|
|
|
|
loaderparams.kernel_filename = kernel_filename;
|
|
|
|
kernel_addr = load_kernel_info();
|
|
|
|
if (!machine->firmware) {
|
|
|
|
for (i = 0; i < machine->smp.cpus; i++) {
|
|
|
|
lacpu = LOONGARCH_CPU(qemu_get_cpu(i));
|
|
|
|
lacpu->env.load_elf = true;
|
|
|
|
lacpu->env.elf_address = kernel_addr;
|
|
|
|
qemu_register_reset(reset_load_elf, lacpu);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2022-06-06 14:43:25 +02:00
|
|
|
/* Initialize the IO interrupt subsystem */
|
|
|
|
loongarch_irq_init(lams);
|
2022-06-06 14:43:20 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static void loongarch_class_init(ObjectClass *oc, void *data)
|
|
|
|
{
|
|
|
|
MachineClass *mc = MACHINE_CLASS(oc);
|
|
|
|
|
|
|
|
mc->desc = "Loongson-3A5000 LS7A1000 machine";
|
|
|
|
mc->init = loongarch_init;
|
|
|
|
mc->default_ram_size = 1 * GiB;
|
|
|
|
mc->default_cpu_type = LOONGARCH_CPU_TYPE_NAME("la464");
|
|
|
|
mc->default_ram_id = "loongarch.ram";
|
|
|
|
mc->max_cpus = LOONGARCH_MAX_VCPUS;
|
|
|
|
mc->is_default = 1;
|
|
|
|
mc->default_kernel_irqchip_split = false;
|
|
|
|
mc->block_default_type = IF_VIRTIO;
|
|
|
|
mc->default_boot_order = "c";
|
|
|
|
mc->no_cdrom = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const TypeInfo loongarch_machine_types[] = {
|
|
|
|
{
|
|
|
|
.name = TYPE_LOONGARCH_MACHINE,
|
|
|
|
.parent = TYPE_MACHINE,
|
|
|
|
.instance_size = sizeof(LoongArchMachineState),
|
|
|
|
.class_init = loongarch_class_init,
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
DEFINE_TYPES(loongarch_machine_types)
|