arch/nios2/kernel/prom.c

   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
  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
  46 void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
  47 {
  48         return alloc_bootmem_align(size, align);
  49 }
  50
  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
  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
  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
 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 */