1 /*
2 * Device tree support
3 *
4 * Copyright (C) 2013, 2015 Altera Corporation
5 * Copyright (C) 2010 Thomas Chou <thomas@wytron.com.tw>
6 *
7 * Based on MIPS support for CONFIG_OF device tree support
8 *
9 * Copyright (C) 2010 Cisco Systems Inc. <dediao@cisco.com>
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program. If not, see <http://www.gnu.org/licenses/>.
23 *
24 */
25
26 #include <linux/init.h>
27 #include <linux/types.h>
28 #include <linux/bootmem.h>
29 #include <linux/of.h>
30 #include <linux/of_fdt.h>
31 #include <linux/io.h>
32
33 #include <asm/prom.h>
34 #include <asm/sections.h>
35
early_init_dt_add_memory_arch(u64 base,u64 size)36 void __init early_init_dt_add_memory_arch(u64 base, u64 size)
37 {
38 u64 kernel_start = (u64)virt_to_phys(_text);
39
40 if (!memory_size &&
41 (kernel_start >= base) && (kernel_start < (base + size)))
42 memory_size = size;
43
44 }
45
early_init_dt_alloc_memory_arch(u64 size,u64 align)46 void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
47 {
48 return alloc_bootmem_align(size, align);
49 }
50
early_init_dt_reserve_memory_arch(phys_addr_t base,phys_addr_t size,bool nomap)51 int __init early_init_dt_reserve_memory_arch(phys_addr_t base, phys_addr_t size,
52 bool nomap)
53 {
54 reserve_bootmem(base, size, BOOTMEM_DEFAULT);
55 return 0;
56 }
57
early_init_devtree(void * params)58 void __init early_init_devtree(void *params)
59 {
60 __be32 *dtb = (u32 *)__dtb_start;
61 #if defined(CONFIG_NIOS2_DTB_AT_PHYS_ADDR)
62 if (be32_to_cpup((__be32 *)CONFIG_NIOS2_DTB_PHYS_ADDR) ==
63 OF_DT_HEADER) {
64 params = (void *)CONFIG_NIOS2_DTB_PHYS_ADDR;
65 early_init_dt_scan(params);
66 return;
67 }
68 #endif
69 if (be32_to_cpu((__be32) *dtb) == OF_DT_HEADER)
70 params = (void *)__dtb_start;
71
72 early_init_dt_scan(params);
73 }
74
75 #ifdef CONFIG_EARLY_PRINTK
early_init_dt_scan_serial(unsigned long node,const char * uname,int depth,void * data)76 static int __init early_init_dt_scan_serial(unsigned long node,
77 const char *uname, int depth, void *data)
78 {
79 u64 *addr64 = (u64 *) data;
80 const char *p;
81
82 /* only consider serial nodes */
83 if (strncmp(uname, "serial", 6) != 0)
84 return 0;
85
86 p = of_get_flat_dt_prop(node, "compatible", NULL);
87 if (!p)
88 return 0;
89
90 /*
91 * We found an altera_jtaguart but it wasn't configured for console, so
92 * skip it.
93 */
94 #ifndef CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE
95 if (strncmp(p, "altr,juart", 10) == 0)
96 return 0;
97 #endif
98
99 /*
100 * Same for altera_uart.
101 */
102 #ifndef CONFIG_SERIAL_ALTERA_UART_CONSOLE
103 if (strncmp(p, "altr,uart", 9) == 0)
104 return 0;
105 #endif
106
107 *addr64 = of_flat_dt_translate_address(node);
108
109 return *addr64 == OF_BAD_ADDR ? 0 : 1;
110 }
111
of_early_console(void)112 unsigned long __init of_early_console(void)
113 {
114 u64 base = 0;
115
116 if (of_scan_flat_dt(early_init_dt_scan_serial, &base))
117 return (u32)ioremap(base, 32);
118 else
119 return 0;
120 }
121 #endif /* CONFIG_EARLY_PRINTK */
122