mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
197 lines
4.5 KiB
197 lines
4.5 KiB
/* |
|
* Nios2-specific parts of system setup |
|
* |
|
* Copyright (C) 2010 Tobias Klauser <[email protected]> |
|
* Copyright (C) 2004 Microtronix Datacom Ltd. |
|
* Copyright (C) 2001 Vic Phillips <[email protected]> |
|
* |
|
* This file is subject to the terms and conditions of the GNU General Public |
|
* License. See the file "COPYING" in the main directory of this archive |
|
* for more details. |
|
*/ |
|
|
|
#include <linux/export.h> |
|
#include <linux/kernel.h> |
|
#include <linux/mm.h> |
|
#include <linux/sched.h> |
|
#include <linux/sched/task.h> |
|
#include <linux/console.h> |
|
#include <linux/memblock.h> |
|
#include <linux/initrd.h> |
|
#include <linux/of_fdt.h> |
|
#include <linux/screen_info.h> |
|
|
|
#include <asm/mmu_context.h> |
|
#include <asm/sections.h> |
|
#include <asm/setup.h> |
|
#include <asm/cpuinfo.h> |
|
|
|
unsigned long memory_start; |
|
EXPORT_SYMBOL(memory_start); |
|
|
|
unsigned long memory_end; |
|
EXPORT_SYMBOL(memory_end); |
|
|
|
static struct pt_regs fake_regs = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
|
0, 0, 0, 0, 0, 0, |
|
0}; |
|
|
|
#ifdef CONFIG_VT |
|
struct screen_info screen_info; |
|
#endif |
|
|
|
/* Copy a short hook instruction sequence to the exception address */ |
|
static inline void copy_exception_handler(unsigned int addr) |
|
{ |
|
unsigned int start = (unsigned int) exception_handler_hook; |
|
volatile unsigned int tmp = 0; |
|
|
|
if (start == addr) { |
|
/* The CPU exception address already points to the handler. */ |
|
return; |
|
} |
|
|
|
__asm__ __volatile__ ( |
|
"ldw %2,0(%0)\n" |
|
"stw %2,0(%1)\n" |
|
"ldw %2,4(%0)\n" |
|
"stw %2,4(%1)\n" |
|
"ldw %2,8(%0)\n" |
|
"stw %2,8(%1)\n" |
|
"flushd 0(%1)\n" |
|
"flushd 4(%1)\n" |
|
"flushd 8(%1)\n" |
|
"flushi %1\n" |
|
"addi %1,%1,4\n" |
|
"flushi %1\n" |
|
"addi %1,%1,4\n" |
|
"flushi %1\n" |
|
"flushp\n" |
|
: /* no output registers */ |
|
: "r" (start), "r" (addr), "r" (tmp) |
|
: "memory" |
|
); |
|
} |
|
|
|
/* Copy the fast TLB miss handler */ |
|
static inline void copy_fast_tlb_miss_handler(unsigned int addr) |
|
{ |
|
unsigned int start = (unsigned int) fast_handler; |
|
unsigned int end = (unsigned int) fast_handler_end; |
|
volatile unsigned int tmp = 0; |
|
|
|
__asm__ __volatile__ ( |
|
"1:\n" |
|
" ldw %3,0(%0)\n" |
|
" stw %3,0(%1)\n" |
|
" flushd 0(%1)\n" |
|
" flushi %1\n" |
|
" flushp\n" |
|
" addi %0,%0,4\n" |
|
" addi %1,%1,4\n" |
|
" bne %0,%2,1b\n" |
|
: /* no output registers */ |
|
: "r" (start), "r" (addr), "r" (end), "r" (tmp) |
|
: "memory" |
|
); |
|
} |
|
|
|
/* |
|
* save args passed from u-boot, called from head.S |
|
* |
|
* @r4: NIOS magic |
|
* @r5: initrd start |
|
* @r6: initrd end or fdt |
|
* @r7: kernel command line |
|
*/ |
|
asmlinkage void __init nios2_boot_init(unsigned r4, unsigned r5, unsigned r6, |
|
unsigned r7) |
|
{ |
|
unsigned dtb_passed = 0; |
|
char cmdline_passed[COMMAND_LINE_SIZE] __maybe_unused = { 0, }; |
|
|
|
#if defined(CONFIG_NIOS2_PASS_CMDLINE) |
|
if (r4 == 0x534f494e) { /* r4 is magic NIOS */ |
|
#if defined(CONFIG_BLK_DEV_INITRD) |
|
if (r5) { /* initramfs */ |
|
initrd_start = r5; |
|
initrd_end = r6; |
|
} |
|
#endif /* CONFIG_BLK_DEV_INITRD */ |
|
dtb_passed = r6; |
|
|
|
if (r7) |
|
strlcpy(cmdline_passed, (char *)r7, COMMAND_LINE_SIZE); |
|
} |
|
#endif |
|
|
|
early_init_devtree((void *)dtb_passed); |
|
|
|
#ifndef CONFIG_CMDLINE_FORCE |
|
if (cmdline_passed[0]) |
|
strlcpy(boot_command_line, cmdline_passed, COMMAND_LINE_SIZE); |
|
#ifdef CONFIG_NIOS2_CMDLINE_IGNORE_DTB |
|
else |
|
strlcpy(boot_command_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE); |
|
#endif |
|
#endif |
|
|
|
parse_early_param(); |
|
} |
|
|
|
static void __init find_limits(unsigned long *min, unsigned long *max_low, |
|
unsigned long *max_high) |
|
{ |
|
*max_low = PFN_DOWN(memblock_get_current_limit()); |
|
*min = PFN_UP(memblock_start_of_DRAM()); |
|
*max_high = PFN_DOWN(memblock_end_of_DRAM()); |
|
} |
|
|
|
void __init setup_arch(char **cmdline_p) |
|
{ |
|
console_verbose(); |
|
|
|
memory_start = memblock_start_of_DRAM(); |
|
memory_end = memblock_end_of_DRAM(); |
|
|
|
setup_initial_init_mm(_stext, _etext, _edata, _end); |
|
init_task.thread.kregs = &fake_regs; |
|
|
|
/* Keep a copy of command line */ |
|
*cmdline_p = boot_command_line; |
|
|
|
find_limits(&min_low_pfn, &max_low_pfn, &max_pfn); |
|
max_mapnr = max_low_pfn; |
|
|
|
memblock_reserve(__pa_symbol(_stext), _end - _stext); |
|
#ifdef CONFIG_BLK_DEV_INITRD |
|
if (initrd_start) { |
|
memblock_reserve(virt_to_phys((void *)initrd_start), |
|
initrd_end - initrd_start); |
|
} |
|
#endif /* CONFIG_BLK_DEV_INITRD */ |
|
|
|
early_init_fdt_reserve_self(); |
|
early_init_fdt_scan_reserved_mem(); |
|
|
|
unflatten_and_copy_device_tree(); |
|
|
|
setup_cpuinfo(); |
|
|
|
copy_exception_handler(cpuinfo.exception_addr); |
|
|
|
mmu_init(); |
|
|
|
copy_fast_tlb_miss_handler(cpuinfo.fast_tlb_miss_exc_addr); |
|
|
|
/* |
|
* Initialize MMU context handling here because data from cpuinfo is |
|
* needed for this. |
|
*/ |
|
mmu_context_init(); |
|
|
|
/* |
|
* get kmalloc into gear |
|
*/ |
|
paging_init(); |
|
}
|
|
|