| John Crispin | 3a5bfe7 | 2013-01-20 22:02:01 +0100 | [diff] [blame^] | 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); |