123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright 2007,2009-2014 Freescale Semiconductor, Inc.
- * Copyright (C) 2021, Bin Meng <bmeng.cn@gmail.com>
- */
- #include <common.h>
- #include <command.h>
- #include <cpu_func.h>
- #include <dm.h>
- #include <env.h>
- #include <init.h>
- #include <log.h>
- #include <net.h>
- #include <pci.h>
- #include <time.h>
- #include <asm/global_data.h>
- #include <asm/processor.h>
- #include <asm/mmu.h>
- #include <asm/fsl_pci.h>
- #include <asm/io.h>
- #include <linux/libfdt.h>
- #include <fdt_support.h>
- #include <netdev.h>
- #include <fdtdec.h>
- #include <errno.h>
- #include <malloc.h>
- #include <virtio_types.h>
- #include <virtio.h>
- DECLARE_GLOBAL_DATA_PTR;
- static void *get_fdt_virt(void)
- {
- if (gd->flags & GD_FLG_RELOC)
- return (void *)gd->fdt_blob;
- else
- return (void *)CONFIG_SYS_TMPVIRT;
- }
- static uint64_t get_fdt_phys(void)
- {
- return (uint64_t)(uintptr_t)gd->fdt_blob;
- }
- static void map_fdt_as(int esel)
- {
- u32 mas0, mas1, mas2, mas3, mas7;
- uint64_t fdt_phys = get_fdt_phys();
- unsigned long fdt_phys_tlb = fdt_phys & ~0xffffful;
- unsigned long fdt_virt_tlb = (ulong)get_fdt_virt() & ~0xffffful;
- mas0 = MAS0_TLBSEL(1) | MAS0_ESEL(esel);
- mas1 = MAS1_VALID | MAS1_TID(0) | MAS1_TS | MAS1_TSIZE(BOOKE_PAGESZ_1M);
- mas2 = FSL_BOOKE_MAS2(fdt_virt_tlb, 0);
- mas3 = FSL_BOOKE_MAS3(fdt_phys_tlb, 0, MAS3_SW|MAS3_SR);
- mas7 = FSL_BOOKE_MAS7(fdt_phys_tlb);
- write_tlb(mas0, mas1, mas2, mas3, mas7);
- }
- uint64_t get_phys_ccsrbar_addr_early(void)
- {
- void *fdt = get_fdt_virt();
- uint64_t r;
- int size, node;
- u32 naddr;
- const fdt32_t *prop;
- /*
- * To be able to read the FDT we need to create a temporary TLB
- * map for it.
- */
- map_fdt_as(10);
- node = fdt_path_offset(fdt, "/soc");
- naddr = fdt_address_cells(fdt, node);
- prop = fdt_getprop(fdt, node, "ranges", &size);
- r = fdt_translate_address(fdt, node, prop + naddr);
- disable_tlb(10);
- return r;
- }
- int checkboard(void)
- {
- return 0;
- }
- static int pci_map_region(phys_addr_t paddr, phys_size_t size, ulong *pmap_addr)
- {
- ulong map_addr;
- if (!pmap_addr)
- return 0;
- map_addr = *pmap_addr;
- /* Align map_addr */
- map_addr += size - 1;
- map_addr &= ~(size - 1);
- if (map_addr + size >= CONFIG_SYS_PCI_MAP_END)
- return -1;
- /* Map virtual memory for range */
- assert(!tlb_map_range(map_addr, paddr, size, TLB_MAP_IO));
- *pmap_addr = map_addr + size;
- return 0;
- }
- int misc_init_r(void)
- {
- struct udevice *dev;
- struct pci_region *io;
- struct pci_region *mem;
- struct pci_region *pre;
- ulong map_addr;
- int ret;
- /* Ensure PCI is probed */
- uclass_first_device(UCLASS_PCI, &dev);
- pci_get_regions(dev, &io, &mem, &pre);
- /* Start MMIO and PIO range maps above RAM */
- map_addr = CONFIG_SYS_PCI_MAP_START;
- /* Map MMIO range */
- ret = pci_map_region(mem->phys_start, mem->size, &map_addr);
- if (ret)
- return ret;
- /* Map PIO range */
- ret = pci_map_region(io->phys_start, io->size, &map_addr);
- if (ret)
- return ret;
- /*
- * Make sure virtio bus is enumerated so that peripherals
- * on the virtio bus can be discovered by their drivers.
- */
- virtio_init();
- /*
- * U-Boot is relocated to RAM already, let's delete the temporary FDT
- * virtual-physical mapping that was used in the pre-relocation phase.
- */
- disable_tlb(find_tlb_idx((void *)CONFIG_SYS_TMPVIRT, 1));
- return 0;
- }
- int last_stage_init(void)
- {
- void *fdt = get_fdt_virt();
- int len = 0;
- const uint64_t *prop;
- int chosen;
- chosen = fdt_path_offset(fdt, "/chosen");
- if (chosen < 0) {
- printf("Couldn't find /chosen node in fdt\n");
- return -EIO;
- }
- /* -kernel boot */
- prop = fdt_getprop(fdt, chosen, "qemu,boot-kernel", &len);
- if (prop && (len >= 8))
- env_set_hex("qemu_kernel_addr", *prop);
- return 0;
- }
- static uint64_t get_linear_ram_size(void)
- {
- void *fdt = get_fdt_virt();
- const void *prop;
- int memory;
- int len;
- memory = fdt_path_offset(fdt, "/memory");
- prop = fdt_getprop(fdt, memory, "reg", &len);
- if (prop && len >= 16)
- return *(uint64_t *)(prop+8);
- panic("Couldn't determine RAM size");
- }
- phys_size_t fsl_ddr_sdram_size(void)
- {
- return get_linear_ram_size();
- }
- void init_tlbs(void)
- {
- phys_size_t ram_size;
- /*
- * Create a temporary AS=1 map for the fdt
- *
- * We use ESEL=0 here to overwrite the previous AS=0 map for ourselves
- * which was only 4k big. This way we don't have to clear any other maps.
- */
- map_fdt_as(0);
- /* Fetch RAM size from the fdt */
- ram_size = get_linear_ram_size();
- /* And remove our fdt map again */
- disable_tlb(0);
- /* Create an internal map of manually created TLB maps */
- init_used_tlb_cams();
- /* Create a dynamic AS=0 CCSRBAR mapping */
- assert(!tlb_map_range(CONFIG_SYS_CCSRBAR, CONFIG_SYS_CCSRBAR_PHYS,
- 1024 * 1024, TLB_MAP_IO));
- /* Create a RAM map that spans all accessible RAM */
- setup_ddr_tlbs(ram_size >> 20);
- /* Create a map for the TLB */
- assert(!tlb_map_range((ulong)get_fdt_virt(), get_fdt_phys(),
- 1024 * 1024, TLB_MAP_RAM));
- }
- static uint32_t get_cpu_freq(void)
- {
- void *fdt = get_fdt_virt();
- int cpus_node = fdt_path_offset(fdt, "/cpus");
- int cpu_node = fdt_first_subnode(fdt, cpus_node);
- const char *prop = "clock-frequency";
- return fdt_getprop_u32_default_node(fdt, cpu_node, 0, prop, 0);
- }
- void get_sys_info(sys_info_t *sys_info)
- {
- int freq = get_cpu_freq();
- memset(sys_info, 0, sizeof(sys_info_t));
- sys_info->freq_systembus = freq;
- sys_info->freq_ddrbus = freq;
- sys_info->freq_processor[0] = freq;
- }
- int get_clocks(void)
- {
- sys_info_t sys_info;
- get_sys_info(&sys_info);
- gd->cpu_clk = sys_info.freq_processor[0];
- gd->bus_clk = sys_info.freq_systembus;
- gd->mem_clk = sys_info.freq_ddrbus;
- gd->arch.lbc_clk = sys_info.freq_ddrbus;
- return 0;
- }
- unsigned long get_tbclk(void)
- {
- void *fdt = get_fdt_virt();
- int cpus_node = fdt_path_offset(fdt, "/cpus");
- int cpu_node = fdt_first_subnode(fdt, cpus_node);
- const char *prop = "timebase-frequency";
- return fdt_getprop_u32_default_node(fdt, cpu_node, 0, prop, 0);
- }
- /********************************************
- * get_bus_freq
- * return system bus freq in Hz
- *********************************************/
- ulong get_bus_freq(ulong dummy)
- {
- sys_info_t sys_info;
- get_sys_info(&sys_info);
- return sys_info.freq_systembus;
- }
- /*
- * Return the number of cores on this SOC.
- */
- int cpu_numcores(void)
- {
- /*
- * The QEMU u-boot target only needs to drive the first core,
- * spinning and device tree nodes get driven by QEMU itself
- */
- return 1;
- }
- /*
- * Return a 32-bit mask indicating which cores are present on this SOC.
- */
- u32 cpu_mask(void)
- {
- return (1 << cpu_numcores()) - 1;
- }
- /**
- * Return the virtual address of FDT that was passed by QEMU
- *
- * @return virtual address of FDT received from QEMU in r3 register
- */
- void *board_fdt_blob_setup(void)
- {
- return get_fdt_virt();
- }
- /* See CONFIG_SYS_NS16550_CLK in arch/powerpc/include/asm/config.h */
- int get_serial_clock(void)
- {
- return get_bus_freq(0);
- }
|