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/sizes.h> 15 #include <linux/of_fdt.h> 16 #include <linux/kernel.h> 17 #include <linux/bootmem.h> 18 #include <linux/of_platform.h> 19 #include <linux/of_address.h> 20 21 #include <asm/reboot.h> 22 #include <asm/bootinfo.h> 23 #include <asm/addrspace.h> 24 25 #include "common.h" 26 27 __iomem void *rt_sysc_membase; 28 __iomem void *rt_memc_membase; 29 30 extern struct boot_param_header __dtb_start; 31 32 __iomem void *plat_of_remap_node(const char *node) 33 { 34 struct resource res; 35 struct device_node *np; 36 37 np = of_find_compatible_node(NULL, NULL, node); 38 if (!np) 39 panic("Failed to find %s node", node); 40 41 if (of_address_to_resource(np, 0, &res)) 42 panic("Failed to get resource for %s", node); 43 44 if ((request_mem_region(res.start, 45 resource_size(&res), 46 res.name) < 0)) 47 panic("Failed to request resources for %s", node); 48 49 return ioremap_nocache(res.start, resource_size(&res)); 50 } 51 52 void __init device_tree_init(void) 53 { 54 unsigned long base, size; 55 void *fdt_copy; 56 57 if (!initial_boot_params) 58 return; 59 60 base = virt_to_phys((void *)initial_boot_params); 61 size = be32_to_cpu(initial_boot_params->totalsize); 62 63 /* Before we do anything, lets reserve the dt blob */ 64 reserve_bootmem(base, size, BOOTMEM_DEFAULT); 65 66 /* The strings in the flattened tree are referenced directly by the 67 * device tree, so copy the flattened device tree from init memory 68 * to regular memory. 69 */ 70 fdt_copy = alloc_bootmem(size); 71 memcpy(fdt_copy, initial_boot_params, size); 72 initial_boot_params = fdt_copy; 73 74 unflatten_device_tree(); 75 76 /* free the space reserved for the dt blob */ 77 free_bootmem(base, size); 78 } 79 80 void __init plat_mem_setup(void) 81 { 82 set_io_port_base(KSEG1); 83 84 /* 85 * Load the builtin devicetree. This causes the chosen node to be 86 * parsed resulting in our memory appearing 87 */ 88 __dt_setup_arch(&__dtb_start); 89 90 if (soc_info.mem_size) 91 add_memory_region(soc_info.mem_base, soc_info.mem_size * SZ_1M, 92 BOOT_MEM_RAM); 93 else 94 detect_memory_region(soc_info.mem_base, 95 soc_info.mem_size_min * SZ_1M, 96 soc_info.mem_size_max * SZ_1M); 97 } 98 99 static int __init plat_of_setup(void) 100 { 101 static struct of_device_id of_ids[3]; 102 int len = sizeof(of_ids[0].compatible); 103 104 if (!of_have_populated_dt()) 105 panic("device tree not present"); 106 107 strlcpy(of_ids[0].compatible, soc_info.compatible, len); 108 strncpy(of_ids[1].compatible, "palmbus", len); 109 110 if (of_platform_populate(NULL, of_ids, NULL, NULL)) 111 panic("failed to populate DT"); 112 113 /* make sure ithat the reset controller is setup early */ 114 ralink_rst_init(); 115 116 return 0; 117 } 118 119 arch_initcall(plat_of_setup); 120