Merge commit 'main-jb-2012.08.03-B4' into t114-0806
[linux-2.6.git] / arch / arm / kernel / devtree.c
1 /*
2  *  linux/arch/arm/kernel/devtree.c
3  *
4  *  Copyright (C) 2009 Canonical Ltd. <jeremy.kerr@canonical.com>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10
11 #include <linux/init.h>
12 #include <linux/export.h>
13 #include <linux/errno.h>
14 #include <linux/types.h>
15 #include <linux/bootmem.h>
16 #include <linux/memblock.h>
17 #include <linux/of.h>
18 #include <linux/of_fdt.h>
19 #include <linux/of_irq.h>
20 #include <linux/of_platform.h>
21
22 #include <asm/setup.h>
23 #include <asm/page.h>
24 #include <asm/mach/arch.h>
25 #include <asm/mach-types.h>
26
27 void __init early_init_dt_add_memory_arch(u64 base, u64 size)
28 {
29         arm_add_memory(base, size);
30 }
31
32 void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
33 {
34         return alloc_bootmem_align(size, align);
35 }
36
37 void __init arm_dt_memblock_reserve(void)
38 {
39         u64 *reserve_map, base, size;
40
41         if (!initial_boot_params)
42                 return;
43
44         /* Reserve the dtb region */
45         memblock_reserve(virt_to_phys(initial_boot_params),
46                          be32_to_cpu(initial_boot_params->totalsize));
47
48         /*
49          * Process the reserve map.  This will probably overlap the initrd
50          * and dtb locations which are already reserved, but overlaping
51          * doesn't hurt anything
52          */
53         reserve_map = ((void*)initial_boot_params) +
54                         be32_to_cpu(initial_boot_params->off_mem_rsvmap);
55         while (1) {
56                 base = be64_to_cpup(reserve_map++);
57                 size = be64_to_cpup(reserve_map++);
58                 if (!size)
59                         break;
60                 memblock_reserve(base, size);
61         }
62 }
63
64 /**
65  * setup_machine_fdt - Machine setup when an dtb was passed to the kernel
66  * @dt_phys: physical address of dt blob
67  *
68  * If a dtb was passed to the kernel in r2, then use it to choose the
69  * correct machine_desc and to setup the system.
70  */
71 struct machine_desc * __init setup_machine_fdt(unsigned int dt_phys)
72 {
73         struct boot_param_header *devtree;
74         struct machine_desc *mdesc, *mdesc_best = NULL;
75         unsigned int score, mdesc_score = ~1;
76         unsigned long dt_root;
77         const char *model;
78         __be32 *serial_prop;
79         u64 serial = 0;
80         unsigned long len;
81
82         if (!dt_phys)
83                 return NULL;
84
85         devtree = phys_to_virt(dt_phys);
86
87         /* check device tree validity */
88         if (be32_to_cpu(devtree->magic) != OF_DT_HEADER)
89                 return NULL;
90
91         /* Search the mdescs for the 'best' compatible value match */
92         initial_boot_params = devtree;
93         dt_root = of_get_flat_dt_root();
94         for_each_machine_desc(mdesc) {
95                 score = of_flat_dt_match(dt_root, mdesc->dt_compat);
96                 if (score > 0 && score < mdesc_score) {
97                         mdesc_best = mdesc;
98                         mdesc_score = score;
99                 }
100         }
101         if (!mdesc_best) {
102                 const char *prop;
103                 long size;
104
105                 early_print("\nError: unrecognized/unsupported "
106                             "device tree compatible list:\n[ ");
107
108                 prop = of_get_flat_dt_prop(dt_root, "compatible", &size);
109                 while (size > 0) {
110                         early_print("'%s' ", prop);
111                         size -= strlen(prop) + 1;
112                         prop += strlen(prop) + 1;
113                 }
114                 early_print("]\n\n");
115
116                 dump_machine_table(); /* does not return */
117         }
118
119         model = of_get_flat_dt_prop(dt_root, "model", NULL);
120         if (!model)
121                 model = of_get_flat_dt_prop(dt_root, "compatible", NULL);
122         if (!model)
123                 model = "<unknown>";
124
125         serial_prop = of_get_flat_dt_prop(dt_root, "serial-num", &len);
126         if (serial_prop) {
127                 serial = of_read_number(serial_prop, len / 4);
128         }
129         system_serial_high = serial >> 32;
130         system_serial_low = serial;
131
132         pr_info("Machine: %s, model: %s, serial: %llu\n", mdesc_best->name,
133                 model, serial);
134
135         /* Retrieve various information from the /chosen node */
136         of_scan_flat_dt(early_init_dt_scan_chosen, boot_command_line);
137         /* Initialize {size,address}-cells info */
138         of_scan_flat_dt(early_init_dt_scan_root, NULL);
139         /* Setup memory, calling early_init_dt_add_memory_arch */
140         of_scan_flat_dt(early_init_dt_scan_memory, NULL);
141
142         /* Change machine number to match the mdesc we're using */
143         __machine_arch_type = mdesc_best->nr;
144
145         return mdesc_best;
146 }