Commit | Line | Data |
---|---|---|
3a5bfe7b JC |
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); |