 b8b499c86b
			
		
	
	
	b8b499c86b
	
	
	
		
			
			This modification is needed to proper boot the custom machines with the IDs that are not described in the mach-types.h table. Signed-off-by: Alexander Shiyan <shc_work@mail.ru> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
		
			
				
	
	
		
			933 lines
		
	
	
	
		
			21 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			933 lines
		
	
	
	
		
			21 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  *  linux/arch/arm/kernel/setup.c
 | |
|  *
 | |
|  *  Copyright (C) 1995-2001 Russell King
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 as
 | |
|  * published by the Free Software Foundation.
 | |
|  */
 | |
| #include <linux/export.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/stddef.h>
 | |
| #include <linux/ioport.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/utsname.h>
 | |
| #include <linux/initrd.h>
 | |
| #include <linux/console.h>
 | |
| #include <linux/bootmem.h>
 | |
| #include <linux/seq_file.h>
 | |
| #include <linux/screen_info.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/kexec.h>
 | |
| #include <linux/of_fdt.h>
 | |
| #include <linux/cpu.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/smp.h>
 | |
| #include <linux/proc_fs.h>
 | |
| #include <linux/memblock.h>
 | |
| #include <linux/bug.h>
 | |
| #include <linux/compiler.h>
 | |
| #include <linux/sort.h>
 | |
| 
 | |
| #include <asm/unified.h>
 | |
| #include <asm/cp15.h>
 | |
| #include <asm/cpu.h>
 | |
| #include <asm/cputype.h>
 | |
| #include <asm/elf.h>
 | |
| #include <asm/procinfo.h>
 | |
| #include <asm/sections.h>
 | |
| #include <asm/setup.h>
 | |
| #include <asm/smp_plat.h>
 | |
| #include <asm/mach-types.h>
 | |
| #include <asm/cacheflush.h>
 | |
| #include <asm/cachetype.h>
 | |
| #include <asm/tlbflush.h>
 | |
| 
 | |
| #include <asm/prom.h>
 | |
| #include <asm/mach/arch.h>
 | |
| #include <asm/mach/irq.h>
 | |
| #include <asm/mach/time.h>
 | |
| #include <asm/system_info.h>
 | |
| #include <asm/system_misc.h>
 | |
| #include <asm/traps.h>
 | |
| #include <asm/unwind.h>
 | |
| #include <asm/memblock.h>
 | |
| #include <asm/virt.h>
 | |
| 
 | |
| #include "atags.h"
 | |
| #include "tcm.h"
 | |
| 
 | |
| 
 | |
| #if defined(CONFIG_FPE_NWFPE) || defined(CONFIG_FPE_FASTFPE)
 | |
| char fpe_type[8];
 | |
| 
 | |
| static int __init fpe_setup(char *line)
 | |
| {
 | |
| 	memcpy(fpe_type, line, 8);
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| __setup("fpe=", fpe_setup);
 | |
| #endif
 | |
| 
 | |
| extern void paging_init(struct machine_desc *desc);
 | |
| extern void sanity_check_meminfo(void);
 | |
| extern void reboot_setup(char *str);
 | |
| extern void setup_dma_zone(struct machine_desc *desc);
 | |
| 
 | |
| unsigned int processor_id;
 | |
| EXPORT_SYMBOL(processor_id);
 | |
| unsigned int __machine_arch_type __read_mostly;
 | |
| EXPORT_SYMBOL(__machine_arch_type);
 | |
| unsigned int cacheid __read_mostly;
 | |
| EXPORT_SYMBOL(cacheid);
 | |
| 
 | |
| unsigned int __atags_pointer __initdata;
 | |
| 
 | |
| unsigned int system_rev;
 | |
| EXPORT_SYMBOL(system_rev);
 | |
| 
 | |
| unsigned int system_serial_low;
 | |
| EXPORT_SYMBOL(system_serial_low);
 | |
| 
 | |
| unsigned int system_serial_high;
 | |
| EXPORT_SYMBOL(system_serial_high);
 | |
| 
 | |
| unsigned int elf_hwcap __read_mostly;
 | |
| EXPORT_SYMBOL(elf_hwcap);
 | |
| 
 | |
| 
 | |
| #ifdef MULTI_CPU
 | |
| struct processor processor __read_mostly;
 | |
| #endif
 | |
| #ifdef MULTI_TLB
 | |
| struct cpu_tlb_fns cpu_tlb __read_mostly;
 | |
| #endif
 | |
| #ifdef MULTI_USER
 | |
| struct cpu_user_fns cpu_user __read_mostly;
 | |
| #endif
 | |
| #ifdef MULTI_CACHE
 | |
| struct cpu_cache_fns cpu_cache __read_mostly;
 | |
| #endif
 | |
| #ifdef CONFIG_OUTER_CACHE
 | |
| struct outer_cache_fns outer_cache __read_mostly;
 | |
| EXPORT_SYMBOL(outer_cache);
 | |
| #endif
 | |
| 
 | |
| /*
 | |
|  * Cached cpu_architecture() result for use by assembler code.
 | |
|  * C code should use the cpu_architecture() function instead of accessing this
 | |
|  * variable directly.
 | |
|  */
 | |
| int __cpu_architecture __read_mostly = CPU_ARCH_UNKNOWN;
 | |
| 
 | |
| struct stack {
 | |
| 	u32 irq[3];
 | |
| 	u32 abt[3];
 | |
| 	u32 und[3];
 | |
| } ____cacheline_aligned;
 | |
| 
 | |
| static struct stack stacks[NR_CPUS];
 | |
| 
 | |
| char elf_platform[ELF_PLATFORM_SIZE];
 | |
| EXPORT_SYMBOL(elf_platform);
 | |
| 
 | |
| static const char *cpu_name;
 | |
| static const char *machine_name;
 | |
| static char __initdata cmd_line[COMMAND_LINE_SIZE];
 | |
| struct machine_desc *machine_desc __initdata;
 | |
| 
 | |
| static union { char c[4]; unsigned long l; } endian_test __initdata = { { 'l', '?', '?', 'b' } };
 | |
| #define ENDIANNESS ((char)endian_test.l)
 | |
| 
 | |
| DEFINE_PER_CPU(struct cpuinfo_arm, cpu_data);
 | |
| 
 | |
| /*
 | |
|  * Standard memory resources
 | |
|  */
 | |
| static struct resource mem_res[] = {
 | |
| 	{
 | |
| 		.name = "Video RAM",
 | |
| 		.start = 0,
 | |
| 		.end = 0,
 | |
| 		.flags = IORESOURCE_MEM
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "Kernel code",
 | |
| 		.start = 0,
 | |
| 		.end = 0,
 | |
| 		.flags = IORESOURCE_MEM
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "Kernel data",
 | |
| 		.start = 0,
 | |
| 		.end = 0,
 | |
| 		.flags = IORESOURCE_MEM
 | |
| 	}
 | |
| };
 | |
| 
 | |
| #define video_ram   mem_res[0]
 | |
| #define kernel_code mem_res[1]
 | |
| #define kernel_data mem_res[2]
 | |
| 
 | |
| static struct resource io_res[] = {
 | |
| 	{
 | |
| 		.name = "reserved",
 | |
| 		.start = 0x3bc,
 | |
| 		.end = 0x3be,
 | |
| 		.flags = IORESOURCE_IO | IORESOURCE_BUSY
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "reserved",
 | |
| 		.start = 0x378,
 | |
| 		.end = 0x37f,
 | |
| 		.flags = IORESOURCE_IO | IORESOURCE_BUSY
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "reserved",
 | |
| 		.start = 0x278,
 | |
| 		.end = 0x27f,
 | |
| 		.flags = IORESOURCE_IO | IORESOURCE_BUSY
 | |
| 	}
 | |
| };
 | |
| 
 | |
| #define lp0 io_res[0]
 | |
| #define lp1 io_res[1]
 | |
| #define lp2 io_res[2]
 | |
| 
 | |
| static const char *proc_arch[] = {
 | |
| 	"undefined/unknown",
 | |
| 	"3",
 | |
| 	"4",
 | |
| 	"4T",
 | |
| 	"5",
 | |
| 	"5T",
 | |
| 	"5TE",
 | |
| 	"5TEJ",
 | |
| 	"6TEJ",
 | |
| 	"7",
 | |
| 	"?(11)",
 | |
| 	"?(12)",
 | |
| 	"?(13)",
 | |
| 	"?(14)",
 | |
| 	"?(15)",
 | |
| 	"?(16)",
 | |
| 	"?(17)",
 | |
| };
 | |
| 
 | |
| static int __get_cpu_architecture(void)
 | |
| {
 | |
| 	int cpu_arch;
 | |
| 
 | |
| 	if ((read_cpuid_id() & 0x0008f000) == 0) {
 | |
| 		cpu_arch = CPU_ARCH_UNKNOWN;
 | |
| 	} else if ((read_cpuid_id() & 0x0008f000) == 0x00007000) {
 | |
| 		cpu_arch = (read_cpuid_id() & (1 << 23)) ? CPU_ARCH_ARMv4T : CPU_ARCH_ARMv3;
 | |
| 	} else if ((read_cpuid_id() & 0x00080000) == 0x00000000) {
 | |
| 		cpu_arch = (read_cpuid_id() >> 16) & 7;
 | |
| 		if (cpu_arch)
 | |
| 			cpu_arch += CPU_ARCH_ARMv3;
 | |
| 	} else if ((read_cpuid_id() & 0x000f0000) == 0x000f0000) {
 | |
| 		unsigned int mmfr0;
 | |
| 
 | |
| 		/* Revised CPUID format. Read the Memory Model Feature
 | |
| 		 * Register 0 and check for VMSAv7 or PMSAv7 */
 | |
| 		asm("mrc	p15, 0, %0, c0, c1, 4"
 | |
| 		    : "=r" (mmfr0));
 | |
| 		if ((mmfr0 & 0x0000000f) >= 0x00000003 ||
 | |
| 		    (mmfr0 & 0x000000f0) >= 0x00000030)
 | |
| 			cpu_arch = CPU_ARCH_ARMv7;
 | |
| 		else if ((mmfr0 & 0x0000000f) == 0x00000002 ||
 | |
| 			 (mmfr0 & 0x000000f0) == 0x00000020)
 | |
| 			cpu_arch = CPU_ARCH_ARMv6;
 | |
| 		else
 | |
| 			cpu_arch = CPU_ARCH_UNKNOWN;
 | |
| 	} else
 | |
| 		cpu_arch = CPU_ARCH_UNKNOWN;
 | |
| 
 | |
| 	return cpu_arch;
 | |
| }
 | |
| 
 | |
| int __pure cpu_architecture(void)
 | |
| {
 | |
| 	BUG_ON(__cpu_architecture == CPU_ARCH_UNKNOWN);
 | |
| 
 | |
| 	return __cpu_architecture;
 | |
| }
 | |
| 
 | |
| static int cpu_has_aliasing_icache(unsigned int arch)
 | |
| {
 | |
| 	int aliasing_icache;
 | |
| 	unsigned int id_reg, num_sets, line_size;
 | |
| 
 | |
| 	/* PIPT caches never alias. */
 | |
| 	if (icache_is_pipt())
 | |
| 		return 0;
 | |
| 
 | |
| 	/* arch specifies the register format */
 | |
| 	switch (arch) {
 | |
| 	case CPU_ARCH_ARMv7:
 | |
| 		asm("mcr	p15, 2, %0, c0, c0, 0 @ set CSSELR"
 | |
| 		    : /* No output operands */
 | |
| 		    : "r" (1));
 | |
| 		isb();
 | |
| 		asm("mrc	p15, 1, %0, c0, c0, 0 @ read CCSIDR"
 | |
| 		    : "=r" (id_reg));
 | |
| 		line_size = 4 << ((id_reg & 0x7) + 2);
 | |
| 		num_sets = ((id_reg >> 13) & 0x7fff) + 1;
 | |
| 		aliasing_icache = (line_size * num_sets) > PAGE_SIZE;
 | |
| 		break;
 | |
| 	case CPU_ARCH_ARMv6:
 | |
| 		aliasing_icache = read_cpuid_cachetype() & (1 << 11);
 | |
| 		break;
 | |
| 	default:
 | |
| 		/* I-cache aliases will be handled by D-cache aliasing code */
 | |
| 		aliasing_icache = 0;
 | |
| 	}
 | |
| 
 | |
| 	return aliasing_icache;
 | |
| }
 | |
| 
 | |
| static void __init cacheid_init(void)
 | |
| {
 | |
| 	unsigned int cachetype = read_cpuid_cachetype();
 | |
| 	unsigned int arch = cpu_architecture();
 | |
| 
 | |
| 	if (arch >= CPU_ARCH_ARMv6) {
 | |
| 		if ((cachetype & (7 << 29)) == 4 << 29) {
 | |
| 			/* ARMv7 register format */
 | |
| 			arch = CPU_ARCH_ARMv7;
 | |
| 			cacheid = CACHEID_VIPT_NONALIASING;
 | |
| 			switch (cachetype & (3 << 14)) {
 | |
| 			case (1 << 14):
 | |
| 				cacheid |= CACHEID_ASID_TAGGED;
 | |
| 				break;
 | |
| 			case (3 << 14):
 | |
| 				cacheid |= CACHEID_PIPT;
 | |
| 				break;
 | |
| 			}
 | |
| 		} else {
 | |
| 			arch = CPU_ARCH_ARMv6;
 | |
| 			if (cachetype & (1 << 23))
 | |
| 				cacheid = CACHEID_VIPT_ALIASING;
 | |
| 			else
 | |
| 				cacheid = CACHEID_VIPT_NONALIASING;
 | |
| 		}
 | |
| 		if (cpu_has_aliasing_icache(arch))
 | |
| 			cacheid |= CACHEID_VIPT_I_ALIASING;
 | |
| 	} else {
 | |
| 		cacheid = CACHEID_VIVT;
 | |
| 	}
 | |
| 
 | |
| 	printk("CPU: %s data cache, %s instruction cache\n",
 | |
| 		cache_is_vivt() ? "VIVT" :
 | |
| 		cache_is_vipt_aliasing() ? "VIPT aliasing" :
 | |
| 		cache_is_vipt_nonaliasing() ? "PIPT / VIPT nonaliasing" : "unknown",
 | |
| 		cache_is_vivt() ? "VIVT" :
 | |
| 		icache_is_vivt_asid_tagged() ? "VIVT ASID tagged" :
 | |
| 		icache_is_vipt_aliasing() ? "VIPT aliasing" :
 | |
| 		icache_is_pipt() ? "PIPT" :
 | |
| 		cache_is_vipt_nonaliasing() ? "VIPT nonaliasing" : "unknown");
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * These functions re-use the assembly code in head.S, which
 | |
|  * already provide the required functionality.
 | |
|  */
 | |
| extern struct proc_info_list *lookup_processor_type(unsigned int);
 | |
| 
 | |
| void __init early_print(const char *str, ...)
 | |
| {
 | |
| 	extern void printascii(const char *);
 | |
| 	char buf[256];
 | |
| 	va_list ap;
 | |
| 
 | |
| 	va_start(ap, str);
 | |
| 	vsnprintf(buf, sizeof(buf), str, ap);
 | |
| 	va_end(ap);
 | |
| 
 | |
| #ifdef CONFIG_DEBUG_LL
 | |
| 	printascii(buf);
 | |
| #endif
 | |
| 	printk("%s", buf);
 | |
| }
 | |
| 
 | |
| static void __init feat_v6_fixup(void)
 | |
| {
 | |
| 	int id = read_cpuid_id();
 | |
| 
 | |
| 	if ((id & 0xff0f0000) != 0x41070000)
 | |
| 		return;
 | |
| 
 | |
| 	/*
 | |
| 	 * HWCAP_TLS is available only on 1136 r1p0 and later,
 | |
| 	 * see also kuser_get_tls_init.
 | |
| 	 */
 | |
| 	if ((((id >> 4) & 0xfff) == 0xb36) && (((id >> 20) & 3) == 0))
 | |
| 		elf_hwcap &= ~HWCAP_TLS;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * cpu_init - initialise one CPU.
 | |
|  *
 | |
|  * cpu_init sets up the per-CPU stacks.
 | |
|  */
 | |
| void cpu_init(void)
 | |
| {
 | |
| 	unsigned int cpu = smp_processor_id();
 | |
| 	struct stack *stk = &stacks[cpu];
 | |
| 
 | |
| 	if (cpu >= NR_CPUS) {
 | |
| 		printk(KERN_CRIT "CPU%u: bad primary CPU number\n", cpu);
 | |
| 		BUG();
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * This only works on resume and secondary cores. For booting on the
 | |
| 	 * boot cpu, smp_prepare_boot_cpu is called after percpu area setup.
 | |
| 	 */
 | |
| 	set_my_cpu_offset(per_cpu_offset(cpu));
 | |
| 
 | |
| 	cpu_proc_init();
 | |
| 
 | |
| 	/*
 | |
| 	 * Define the placement constraint for the inline asm directive below.
 | |
| 	 * In Thumb-2, msr with an immediate value is not allowed.
 | |
| 	 */
 | |
| #ifdef CONFIG_THUMB2_KERNEL
 | |
| #define PLC	"r"
 | |
| #else
 | |
| #define PLC	"I"
 | |
| #endif
 | |
| 
 | |
| 	/*
 | |
| 	 * setup stacks for re-entrant exception handlers
 | |
| 	 */
 | |
| 	__asm__ (
 | |
| 	"msr	cpsr_c, %1\n\t"
 | |
| 	"add	r14, %0, %2\n\t"
 | |
| 	"mov	sp, r14\n\t"
 | |
| 	"msr	cpsr_c, %3\n\t"
 | |
| 	"add	r14, %0, %4\n\t"
 | |
| 	"mov	sp, r14\n\t"
 | |
| 	"msr	cpsr_c, %5\n\t"
 | |
| 	"add	r14, %0, %6\n\t"
 | |
| 	"mov	sp, r14\n\t"
 | |
| 	"msr	cpsr_c, %7"
 | |
| 	    :
 | |
| 	    : "r" (stk),
 | |
| 	      PLC (PSR_F_BIT | PSR_I_BIT | IRQ_MODE),
 | |
| 	      "I" (offsetof(struct stack, irq[0])),
 | |
| 	      PLC (PSR_F_BIT | PSR_I_BIT | ABT_MODE),
 | |
| 	      "I" (offsetof(struct stack, abt[0])),
 | |
| 	      PLC (PSR_F_BIT | PSR_I_BIT | UND_MODE),
 | |
| 	      "I" (offsetof(struct stack, und[0])),
 | |
| 	      PLC (PSR_F_BIT | PSR_I_BIT | SVC_MODE)
 | |
| 	    : "r14");
 | |
| }
 | |
| 
 | |
| int __cpu_logical_map[NR_CPUS];
 | |
| 
 | |
| void __init smp_setup_processor_id(void)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 mpidr = is_smp() ? read_cpuid_mpidr() & MPIDR_HWID_BITMASK : 0;
 | |
| 	u32 cpu = MPIDR_AFFINITY_LEVEL(mpidr, 0);
 | |
| 
 | |
| 	cpu_logical_map(0) = cpu;
 | |
| 	for (i = 1; i < nr_cpu_ids; ++i)
 | |
| 		cpu_logical_map(i) = i == cpu ? 0 : i;
 | |
| 
 | |
| 	printk(KERN_INFO "Booting Linux on physical CPU 0x%x\n", mpidr);
 | |
| }
 | |
| 
 | |
| static void __init setup_processor(void)
 | |
| {
 | |
| 	struct proc_info_list *list;
 | |
| 
 | |
| 	/*
 | |
| 	 * locate processor in the list of supported processor
 | |
| 	 * types.  The linker builds this table for us from the
 | |
| 	 * entries in arch/arm/mm/proc-*.S
 | |
| 	 */
 | |
| 	list = lookup_processor_type(read_cpuid_id());
 | |
| 	if (!list) {
 | |
| 		printk("CPU configuration botched (ID %08x), unable "
 | |
| 		       "to continue.\n", read_cpuid_id());
 | |
| 		while (1);
 | |
| 	}
 | |
| 
 | |
| 	cpu_name = list->cpu_name;
 | |
| 	__cpu_architecture = __get_cpu_architecture();
 | |
| 
 | |
| #ifdef MULTI_CPU
 | |
| 	processor = *list->proc;
 | |
| #endif
 | |
| #ifdef MULTI_TLB
 | |
| 	cpu_tlb = *list->tlb;
 | |
| #endif
 | |
| #ifdef MULTI_USER
 | |
| 	cpu_user = *list->user;
 | |
| #endif
 | |
| #ifdef MULTI_CACHE
 | |
| 	cpu_cache = *list->cache;
 | |
| #endif
 | |
| 
 | |
| 	printk("CPU: %s [%08x] revision %d (ARMv%s), cr=%08lx\n",
 | |
| 	       cpu_name, read_cpuid_id(), read_cpuid_id() & 15,
 | |
| 	       proc_arch[cpu_architecture()], cr_alignment);
 | |
| 
 | |
| 	snprintf(init_utsname()->machine, __NEW_UTS_LEN + 1, "%s%c",
 | |
| 		 list->arch_name, ENDIANNESS);
 | |
| 	snprintf(elf_platform, ELF_PLATFORM_SIZE, "%s%c",
 | |
| 		 list->elf_name, ENDIANNESS);
 | |
| 	elf_hwcap = list->elf_hwcap;
 | |
| #ifndef CONFIG_ARM_THUMB
 | |
| 	elf_hwcap &= ~HWCAP_THUMB;
 | |
| #endif
 | |
| 
 | |
| 	feat_v6_fixup();
 | |
| 
 | |
| 	cacheid_init();
 | |
| 	cpu_init();
 | |
| }
 | |
| 
 | |
| void __init dump_machine_table(void)
 | |
| {
 | |
| 	struct machine_desc *p;
 | |
| 
 | |
| 	early_print("Available machine support:\n\nID (hex)\tNAME\n");
 | |
| 	for_each_machine_desc(p)
 | |
| 		early_print("%08x\t%s\n", p->nr, p->name);
 | |
| 
 | |
| 	early_print("\nPlease check your kernel config and/or bootloader.\n");
 | |
| 
 | |
| 	while (true)
 | |
| 		/* can't use cpu_relax() here as it may require MMU setup */;
 | |
| }
 | |
| 
 | |
| int __init arm_add_memory(phys_addr_t start, phys_addr_t size)
 | |
| {
 | |
| 	struct membank *bank = &meminfo.bank[meminfo.nr_banks];
 | |
| 
 | |
| 	if (meminfo.nr_banks >= NR_BANKS) {
 | |
| 		printk(KERN_CRIT "NR_BANKS too low, "
 | |
| 			"ignoring memory at 0x%08llx\n", (long long)start);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Ensure that start/size are aligned to a page boundary.
 | |
| 	 * Size is appropriately rounded down, start is rounded up.
 | |
| 	 */
 | |
| 	size -= start & ~PAGE_MASK;
 | |
| 	bank->start = PAGE_ALIGN(start);
 | |
| 
 | |
| #ifndef CONFIG_LPAE
 | |
| 	if (bank->start + size < bank->start) {
 | |
| 		printk(KERN_CRIT "Truncating memory at 0x%08llx to fit in "
 | |
| 			"32-bit physical address space\n", (long long)start);
 | |
| 		/*
 | |
| 		 * To ensure bank->start + bank->size is representable in
 | |
| 		 * 32 bits, we use ULONG_MAX as the upper limit rather than 4GB.
 | |
| 		 * This means we lose a page after masking.
 | |
| 		 */
 | |
| 		size = ULONG_MAX - bank->start;
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| 	bank->size = size & ~(phys_addr_t)(PAGE_SIZE - 1);
 | |
| 
 | |
| 	/*
 | |
| 	 * Check whether this memory region has non-zero size or
 | |
| 	 * invalid node number.
 | |
| 	 */
 | |
| 	if (bank->size == 0)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	meminfo.nr_banks++;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Pick out the memory size.  We look for mem=size@start,
 | |
|  * where start and size are "size[KkMm]"
 | |
|  */
 | |
| static int __init early_mem(char *p)
 | |
| {
 | |
| 	static int usermem __initdata = 0;
 | |
| 	phys_addr_t size;
 | |
| 	phys_addr_t start;
 | |
| 	char *endp;
 | |
| 
 | |
| 	/*
 | |
| 	 * If the user specifies memory size, we
 | |
| 	 * blow away any automatically generated
 | |
| 	 * size.
 | |
| 	 */
 | |
| 	if (usermem == 0) {
 | |
| 		usermem = 1;
 | |
| 		meminfo.nr_banks = 0;
 | |
| 	}
 | |
| 
 | |
| 	start = PHYS_OFFSET;
 | |
| 	size  = memparse(p, &endp);
 | |
| 	if (*endp == '@')
 | |
| 		start = memparse(endp + 1, NULL);
 | |
| 
 | |
| 	arm_add_memory(start, size);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| early_param("mem", early_mem);
 | |
| 
 | |
| static void __init request_standard_resources(struct machine_desc *mdesc)
 | |
| {
 | |
| 	struct memblock_region *region;
 | |
| 	struct resource *res;
 | |
| 
 | |
| 	kernel_code.start   = virt_to_phys(_text);
 | |
| 	kernel_code.end     = virt_to_phys(_etext - 1);
 | |
| 	kernel_data.start   = virt_to_phys(_sdata);
 | |
| 	kernel_data.end     = virt_to_phys(_end - 1);
 | |
| 
 | |
| 	for_each_memblock(memory, region) {
 | |
| 		res = alloc_bootmem_low(sizeof(*res));
 | |
| 		res->name  = "System RAM";
 | |
| 		res->start = __pfn_to_phys(memblock_region_memory_base_pfn(region));
 | |
| 		res->end = __pfn_to_phys(memblock_region_memory_end_pfn(region)) - 1;
 | |
| 		res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
 | |
| 
 | |
| 		request_resource(&iomem_resource, res);
 | |
| 
 | |
| 		if (kernel_code.start >= res->start &&
 | |
| 		    kernel_code.end <= res->end)
 | |
| 			request_resource(res, &kernel_code);
 | |
| 		if (kernel_data.start >= res->start &&
 | |
| 		    kernel_data.end <= res->end)
 | |
| 			request_resource(res, &kernel_data);
 | |
| 	}
 | |
| 
 | |
| 	if (mdesc->video_start) {
 | |
| 		video_ram.start = mdesc->video_start;
 | |
| 		video_ram.end   = mdesc->video_end;
 | |
| 		request_resource(&iomem_resource, &video_ram);
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Some machines don't have the possibility of ever
 | |
| 	 * possessing lp0, lp1 or lp2
 | |
| 	 */
 | |
| 	if (mdesc->reserve_lp0)
 | |
| 		request_resource(&ioport_resource, &lp0);
 | |
| 	if (mdesc->reserve_lp1)
 | |
| 		request_resource(&ioport_resource, &lp1);
 | |
| 	if (mdesc->reserve_lp2)
 | |
| 		request_resource(&ioport_resource, &lp2);
 | |
| }
 | |
| 
 | |
| #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
 | |
| struct screen_info screen_info = {
 | |
|  .orig_video_lines	= 30,
 | |
|  .orig_video_cols	= 80,
 | |
|  .orig_video_mode	= 0,
 | |
|  .orig_video_ega_bx	= 0,
 | |
|  .orig_video_isVGA	= 1,
 | |
|  .orig_video_points	= 8
 | |
| };
 | |
| #endif
 | |
| 
 | |
| static int __init customize_machine(void)
 | |
| {
 | |
| 	/* customizes platform devices, or adds new ones */
 | |
| 	if (machine_desc->init_machine)
 | |
| 		machine_desc->init_machine();
 | |
| 	return 0;
 | |
| }
 | |
| arch_initcall(customize_machine);
 | |
| 
 | |
| static int __init init_machine_late(void)
 | |
| {
 | |
| 	if (machine_desc->init_late)
 | |
| 		machine_desc->init_late();
 | |
| 	return 0;
 | |
| }
 | |
| late_initcall(init_machine_late);
 | |
| 
 | |
| #ifdef CONFIG_KEXEC
 | |
| static inline unsigned long long get_total_mem(void)
 | |
| {
 | |
| 	unsigned long total;
 | |
| 
 | |
| 	total = max_low_pfn - min_low_pfn;
 | |
| 	return total << PAGE_SHIFT;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * reserve_crashkernel() - reserves memory are for crash kernel
 | |
|  *
 | |
|  * This function reserves memory area given in "crashkernel=" kernel command
 | |
|  * line parameter. The memory reserved is used by a dump capture kernel when
 | |
|  * primary kernel is crashing.
 | |
|  */
 | |
| static void __init reserve_crashkernel(void)
 | |
| {
 | |
| 	unsigned long long crash_size, crash_base;
 | |
| 	unsigned long long total_mem;
 | |
| 	int ret;
 | |
| 
 | |
| 	total_mem = get_total_mem();
 | |
| 	ret = parse_crashkernel(boot_command_line, total_mem,
 | |
| 				&crash_size, &crash_base);
 | |
| 	if (ret)
 | |
| 		return;
 | |
| 
 | |
| 	ret = reserve_bootmem(crash_base, crash_size, BOOTMEM_EXCLUSIVE);
 | |
| 	if (ret < 0) {
 | |
| 		printk(KERN_WARNING "crashkernel reservation failed - "
 | |
| 		       "memory is in use (0x%lx)\n", (unsigned long)crash_base);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	printk(KERN_INFO "Reserving %ldMB of memory at %ldMB "
 | |
| 	       "for crashkernel (System RAM: %ldMB)\n",
 | |
| 	       (unsigned long)(crash_size >> 20),
 | |
| 	       (unsigned long)(crash_base >> 20),
 | |
| 	       (unsigned long)(total_mem >> 20));
 | |
| 
 | |
| 	crashk_res.start = crash_base;
 | |
| 	crashk_res.end = crash_base + crash_size - 1;
 | |
| 	insert_resource(&iomem_resource, &crashk_res);
 | |
| }
 | |
| #else
 | |
| static inline void reserve_crashkernel(void) {}
 | |
| #endif /* CONFIG_KEXEC */
 | |
| 
 | |
| static int __init meminfo_cmp(const void *_a, const void *_b)
 | |
| {
 | |
| 	const struct membank *a = _a, *b = _b;
 | |
| 	long cmp = bank_pfn_start(a) - bank_pfn_start(b);
 | |
| 	return cmp < 0 ? -1 : cmp > 0 ? 1 : 0;
 | |
| }
 | |
| 
 | |
| void __init hyp_mode_check(void)
 | |
| {
 | |
| #ifdef CONFIG_ARM_VIRT_EXT
 | |
| 	if (is_hyp_mode_available()) {
 | |
| 		pr_info("CPU: All CPU(s) started in HYP mode.\n");
 | |
| 		pr_info("CPU: Virtualization extensions available.\n");
 | |
| 	} else if (is_hyp_mode_mismatched()) {
 | |
| 		pr_warn("CPU: WARNING: CPU(s) started in wrong/inconsistent modes (primary CPU mode 0x%x)\n",
 | |
| 			__boot_cpu_mode & MODE_MASK);
 | |
| 		pr_warn("CPU: This may indicate a broken bootloader or firmware.\n");
 | |
| 	} else
 | |
| 		pr_info("CPU: All CPU(s) started in SVC mode.\n");
 | |
| #endif
 | |
| }
 | |
| 
 | |
| void __init setup_arch(char **cmdline_p)
 | |
| {
 | |
| 	struct machine_desc *mdesc;
 | |
| 
 | |
| 	setup_processor();
 | |
| 	mdesc = setup_machine_fdt(__atags_pointer);
 | |
| 	if (!mdesc)
 | |
| 		mdesc = setup_machine_tags(__atags_pointer, __machine_arch_type);
 | |
| 	machine_desc = mdesc;
 | |
| 	machine_name = mdesc->name;
 | |
| 
 | |
| 	setup_dma_zone(mdesc);
 | |
| 
 | |
| 	if (mdesc->restart_mode)
 | |
| 		reboot_setup(&mdesc->restart_mode);
 | |
| 
 | |
| 	init_mm.start_code = (unsigned long) _text;
 | |
| 	init_mm.end_code   = (unsigned long) _etext;
 | |
| 	init_mm.end_data   = (unsigned long) _edata;
 | |
| 	init_mm.brk	   = (unsigned long) _end;
 | |
| 
 | |
| 	/* populate cmd_line too for later use, preserving boot_command_line */
 | |
| 	strlcpy(cmd_line, boot_command_line, COMMAND_LINE_SIZE);
 | |
| 	*cmdline_p = cmd_line;
 | |
| 
 | |
| 	parse_early_param();
 | |
| 
 | |
| 	sort(&meminfo.bank, meminfo.nr_banks, sizeof(meminfo.bank[0]), meminfo_cmp, NULL);
 | |
| 	sanity_check_meminfo();
 | |
| 	arm_memblock_init(&meminfo, mdesc);
 | |
| 
 | |
| 	paging_init(mdesc);
 | |
| 	request_standard_resources(mdesc);
 | |
| 
 | |
| 	if (mdesc->restart)
 | |
| 		arm_pm_restart = mdesc->restart;
 | |
| 
 | |
| 	unflatten_device_tree();
 | |
| 
 | |
| 	arm_dt_init_cpu_maps();
 | |
| #ifdef CONFIG_SMP
 | |
| 	if (is_smp()) {
 | |
| 		smp_set_ops(mdesc->smp);
 | |
| 		smp_init_cpus();
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| 	if (!is_smp())
 | |
| 		hyp_mode_check();
 | |
| 
 | |
| 	reserve_crashkernel();
 | |
| 
 | |
| 	tcm_init();
 | |
| 
 | |
| #ifdef CONFIG_MULTI_IRQ_HANDLER
 | |
| 	handle_arch_irq = mdesc->handle_irq;
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_VT
 | |
| #if defined(CONFIG_VGA_CONSOLE)
 | |
| 	conswitchp = &vga_con;
 | |
| #elif defined(CONFIG_DUMMY_CONSOLE)
 | |
| 	conswitchp = &dummy_con;
 | |
| #endif
 | |
| #endif
 | |
| 
 | |
| 	if (mdesc->init_early)
 | |
| 		mdesc->init_early();
 | |
| }
 | |
| 
 | |
| 
 | |
| static int __init topology_init(void)
 | |
| {
 | |
| 	int cpu;
 | |
| 
 | |
| 	for_each_possible_cpu(cpu) {
 | |
| 		struct cpuinfo_arm *cpuinfo = &per_cpu(cpu_data, cpu);
 | |
| 		cpuinfo->cpu.hotpluggable = 1;
 | |
| 		register_cpu(&cpuinfo->cpu, cpu);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| subsys_initcall(topology_init);
 | |
| 
 | |
| #ifdef CONFIG_HAVE_PROC_CPU
 | |
| static int __init proc_cpu_init(void)
 | |
| {
 | |
| 	struct proc_dir_entry *res;
 | |
| 
 | |
| 	res = proc_mkdir("cpu", NULL);
 | |
| 	if (!res)
 | |
| 		return -ENOMEM;
 | |
| 	return 0;
 | |
| }
 | |
| fs_initcall(proc_cpu_init);
 | |
| #endif
 | |
| 
 | |
| static const char *hwcap_str[] = {
 | |
| 	"swp",
 | |
| 	"half",
 | |
| 	"thumb",
 | |
| 	"26bit",
 | |
| 	"fastmult",
 | |
| 	"fpa",
 | |
| 	"vfp",
 | |
| 	"edsp",
 | |
| 	"java",
 | |
| 	"iwmmxt",
 | |
| 	"crunch",
 | |
| 	"thumbee",
 | |
| 	"neon",
 | |
| 	"vfpv3",
 | |
| 	"vfpv3d16",
 | |
| 	"tls",
 | |
| 	"vfpv4",
 | |
| 	"idiva",
 | |
| 	"idivt",
 | |
| 	NULL
 | |
| };
 | |
| 
 | |
| static int c_show(struct seq_file *m, void *v)
 | |
| {
 | |
| 	int i, j;
 | |
| 	u32 cpuid;
 | |
| 
 | |
| 	for_each_online_cpu(i) {
 | |
| 		/*
 | |
| 		 * glibc reads /proc/cpuinfo to determine the number of
 | |
| 		 * online processors, looking for lines beginning with
 | |
| 		 * "processor".  Give glibc what it expects.
 | |
| 		 */
 | |
| 		seq_printf(m, "processor\t: %d\n", i);
 | |
| 		cpuid = is_smp() ? per_cpu(cpu_data, i).cpuid : read_cpuid_id();
 | |
| 		seq_printf(m, "model name\t: %s rev %d (%s)\n",
 | |
| 			   cpu_name, cpuid & 15, elf_platform);
 | |
| 
 | |
| #if defined(CONFIG_SMP)
 | |
| 		seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
 | |
| 			   per_cpu(cpu_data, i).loops_per_jiffy / (500000UL/HZ),
 | |
| 			   (per_cpu(cpu_data, i).loops_per_jiffy / (5000UL/HZ)) % 100);
 | |
| #else
 | |
| 		seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
 | |
| 			   loops_per_jiffy / (500000/HZ),
 | |
| 			   (loops_per_jiffy / (5000/HZ)) % 100);
 | |
| #endif
 | |
| 		/* dump out the processor features */
 | |
| 		seq_puts(m, "Features\t: ");
 | |
| 
 | |
| 		for (j = 0; hwcap_str[j]; j++)
 | |
| 			if (elf_hwcap & (1 << j))
 | |
| 				seq_printf(m, "%s ", hwcap_str[j]);
 | |
| 
 | |
| 		seq_printf(m, "\nCPU implementer\t: 0x%02x\n", cpuid >> 24);
 | |
| 		seq_printf(m, "CPU architecture: %s\n",
 | |
| 			   proc_arch[cpu_architecture()]);
 | |
| 
 | |
| 		if ((cpuid & 0x0008f000) == 0x00000000) {
 | |
| 			/* pre-ARM7 */
 | |
| 			seq_printf(m, "CPU part\t: %07x\n", cpuid >> 4);
 | |
| 		} else {
 | |
| 			if ((cpuid & 0x0008f000) == 0x00007000) {
 | |
| 				/* ARM7 */
 | |
| 				seq_printf(m, "CPU variant\t: 0x%02x\n",
 | |
| 					   (cpuid >> 16) & 127);
 | |
| 			} else {
 | |
| 				/* post-ARM7 */
 | |
| 				seq_printf(m, "CPU variant\t: 0x%x\n",
 | |
| 					   (cpuid >> 20) & 15);
 | |
| 			}
 | |
| 			seq_printf(m, "CPU part\t: 0x%03x\n",
 | |
| 				   (cpuid >> 4) & 0xfff);
 | |
| 		}
 | |
| 		seq_printf(m, "CPU revision\t: %d\n\n", cpuid & 15);
 | |
| 	}
 | |
| 
 | |
| 	seq_printf(m, "Hardware\t: %s\n", machine_name);
 | |
| 	seq_printf(m, "Revision\t: %04x\n", system_rev);
 | |
| 	seq_printf(m, "Serial\t\t: %08x%08x\n",
 | |
| 		   system_serial_high, system_serial_low);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void *c_start(struct seq_file *m, loff_t *pos)
 | |
| {
 | |
| 	return *pos < 1 ? (void *)1 : NULL;
 | |
| }
 | |
| 
 | |
| static void *c_next(struct seq_file *m, void *v, loff_t *pos)
 | |
| {
 | |
| 	++*pos;
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static void c_stop(struct seq_file *m, void *v)
 | |
| {
 | |
| }
 | |
| 
 | |
| const struct seq_operations cpuinfo_op = {
 | |
| 	.start	= c_start,
 | |
| 	.next	= c_next,
 | |
| 	.stop	= c_stop,
 | |
| 	.show	= c_show
 | |
| };
 |