1 /* 2 * Raspberry Pi 4B emulation 3 * 4 * Copyright (C) 2022 Ovchinnikov Vitalii <vitalii.ovchinnikov@auriga.com> 5 * 6 * SPDX-License-Identifier: GPL-2.0-or-later 7 */ 8 9 #include "qemu/osdep.h" 10 #include "qemu/units.h" 11 #include "qemu/cutils.h" 12 #include "qapi/error.h" 13 #include "qapi/visitor.h" 14 #include "hw/arm/raspi_platform.h" 15 #include "hw/display/bcm2835_fb.h" 16 #include "hw/registerfields.h" 17 #include "qemu/error-report.h" 18 #include "sysemu/device_tree.h" 19 #include "hw/boards.h" 20 #include "hw/loader.h" 21 #include "hw/arm/boot.h" 22 #include "qom/object.h" 23 #include "hw/arm/bcm2838.h" 24 #include <libfdt.h> 25 26 #define TYPE_RASPI4B_MACHINE MACHINE_TYPE_NAME("raspi4b") 27 OBJECT_DECLARE_SIMPLE_TYPE(Raspi4bMachineState, RASPI4B_MACHINE) 28 29 struct Raspi4bMachineState { 30 RaspiBaseMachineState parent_obj; 31 BCM2838State soc; 32 }; 33 34 /* 35 * Add second memory region if board RAM amount exceeds VC base address 36 * (see https://datasheets.raspberrypi.com/bcm2711/bcm2711-peripherals.pdf 37 * 1.2 Address Map) 38 */ 39 static int raspi_add_memory_node(void *fdt, hwaddr mem_base, hwaddr mem_len) 40 { 41 int ret; 42 uint32_t acells, scells; 43 char *nodename = g_strdup_printf("/memory@%" PRIx64, mem_base); 44 45 acells = qemu_fdt_getprop_cell(fdt, "/", "#address-cells", 46 NULL, &error_fatal); 47 scells = qemu_fdt_getprop_cell(fdt, "/", "#size-cells", 48 NULL, &error_fatal); 49 if (acells == 0 || scells == 0) { 50 fprintf(stderr, "dtb file invalid (#address-cells or #size-cells 0)\n"); 51 ret = -1; 52 } else { 53 qemu_fdt_add_subnode(fdt, nodename); 54 qemu_fdt_setprop_string(fdt, nodename, "device_type", "memory"); 55 ret = qemu_fdt_setprop_sized_cells(fdt, nodename, "reg", 56 acells, mem_base, 57 scells, mem_len); 58 } 59 60 g_free(nodename); 61 return ret; 62 } 63 64 static void raspi4_modify_dtb(const struct arm_boot_info *info, void *fdt) 65 { 66 uint64_t ram_size; 67 68 /* Temporarily disable following devices until they are implemented */ 69 const char *nodes_to_remove[] = { 70 "brcm,bcm2711-pcie", 71 "brcm,bcm2711-rng200", 72 "brcm,bcm2711-thermal", 73 "brcm,bcm2711-genet-v5", 74 }; 75 76 for (int i = 0; i < ARRAY_SIZE(nodes_to_remove); i++) { 77 const char *dev_str = nodes_to_remove[i]; 78 79 int offset = fdt_node_offset_by_compatible(fdt, -1, dev_str); 80 if (offset >= 0) { 81 if (!fdt_nop_node(fdt, offset)) { 82 warn_report("bcm2711 dtc: %s has been disabled!", dev_str); 83 } 84 } 85 } 86 87 ram_size = board_ram_size(info->board_id); 88 89 if (info->ram_size > UPPER_RAM_BASE) { 90 raspi_add_memory_node(fdt, UPPER_RAM_BASE, ram_size - UPPER_RAM_BASE); 91 } 92 } 93 94 static void raspi4b_machine_init(MachineState *machine) 95 { 96 Raspi4bMachineState *s = RASPI4B_MACHINE(machine); 97 RaspiBaseMachineState *s_base = RASPI_BASE_MACHINE(machine); 98 RaspiBaseMachineClass *mc = RASPI_BASE_MACHINE_GET_CLASS(machine); 99 BCM2838State *soc = &s->soc; 100 101 s_base->binfo.modify_dtb = raspi4_modify_dtb; 102 s_base->binfo.board_id = mc->board_rev; 103 104 object_initialize_child(OBJECT(machine), "soc", soc, 105 board_soc_type(mc->board_rev)); 106 107 raspi_base_machine_init(machine, &soc->parent_obj); 108 } 109 110 static void raspi4b_machine_class_init(ObjectClass *oc, void *data) 111 { 112 MachineClass *mc = MACHINE_CLASS(oc); 113 RaspiBaseMachineClass *rmc = RASPI_BASE_MACHINE_CLASS(oc); 114 115 rmc->board_rev = 0xb03115; /* Revision 1.5, 2 Gb RAM */ 116 raspi_machine_class_common_init(mc, rmc->board_rev); 117 mc->init = raspi4b_machine_init; 118 } 119 120 static const TypeInfo raspi4b_machine_type = { 121 .name = TYPE_RASPI4B_MACHINE, 122 .parent = TYPE_RASPI_BASE_MACHINE, 123 .instance_size = sizeof(Raspi4bMachineState), 124 .class_init = raspi4b_machine_class_init, 125 }; 126 127 static void raspi4b_machine_register_type(void) 128 { 129 type_register_static(&raspi4b_machine_type); 130 } 131 132 type_init(raspi4b_machine_register_type) 133