1 /* 2 * This program is free software; you can redistribute it and/or modify it 3 * under the terms of the GNU General Public License version 2 as published 4 * by the Free Software Foundation. 5 * 6 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org> 7 * Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org> 8 * Copyright (C) 2013 John Crispin <blogic@openwrt.org> 9 */ 10 11 #include <linux/io.h> 12 #include <linux/clk.h> 13 #include <linux/init.h> 14 #include <linux/of_fdt.h> 15 #include <linux/kernel.h> 16 #include <linux/bootmem.h> 17 #include <linux/of_platform.h> 18 #include <linux/of_address.h> 19 20 #include <asm/reboot.h> 21 #include <asm/bootinfo.h> 22 #include <asm/addrspace.h> 23 24 #include "common.h" 25 26 __iomem void *rt_sysc_membase; 27 __iomem void *rt_memc_membase; 28 29 extern struct boot_param_header __dtb_start; 30 31 __iomem void *plat_of_remap_node(const char *node) 32 { 33 struct resource res; 34 struct device_node *np; 35 36 np = of_find_compatible_node(NULL, NULL, node); 37 if (!np) 38 panic("Failed to find %s node", node); 39 40 if (of_address_to_resource(np, 0, &res)) 41 panic("Failed to get resource for %s", node); 42 43 if ((request_mem_region(res.start, 44 resource_size(&res), 45 res.name) < 0)) 46 panic("Failed to request resources for %s", node); 47 48 return ioremap_nocache(res.start, resource_size(&res)); 49 } 50 51 void __init device_tree_init(void) 52 { 53 unsigned long base, size; 54 void *fdt_copy; 55 56 if (!initial_boot_params) 57 return; 58 59 base = virt_to_phys((void *)initial_boot_params); 60 size = be32_to_cpu(initial_boot_params->totalsize); 61 62 /* Before we do anything, lets reserve the dt blob */ 63 reserve_bootmem(base, size, BOOTMEM_DEFAULT); 64 65 /* The strings in the flattened tree are referenced directly by the 66 * device tree, so copy the flattened device tree from init memory 67 * to regular memory. 68 */ 69 fdt_copy = alloc_bootmem(size); 70 memcpy(fdt_copy, initial_boot_params, size); 71 initial_boot_params = fdt_copy; 72 73 unflatten_device_tree(); 74 75 /* free the space reserved for the dt blob */ 76 free_bootmem(base, size); 77 } 78 79 void __init plat_mem_setup(void) 80 { 81 set_io_port_base(KSEG1); 82 83 /* 84 * Load the builtin devicetree. This causes the chosen node to be 85 * parsed resulting in our memory appearing 86 */ 87 __dt_setup_arch(&__dtb_start); 88 } 89 90 static int __init plat_of_setup(void) 91 { 92 static struct of_device_id of_ids[3]; 93 int len = sizeof(of_ids[0].compatible); 94 95 if (!of_have_populated_dt()) 96 panic("device tree not present"); 97 98 strncpy(of_ids[0].compatible, soc_info.compatible, len); 99 strncpy(of_ids[1].compatible, "palmbus", len); 100 101 if (of_platform_populate(NULL, of_ids, NULL, NULL)) 102 panic("failed to populate DT\n"); 103 104 return 0; 105 } 106 107 arch_initcall(plat_of_setup); 108