[linux.git] / arch / avr32 / kernel / setup.c

/*
 * Copyright (C) 2004-2006 Atmel Corporation
 *
 * 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/clk.h>
#include <linux/init.h>
#include <linux/initrd.h>
#include <linux/sched.h>
#include <linux/console.h>
#include <linux/ioport.h>
#include <linux/bootmem.h>
#include <linux/fs.h>
#include <linux/module.h>
#include <linux/pfn.h>
#include <linux/root_dev.h>
#include <linux/cpu.h>
#include <linux/kernel.h>

#include <asm/sections.h>
#include <asm/processor.h>
#include <asm/pgtable.h>
#include <asm/setup.h>
#include <asm/sysreg.h>

#include <mach/board.h>
#include <mach/init.h>

extern int root_mountflags;

/*
 * Initialize loops_per_jiffy as 5000000 (500MIPS).
 * Better make it too large than too small...
 */
struct avr32_cpuinfo boot_cpu_data = {
	.loops_per_jiffy = 5000000
};
EXPORT_SYMBOL(boot_cpu_data);

static char __initdata command_line[COMMAND_LINE_SIZE];

/*
 * Standard memory resources
 */
static struct resource __initdata kernel_data = {
	.name	= "Kernel data",
	.start	= 0,
	.end	= 0,
	.flags	= IORESOURCE_MEM,
};
static struct resource __initdata kernel_code = {
	.name	= "Kernel code",
	.start	= 0,
	.end	= 0,
	.flags	= IORESOURCE_MEM,
	.sibling = &kernel_data,
};

/*
 * Available system RAM and reserved regions as singly linked
 * lists. These lists are traversed using the sibling pointer in
 * struct resource and are kept sorted at all times.
 */
static struct resource *__initdata system_ram;
static struct resource *__initdata reserved = &kernel_code;

/*
 * We need to allocate these before the bootmem allocator is up and
 * running, so we need this "cache". 32 entries are probably enough
 * for all but the most insanely complex systems.
 */
static struct resource __initdata res_cache[32];
static unsigned int __initdata res_cache_next_free;

static void __init resource_init(void)
{
	struct resource *mem, *res;
	struct resource *new;

	kernel_code.start = __pa(init_mm.start_code);

	for (mem = system_ram; mem; mem = mem->sibling) {
		new = alloc_bootmem_low(sizeof(struct resource));
		memcpy(new, mem, sizeof(struct resource));

		new->sibling = NULL;
		if (request_resource(&iomem_resource, new))
			printk(KERN_WARNING "Bad RAM resource %08x-%08x\n",
			       mem->start, mem->end);
	}

	for (res = reserved; res; res = res->sibling) {
		new = alloc_bootmem_low(sizeof(struct resource));
		memcpy(new, res, sizeof(struct resource));

		new->sibling = NULL;
		if (insert_resource(&iomem_resource, new))
			printk(KERN_WARNING
			       "Bad reserved resource %s (%08x-%08x)\n",
			       res->name, res->start, res->end);
	}
}

static void __init
add_physical_memory(resource_size_t start, resource_size_t end)
{
	struct resource *new, *next, **pprev;

	for (pprev = &system_ram, next = system_ram; next;
	     pprev = &next->sibling, next = next->sibling) {
		if (end < next->start)
			break;
		if (start <= next->end) {
			printk(KERN_WARNING
			       "Warning: Physical memory map is broken\n");
			printk(KERN_WARNING
			       "Warning: %08x-%08x overlaps %08x-%08x\n",
			       start, end, next->start, next->end);
			return;
		}
	}

	if (res_cache_next_free >= ARRAY_SIZE(res_cache)) {
		printk(KERN_WARNING
		       "Warning: Failed to add physical memory %08x-%08x\n",
		       start, end);
		return;
	}

	new = &res_cache[res_cache_next_free++];
	new->start = start;
	new->end = end;
	new->name = "System RAM";
	new->flags = IORESOURCE_MEM;

	*pprev = new;
}

static int __init
add_reserved_region(resource_size_t start, resource_size_t end,
		    const char *name)
{
	struct resource *new, *next, **pprev;

	if (end < start)
		return -EINVAL;

	if (res_cache_next_free >= ARRAY_SIZE(res_cache))
		return -ENOMEM;

	for (pprev = &reserved, next = reserved; next;
	     pprev = &next->sibling, next = next->sibling) {
		if (end < next->start)
			break;
		if (start <= next->end)
			return -EBUSY;
	}

	new = &res_cache[res_cache_next_free++];
	new->start = start;
	new->end = end;
	new->name = name;
	new->sibling = next;
	new->flags = IORESOURCE_MEM;

	*pprev = new;

	return 0;
}

static unsigned long __init
find_free_region(const struct resource *mem, resource_size_t size,
		 resource_size_t align)
{
	struct resource *res;
	unsigned long target;

	target = ALIGN(mem->start, align);
	for (res = reserved; res; res = res->sibling) {
		if ((target + size) <= res->start)
			break;
		if (target <= res->end)
			target = ALIGN(res->end + 1, align);
	}

	if ((target + size) > (mem->end + 1))
		return mem->end + 1;

	return target;
}

static int __init
alloc_reserved_region(resource_size_t *start, resource_size_t size,
		      resource_size_t align, const char *name)
{
	struct resource *mem;
	resource_size_t target;
	int ret;

	for (mem = system_ram; mem; mem = mem->sibling) {
		target = find_free_region(mem, size, align);
		if (target <= mem->end) {
			ret = add_reserved_region(target, target + size - 1,
						  name);
			if (!ret)
				*start = target;
			return ret;
		}
	}

	return -ENOMEM;
}

/*
 * Early framebuffer allocation. Works as follows:
 *   - If fbmem_size is zero, nothing will be allocated or reserved.
 *   - If fbmem_start is zero when setup_bootmem() is called,
 *     a block of fbmem_size bytes will be reserved before bootmem
 *     initialization. It will be aligned to the largest page size
 *     that fbmem_size is a multiple of.
 *   - If fbmem_start is nonzero, an area of size fbmem_size will be
 *     reserved at the physical address fbmem_start if possible. If
 *     it collides with other reserved memory, a different block of
 *     same size will be allocated, just as if fbmem_start was zero.
 *
 * Board-specific code may use these variables to set up platform data
 * for the framebuffer driver if fbmem_size is nonzero.
 */
resource_size_t __initdata fbmem_start;
resource_size_t __initdata fbmem_size;

/*
 * "fbmem=xxx[kKmM]" allocates the specified amount of boot memory for
 * use as framebuffer.
 *
 * "fbmem=xxx[kKmM]@yyy[kKmM]" defines a memory region of size xxx and
 * starting at yyy to be reserved for use as framebuffer.
 *
 * The kernel won't verify that the memory region starting at yyy
 * actually contains usable RAM.
 */
static int __init early_parse_fbmem(char *p)
{
	int ret;
	unsigned long align;

	fbmem_size = memparse(p, &p);
	if (*p == '@') {
		fbmem_start = memparse(p + 1, &p);
		ret = add_reserved_region(fbmem_start,
					  fbmem_start + fbmem_size - 1,
					  "Framebuffer");
		if (ret) {
			printk(KERN_WARNING
			       "Failed to reserve framebuffer memory\n");
			fbmem_start = 0;
		}
	}

	if (!fbmem_start) {
		if ((fbmem_size & 0x000fffffUL) == 0)
			align = 0x100000;	/* 1 MiB */
		else if ((fbmem_size & 0x0000ffffUL) == 0)
			align = 0x10000;	/* 64 KiB */
		else
			align = 0x1000;		/* 4 KiB */

		ret = alloc_reserved_region(&fbmem_start, fbmem_size,
					    align, "Framebuffer");
		if (ret) {
			printk(KERN_WARNING
			       "Failed to allocate framebuffer memory\n");
			fbmem_size = 0;
		} else {
			memset(__va(fbmem_start), 0, fbmem_size);
		}
	}

	return 0;
}
early_param("fbmem", early_parse_fbmem);

/*
 * Pick out the memory size.  We look for mem=size@start,
 * where start and size are "size[KkMmGg]"
 */
static int __init early_mem(char *p)
{
	resource_size_t size, start;

	start = system_ram->start;
	size  = memparse(p, &p);
	if (*p == '@')
		start = memparse(p + 1, &p);

	system_ram->start = start;
	system_ram->end = system_ram->start + size - 1;
	return 0;
}
early_param("mem", early_mem);

static int __init parse_tag_core(struct tag *tag)
{
	if (tag->hdr.size > 2) {
		if ((tag->u.core.flags & 1) == 0)
			root_mountflags &= ~MS_RDONLY;
		ROOT_DEV = new_decode_dev(tag->u.core.rootdev);
	}
	return 0;
}
__tagtable(ATAG_CORE, parse_tag_core);

static int __init parse_tag_mem(struct tag *tag)
{
	unsigned long start, end;

	/*
	 * Ignore zero-sized entries. If we're running standalone, the
	 * SDRAM code may emit such entries if something goes
	 * wrong...
	 */
	if (tag->u.mem_range.size == 0)
		return 0;

	start = tag->u.mem_range.addr;
	end = tag->u.mem_range.addr + tag->u.mem_range.size - 1;

	add_physical_memory(start, end);
	return 0;
}
__tagtable(ATAG_MEM, parse_tag_mem);

static int __init parse_tag_rdimg(struct tag *tag)
{
#ifdef CONFIG_BLK_DEV_INITRD
	struct tag_mem_range *mem = &tag->u.mem_range;
	int ret;

	if (initrd_start) {
		printk(KERN_WARNING
		       "Warning: Only the first initrd image will be used\n");
		return 0;
	}

	ret = add_reserved_region(mem->addr, mem->addr + mem->size - 1,
				  "initrd");
	if (ret) {
		printk(KERN_WARNING
		       "Warning: Failed to reserve initrd memory\n");
		return ret;
	}

	initrd_start = (unsigned long)__va(mem->addr);
	initrd_end = initrd_start + mem->size;
#else
	printk(KERN_WARNING "RAM disk image present, but "
	       "no initrd support in kernel, ignoring\n");
#endif

	return 0;
}
__tagtable(ATAG_RDIMG, parse_tag_rdimg);

static int __init parse_tag_rsvd_mem(struct tag *tag)
{
	struct tag_mem_range *mem = &tag->u.mem_range;

	return add_reserved_region(mem->addr, mem->addr + mem->size - 1,
				   "Reserved");
}
__tagtable(ATAG_RSVD_MEM, parse_tag_rsvd_mem);

static int __init parse_tag_cmdline(struct tag *tag)
{
	strlcpy(boot_command_line, tag->u.cmdline.cmdline, COMMAND_LINE_SIZE);
	return 0;
}
__tagtable(ATAG_CMDLINE, parse_tag_cmdline);

static int __init parse_tag_clock(struct tag *tag)
{
	/*
	 * We'll figure out the clocks by peeking at the system
	 * manager regs directly.
	 */
	return 0;
}
__tagtable(ATAG_CLOCK, parse_tag_clock);

/*
 * The board_number correspond to the bd->bi_board_number in U-Boot. This
 * parameter is only available during initialisation and can be used in some
 * kind of board identification.
 */
u32 __initdata board_number;

static int __init parse_tag_boardinfo(struct tag *tag)
{
	board_number = tag->u.boardinfo.board_number;

	return 0;
}
__tagtable(ATAG_BOARDINFO, parse_tag_boardinfo);

/*
 * Scan the tag table for this tag, and call its parse function. The
 * tag table is built by the linker from all the __tagtable
 * declarations.
 */
static int __init parse_tag(struct tag *tag)
{
	extern struct tagtable __tagtable_begin, __tagtable_end;
	struct tagtable *t;

	for (t = &__tagtable_begin; t < &__tagtable_end; t++)
		if (tag->hdr.tag == t->tag) {
			t->parse(tag);
			break;
		}

	return t < &__tagtable_end;
}

/*
 * Parse all tags in the list we got from the boot loader
 */
static void __init parse_tags(struct tag *t)
{
	for (; t->hdr.tag != ATAG_NONE; t = tag_next(t))
		if (!parse_tag(t))
			printk(KERN_WARNING
			       "Ignoring unrecognised tag 0x%08x\n",
			       t->hdr.tag);
}

/*
 * Find a free memory region large enough for storing the
 * bootmem bitmap.
 */
static unsigned long __init
find_bootmap_pfn(const struct resource *mem)
{
	unsigned long bootmap_pages, bootmap_len;
	unsigned long node_pages = PFN_UP(resource_size(mem));
	unsigned long bootmap_start;

	bootmap_pages = bootmem_bootmap_pages(node_pages);
	bootmap_len = bootmap_pages << PAGE_SHIFT;

	/*
	 * Find a large enough region without reserved pages for
	 * storing the bootmem bitmap. We can take advantage of the
	 * fact that all lists have been sorted.
	 *
	 * We have to check that we don't collide with any reserved
	 * regions, which includes the kernel image and any RAMDISK
	 * images.
	 */
	bootmap_start = find_free_region(mem, bootmap_len, PAGE_SIZE);

	return bootmap_start >> PAGE_SHIFT;
}

#define MAX_LOWMEM	HIGHMEM_START
#define MAX_LOWMEM_PFN	PFN_DOWN(MAX_LOWMEM)

static void __init setup_bootmem(void)
{
	unsigned bootmap_size;
	unsigned long first_pfn, bootmap_pfn, pages;
	unsigned long max_pfn, max_low_pfn;
	unsigned node = 0;
	struct resource *res;

	printk(KERN_INFO "Physical memory:\n");
	for (res = system_ram; res; res = res->sibling)
		printk("  %08x-%08x\n", res->start, res->end);
	printk(KERN_INFO "Reserved memory:\n");
	for (res = reserved; res; res = res->sibling)
		printk("  %08x-%08x: %s\n",
		       res->start, res->end, res->name);

	nodes_clear(node_online_map);

	if (system_ram->sibling)
		printk(KERN_WARNING "Only using first memory bank\n");

	for (res = system_ram; res; res = NULL) {
		first_pfn = PFN_UP(res->start);
		max_low_pfn = max_pfn = PFN_DOWN(res->end + 1);
		bootmap_pfn = find_bootmap_pfn(res);
		if (bootmap_pfn > max_pfn)
			panic("No space for bootmem bitmap!\n");

		if (max_low_pfn > MAX_LOWMEM_PFN) {
			max_low_pfn = MAX_LOWMEM_PFN;
#ifndef CONFIG_HIGHMEM
			/*
			 * Lowmem is memory that can be addressed
			 * directly through P1/P2
			 */
			printk(KERN_WARNING
			       "Node %u: Only %ld MiB of memory will be used.\n",
			       node, MAX_LOWMEM >> 20);
			printk(KERN_WARNING "Use a HIGHMEM enabled kernel.\n");
#else
#error HIGHMEM is not supported by AVR32 yet
#endif
		}

		/* Initialize the boot-time allocator with low memory only. */
		bootmap_size = init_bootmem_node(NODE_DATA(node), bootmap_pfn,
						 first_pfn, max_low_pfn);

		/*
		 * Register fully available RAM pages with the bootmem
		 * allocator.
		 */
		pages = max_low_pfn - first_pfn;
		free_bootmem_node (NODE_DATA(node), PFN_PHYS(first_pfn),
				   PFN_PHYS(pages));

		/* Reserve space for the bootmem bitmap... */
		reserve_bootmem_node(NODE_DATA(node),
				     PFN_PHYS(bootmap_pfn),
				     bootmap_size,
				     BOOTMEM_DEFAULT);

		/* ...and any other reserved regions. */
		for (res = reserved; res; res = res->sibling) {
			if (res->start > PFN_PHYS(max_pfn))
				break;

			/*
			 * resource_init will complain about partial
			 * overlaps, so we'll just ignore such
			 * resources for now.
			 */
			if (res->start >= PFN_PHYS(first_pfn)
			    && res->end < PFN_PHYS(max_pfn))
				reserve_bootmem_node(NODE_DATA(node),
						     res->start,
						     resource_size(res),
						     BOOTMEM_DEFAULT);
		}

		node_set_online(node);
	}
}

void __init setup_arch (char **cmdline_p)
{
	struct clk *cpu_clk;

	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;

	/*
	 * Include .init section to make allocations easier. It will
	 * be removed before the resource is actually requested.
	 */
	kernel_code.start = __pa(__init_begin);
	kernel_code.end = __pa(init_mm.end_code - 1);
	kernel_data.start = __pa(init_mm.end_code);
	kernel_data.end = __pa(init_mm.brk - 1);

	parse_tags(bootloader_tags);

	setup_processor();
	setup_platform();
	setup_board();

	cpu_clk = clk_get(NULL, "cpu");
	if (IS_ERR(cpu_clk)) {
		printk(KERN_WARNING "Warning: Unable to get CPU clock\n");
	} else {
		unsigned long cpu_hz = clk_get_rate(cpu_clk);

		/*
		 * Well, duh, but it's probably a good idea to
		 * increment the use count.
		 */
		clk_enable(cpu_clk);

		boot_cpu_data.clk = cpu_clk;
		boot_cpu_data.loops_per_jiffy = cpu_hz * 4;
		printk("CPU: Running at %lu.%03lu MHz\n",
		       ((cpu_hz + 500) / 1000) / 1000,
		       ((cpu_hz + 500) / 1000) % 1000);
	}

	strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE);
	*cmdline_p = command_line;
	parse_early_param();

	setup_bootmem();

#ifdef CONFIG_VT
	conswitchp = &dummy_con;
#endif

	paging_init();
	resource_init();
}
Commit	Line	Data
5f97f7f9 HS	1	/*
	2	* Copyright (C) 2004-2006 Atmel Corporation
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8
	9	#include <linux/clk.h>
	10	#include <linux/init.h>
5539f59a	11	#include <linux/initrd.h>
5f97f7f9 HS	12	#include <linux/sched.h>
	13	#include <linux/console.h>
	14	#include <linux/ioport.h>
	15	#include <linux/bootmem.h>
	16	#include <linux/fs.h>
	17	#include <linux/module.h>
5539f59a	18	#include <linux/pfn.h>
5f97f7f9 HS	19	#include <linux/root_dev.h>
5f97f7f9 HS	20	#include <linux/cpu.h>
10b50b7d	21	#include <linux/kernel.h>
5f97f7f9 HS	22
	23	#include <asm/sections.h>
	24	#include <asm/processor.h>
	25	#include <asm/pgtable.h>
	26	#include <asm/setup.h>
	27	#include <asm/sysreg.h>
	28
3663b736 HS	29	#include <mach/board.h>
3663b736 HS	30	#include <mach/init.h>
5f97f7f9 HS	31
	32	extern int root_mountflags;
	33
5f97f7f9 HS	34	/*
	35	* Initialize loops_per_jiffy as 5000000 (500MIPS).
	36	* Better make it too large than too small...
	37	*/
	38	struct avr32_cpuinfo boot_cpu_data = {
	39	.loops_per_jiffy = 5000000
	40	};
	41	EXPORT_SYMBOL(boot_cpu_data);
	42
bf4352c0	43	static char __initdata command_line[COMMAND_LINE_SIZE];
5f97f7f9 HS	44
5f97f7f9 HS	45	/*
d8011768	46	* Standard memory resources
5f97f7f9	47	*/
d8011768 HS	48	static struct resource __initdata kernel_data = {
	49	.name = "Kernel data",
	50	.start = 0,
	51	.end = 0,
	52	.flags = IORESOURCE_MEM,
	53	};
	54	static struct resource __initdata kernel_code = {
	55	.name = "Kernel code",
	56	.start = 0,
	57	.end = 0,
	58	.flags = IORESOURCE_MEM,
	59	.sibling = &kernel_data,
	60	};
5f97f7f9 HS	61
5f97f7f9 HS	62	/*
d8011768 HS	63	* Available system RAM and reserved regions as singly linked
	64	* lists. These lists are traversed using the sibling pointer in
	65	* struct resource and are kept sorted at all times.
5f97f7f9	66	*/
d8011768 HS	67	static struct resource *__initdata system_ram;
	68	static struct resource *__initdata reserved = &kernel_code;
	69
	70	/*
	71	* We need to allocate these before the bootmem allocator is up and
	72	* running, so we need this "cache". 32 entries are probably enough
	73	* for all but the most insanely complex systems.
	74	*/
	75	static struct resource __initdata res_cache[32];
	76	static unsigned int __initdata res_cache_next_free;
	77
	78	static void __init resource_init(void)
	79	{
	80	struct resource mem, res;
	81	struct resource *new;
	82
	83	kernel_code.start = __pa(init_mm.start_code);
	84
	85	for (mem = system_ram; mem; mem = mem->sibling) {
	86	new = alloc_bootmem_low(sizeof(struct resource));
	87	memcpy(new, mem, sizeof(struct resource));
	88
	89	new->sibling = NULL;
	90	if (request_resource(&iomem_resource, new))
	91	printk(KERN_WARNING "Bad RAM resource %08x-%08x\n",
	92	mem->start, mem->end);
	93	}
	94
	95	for (res = reserved; res; res = res->sibling) {
	96	new = alloc_bootmem_low(sizeof(struct resource));
	97	memcpy(new, res, sizeof(struct resource));
	98
	99	new->sibling = NULL;
	100	if (insert_resource(&iomem_resource, new))
	101	printk(KERN_WARNING
	102	"Bad reserved resource %s (%08x-%08x)\n",
	103	res->name, res->start, res->end);
	104	}
	105	}
	106
	107	static void __init
	108	add_physical_memory(resource_size_t start, resource_size_t end)
	109	{
	110	struct resource new, next, **pprev;
	111
	112	for (pprev = &system_ram, next = system_ram; next;
	113	pprev = &next->sibling, next = next->sibling) {
	114	if (end < next->start)
	115	break;
	116	if (start <= next->end) {
	117	printk(KERN_WARNING
	118	"Warning: Physical memory map is broken\n");
	119	printk(KERN_WARNING
	120	"Warning: %08x-%08x overlaps %08x-%08x\n",
	121	start, end, next->start, next->end);
	122	return;
	123	}
	124	}
	125
	126	if (res_cache_next_free >= ARRAY_SIZE(res_cache)) {
	127	printk(KERN_WARNING
	128	"Warning: Failed to add physical memory %08x-%08x\n",
	129	start, end);
	130	return;
131	}
132
133	new = &res_cache[res_cache_next_free++];
134	new->start = start;
135	new->end = end;
136	new->name = "System RAM";
137	new->flags = IORESOURCE_MEM;
138
139	*pprev = new;
140	}
141
142	static int __init
143	add_reserved_region(resource_size_t start, resource_size_t end,
144	const char *name)
145	{
146	struct resource new, next, **pprev;
5f97f7f9	147
d8011768 HS	148	if (end < start)
	149	return -EINVAL;
	150
	151	if (res_cache_next_free >= ARRAY_SIZE(res_cache))
	152	return -ENOMEM;
	153
	154	for (pprev = &reserved, next = reserved; next;
	155	pprev = &next->sibling, next = next->sibling) {
	156	if (end < next->start)
	157	break;
	158	if (start <= next->end)
	159	return -EBUSY;
	160	}
	161
	162	new = &res_cache[res_cache_next_free++];
	163	new->start = start;
	164	new->end = end;
	165	new->name = name;
a2a39525	166	new->sibling = next;
d8011768 HS	167	new->flags = IORESOURCE_MEM;
	168
	169	*pprev = new;
	170
	171	return 0;
	172	}
	173
	174	static unsigned long __init
	175	find_free_region(const struct resource *mem, resource_size_t size,
	176	resource_size_t align)
	177	{
	178	struct resource *res;
	179	unsigned long target;
	180
	181	target = ALIGN(mem->start, align);
	182	for (res = reserved; res; res = res->sibling) {
	183	if ((target + size) <= res->start)
	184	break;
	185	if (target <= res->end)
	186	target = ALIGN(res->end + 1, align);
	187	}
	188
	189	if ((target + size) > (mem->end + 1))
	190	return mem->end + 1;
	191
	192	return target;
	193	}
5f97f7f9	194
f9692b95 HS	195	static int __init
	196	alloc_reserved_region(resource_size_t *start, resource_size_t size,
	197	resource_size_t align, const char *name)
	198	{
	199	struct resource *mem;
	200	resource_size_t target;
	201	int ret;
	202
	203	for (mem = system_ram; mem; mem = mem->sibling) {
	204	target = find_free_region(mem, size, align);
	205	if (target <= mem->end) {
	206	ret = add_reserved_region(target, target + size - 1,
	207	name);
	208	if (!ret)
	209	*start = target;
	210	return ret;
	211	}
	212	}
	213
	214	return -ENOMEM;
	215	}
	216
5f97f7f9 HS	217	/*
	218	* Early framebuffer allocation. Works as follows:
	219	* - If fbmem_size is zero, nothing will be allocated or reserved.
	220	* - If fbmem_start is zero when setup_bootmem() is called,
f9692b95 HS	221	* a block of fbmem_size bytes will be reserved before bootmem
	222	* initialization. It will be aligned to the largest page size
	223	* that fbmem_size is a multiple of.
5f97f7f9	224	* - If fbmem_start is nonzero, an area of size fbmem_size will be
f9692b95 HS	225	* reserved at the physical address fbmem_start if possible. If
	226	* it collides with other reserved memory, a different block of
	227	* same size will be allocated, just as if fbmem_start was zero.
5f97f7f9 HS	228	*
	229	* Board-specific code may use these variables to set up platform data
	230	* for the framebuffer driver if fbmem_size is nonzero.
	231	*/
d80e2bb1 HS	232	resource_size_t __initdata fbmem_start;
d80e2bb1 HS	233	resource_size_t __initdata fbmem_size;
5f97f7f9 HS	234
	235	/*
	236	* "fbmem=xxx[kKmM]" allocates the specified amount of boot memory for
	237	* use as framebuffer.
	238	*
	239	* "fbmem=xxx[kKmM]@yyy[kKmM]" defines a memory region of size xxx and
	240	* starting at yyy to be reserved for use as framebuffer.
	241	*
	242	* The kernel won't verify that the memory region starting at yyy
	243	* actually contains usable RAM.
	244	*/
	245	static int __init early_parse_fbmem(char *p)
	246	{
f9692b95 HS	247	int ret;
	248	unsigned long align;
	249
5f97f7f9	250	fbmem_size = memparse(p, &p);
f9692b95	251	if (*p == '@') {
fe57f84e	252	fbmem_start = memparse(p + 1, &p);
f9692b95 HS	253	ret = add_reserved_region(fbmem_start,
	254	fbmem_start + fbmem_size - 1,
	255	"Framebuffer");
	256	if (ret) {
	257	printk(KERN_WARNING
	258	"Failed to reserve framebuffer memory\n");
	259	fbmem_start = 0;
	260	}
	261	}
	262
	263	if (!fbmem_start) {
	264	if ((fbmem_size & 0x000fffffUL) == 0)
	265	align = 0x100000; /* 1 MiB */
	266	else if ((fbmem_size & 0x0000ffffUL) == 0)
	267	align = 0x10000; /* 64 KiB */
	268	else
	269	align = 0x1000; /* 4 KiB */
	270
	271	ret = alloc_reserved_region(&fbmem_start, fbmem_size,
	272	align, "Framebuffer");
	273	if (ret) {
	274	printk(KERN_WARNING
	275	"Failed to allocate framebuffer memory\n");
	276	fbmem_size = 0;
01d3a5e7 HS	277	} else {
01d3a5e7 HS	278	memset(__va(fbmem_start), 0, fbmem_size);
f9692b95 HS	279	}
	280	}
	281
5f97f7f9 HS	282	return 0;
	283	}
	284	early_param("fbmem", early_parse_fbmem);
	285
48c1fd38 MS	286	/*
	287	* Pick out the memory size. We look for mem=size@start,
	288	* where start and size are "size[KkMmGg]"
	289	*/
	290	static int __init early_mem(char *p)
	291	{
	292	resource_size_t size, start;
	293
	294	start = system_ram->start;
	295	size = memparse(p, &p);
	296	if (*p == '@')
	297	start = memparse(p + 1, &p);
	298
	299	system_ram->start = start;
	300	system_ram->end = system_ram->start + size - 1;
	301	return 0;
	302	}
	303	early_param("mem", early_mem);
	304
5f97f7f9 HS	305	static int __init parse_tag_core(struct tag *tag)
	306	{
	307	if (tag->hdr.size > 2) {
	308	if ((tag->u.core.flags & 1) == 0)
	309	root_mountflags &= ~MS_RDONLY;
	310	ROOT_DEV = new_decode_dev(tag->u.core.rootdev);
	311	}
	312	return 0;
	313	}
	314	__tagtable(ATAG_CORE, parse_tag_core);
	315
d8011768	316	static int __init parse_tag_mem(struct tag *tag)
5f97f7f9	317	{
d8011768	318	unsigned long start, end;
5f97f7f9 HS	319
	320	/*
	321	* Ignore zero-sized entries. If we're running standalone, the
	322	* SDRAM code may emit such entries if something goes
	323	* wrong...
	324	*/
	325	if (tag->u.mem_range.size == 0)
	326	return 0;
	327
d8011768 HS	328	start = tag->u.mem_range.addr;
d8011768 HS	329	end = tag->u.mem_range.addr + tag->u.mem_range.size - 1;
5f97f7f9	330
d8011768 HS	331	add_physical_memory(start, end);
	332	return 0;
	333	}
	334	__tagtable(ATAG_MEM, parse_tag_mem);
5f97f7f9	335
d8011768 HS	336	static int __init parse_tag_rdimg(struct tag *tag)
d8011768 HS	337	{
f3e26984	338	#ifdef CONFIG_BLK_DEV_INITRD
d8011768 HS	339	struct tag_mem_range *mem = &tag->u.mem_range;
	340	int ret;
	341
	342	if (initrd_start) {
	343	printk(KERN_WARNING
	344	"Warning: Only the first initrd image will be used\n");
	345	return 0;
5f97f7f9 HS	346	}
5f97f7f9 HS	347
aa15f637	348	ret = add_reserved_region(mem->addr, mem->addr + mem->size - 1,
d8011768 HS	349	"initrd");
	350	if (ret) {
	351	printk(KERN_WARNING
	352	"Warning: Failed to reserve initrd memory\n");
	353	return ret;
	354	}
	355
	356	initrd_start = (unsigned long)__va(mem->addr);
	357	initrd_end = initrd_start + mem->size;
	358	#else
	359	printk(KERN_WARNING "RAM disk image present, but "
	360	"no initrd support in kernel, ignoring\n");
	361	#endif
5f97f7f9 HS	362
	363	return 0;
	364	}
d8011768	365	__tagtable(ATAG_RDIMG, parse_tag_rdimg);
5f97f7f9	366
d8011768	367	static int __init parse_tag_rsvd_mem(struct tag *tag)
5f97f7f9	368	{
d8011768 HS	369	struct tag_mem_range *mem = &tag->u.mem_range;
	370
	371	return add_reserved_region(mem->addr, mem->addr + mem->size - 1,
	372	"Reserved");
5f97f7f9	373	}
d8011768	374	__tagtable(ATAG_RSVD_MEM, parse_tag_rsvd_mem);
5f97f7f9 HS	375
	376	static int __init parse_tag_cmdline(struct tag *tag)
	377	{
bf4352c0	378	strlcpy(boot_command_line, tag->u.cmdline.cmdline, COMMAND_LINE_SIZE);
5f97f7f9 HS	379	return 0;
	380	}
	381	__tagtable(ATAG_CMDLINE, parse_tag_cmdline);
	382
5f97f7f9 HS	383	static int __init parse_tag_clock(struct tag *tag)
	384	{
	385	/*
	386	* We'll figure out the clocks by peeking at the system
	387	* manager regs directly.
	388	*/
	389	return 0;
	390	}
	391	__tagtable(ATAG_CLOCK, parse_tag_clock);
	392
24a1a475 AB	393	/*
	394	* The board_number correspond to the bd->bi_board_number in U-Boot. This
	395	* parameter is only available during initialisation and can be used in some
	396	* kind of board identification.
	397	*/
	398	u32 __initdata board_number;
	399
	400	static int __init parse_tag_boardinfo(struct tag *tag)
	401	{
	402	board_number = tag->u.boardinfo.board_number;
	403
	404	return 0;
	405	}
	406	__tagtable(ATAG_BOARDINFO, parse_tag_boardinfo);
	407
5f97f7f9 HS	408	/*
	409	* Scan the tag table for this tag, and call its parse function. The
	410	* tag table is built by the linker from all the __tagtable
	411	* declarations.
	412	*/
	413	static int __init parse_tag(struct tag *tag)
	414	{
	415	extern struct tagtable __tagtable_begin, __tagtable_end;
	416	struct tagtable *t;
	417
	418	for (t = &__tagtable_begin; t < &__tagtable_end; t++)
	419	if (tag->hdr.tag == t->tag) {
	420	t->parse(tag);
	421	break;
	422	}
	423
	424	return t < &__tagtable_end;
	425	}
	426
	427	/*
	428	* Parse all tags in the list we got from the boot loader
	429	*/
	430	static void __init parse_tags(struct tag *t)
	431	{
	432	for (; t->hdr.tag != ATAG_NONE; t = tag_next(t))
	433	if (!parse_tag(t))
	434	printk(KERN_WARNING
	435	"Ignoring unrecognised tag 0x%08x\n",
	436	t->hdr.tag);
	437	}
	438
5539f59a HS	439	/*
	440	* Find a free memory region large enough for storing the
	441	* bootmem bitmap.
	442	*/
	443	static unsigned long __init
d8011768	444	find_bootmap_pfn(const struct resource *mem)
5539f59a HS	445	{
5539f59a HS	446	unsigned long bootmap_pages, bootmap_len;
28f65c11	447	unsigned long node_pages = PFN_UP(resource_size(mem));
d8011768	448	unsigned long bootmap_start;
5539f59a HS	449
	450	bootmap_pages = bootmem_bootmap_pages(node_pages);
	451	bootmap_len = bootmap_pages << PAGE_SHIFT;
	452
	453	/*
	454	* Find a large enough region without reserved pages for
	455	* storing the bootmem bitmap. We can take advantage of the
	456	* fact that all lists have been sorted.
	457	*
d8011768 HS	458	* We have to check that we don't collide with any reserved
	459	* regions, which includes the kernel image and any RAMDISK
	460	* images.
5539f59a	461	*/
d8011768	462	bootmap_start = find_free_region(mem, bootmap_len, PAGE_SIZE);
5539f59a	463
d8011768	464	return bootmap_start >> PAGE_SHIFT;
5539f59a HS	465	}
5539f59a HS	466
d8011768 HS	467	#define MAX_LOWMEM HIGHMEM_START
	468	#define MAX_LOWMEM_PFN PFN_DOWN(MAX_LOWMEM)
	469
5539f59a HS	470	static void __init setup_bootmem(void)
	471	{
	472	unsigned bootmap_size;
	473	unsigned long first_pfn, bootmap_pfn, pages;
	474	unsigned long max_pfn, max_low_pfn;
5539f59a	475	unsigned node = 0;
d8011768	476	struct resource *res;
5539f59a	477
d8011768 HS	478	printk(KERN_INFO "Physical memory:\n");
	479	for (res = system_ram; res; res = res->sibling)
	480	printk(" %08x-%08x\n", res->start, res->end);
	481	printk(KERN_INFO "Reserved memory:\n");
	482	for (res = reserved; res; res = res->sibling)
	483	printk(" %08x-%08x: %s\n",
	484	res->start, res->end, res->name);
5539f59a HS	485
	486	nodes_clear(node_online_map);
	487
d8011768	488	if (system_ram->sibling)
5539f59a HS	489	printk(KERN_WARNING "Only using first memory bank\n");
5539f59a HS	490
d8011768 HS	491	for (res = system_ram; res; res = NULL) {
	492	first_pfn = PFN_UP(res->start);
	493	max_low_pfn = max_pfn = PFN_DOWN(res->end + 1);
	494	bootmap_pfn = find_bootmap_pfn(res);
5539f59a HS	495	if (bootmap_pfn > max_pfn)
	496	panic("No space for bootmem bitmap!\n");
	497
	498	if (max_low_pfn > MAX_LOWMEM_PFN) {
	499	max_low_pfn = MAX_LOWMEM_PFN;
	500	#ifndef CONFIG_HIGHMEM
	501	/*
	502	* Lowmem is memory that can be addressed
	503	* directly through P1/P2
	504	*/
	505	printk(KERN_WARNING
	506	"Node %u: Only %ld MiB of memory will be used.\n",
	507	node, MAX_LOWMEM >> 20);
	508	printk(KERN_WARNING "Use a HIGHMEM enabled kernel.\n");
	509	#else
	510	#error HIGHMEM is not supported by AVR32 yet
	511	#endif
	512	}
	513
	514	/* Initialize the boot-time allocator with low memory only. */
	515	bootmap_size = init_bootmem_node(NODE_DATA(node), bootmap_pfn,
	516	first_pfn, max_low_pfn);
	517
5539f59a HS	518	/*
	519	* Register fully available RAM pages with the bootmem
	520	* allocator.
	521	*/
	522	pages = max_low_pfn - first_pfn;
	523	free_bootmem_node (NODE_DATA(node), PFN_PHYS(first_pfn),
	524	PFN_PHYS(pages));
	525
d8011768	526	/* Reserve space for the bootmem bitmap... */
5539f59a HS	527	reserve_bootmem_node(NODE_DATA(node),
5539f59a HS	528	PFN_PHYS(bootmap_pfn),
72a7fe39 BW	529	bootmap_size,
72a7fe39 BW	530	BOOTMEM_DEFAULT);
5539f59a	531
5539f59a	532	/* ...and any other reserved regions. */
d8011768 HS	533	for (res = reserved; res; res = res->sibling) {
d8011768 HS	534	if (res->start > PFN_PHYS(max_pfn))
5539f59a HS	535	break;
5539f59a HS	536
d8011768 HS	537	/*
	538	* resource_init will complain about partial
	539	* overlaps, so we'll just ignore such
	540	* resources for now.
	541	*/
	542	if (res->start >= PFN_PHYS(first_pfn)
	543	&& res->end < PFN_PHYS(max_pfn))
28f65c11 JP	544	reserve_bootmem_node(NODE_DATA(node),
	545	res->start,
	546	resource_size(res),
	547	BOOTMEM_DEFAULT);
5539f59a HS	548	}
	549
	550	node_set_online(node);
	551	}
	552	}
	553
5f97f7f9 HS	554	void __init setup_arch (char **cmdline_p)
	555	{
	556	struct clk *cpu_clk;
	557
d8011768 HS	558	init_mm.start_code = (unsigned long)_text;
	559	init_mm.end_code = (unsigned long)_etext;
	560	init_mm.end_data = (unsigned long)_edata;
	561	init_mm.brk = (unsigned long)_end;
	562
	563	/*
	564	* Include .init section to make allocations easier. It will
	565	* be removed before the resource is actually requested.
	566	*/
	567	kernel_code.start = __pa(__init_begin);
	568	kernel_code.end = __pa(init_mm.end_code - 1);
	569	kernel_data.start = __pa(init_mm.end_code);
	570	kernel_data.end = __pa(init_mm.brk - 1);
	571
5f97f7f9 HS	572	parse_tags(bootloader_tags);
	573
	574	setup_processor();
	575	setup_platform();
c194588d	576	setup_board();
5f97f7f9 HS	577
	578	cpu_clk = clk_get(NULL, "cpu");
	579	if (IS_ERR(cpu_clk)) {
	580	printk(KERN_WARNING "Warning: Unable to get CPU clock\n");
	581	} else {
	582	unsigned long cpu_hz = clk_get_rate(cpu_clk);
	583
	584	/*
	585	* Well, duh, but it's probably a good idea to
	586	* increment the use count.
	587	*/
	588	clk_enable(cpu_clk);
	589
	590	boot_cpu_data.clk = cpu_clk;
	591	boot_cpu_data.loops_per_jiffy = cpu_hz * 4;
	592	printk("CPU: Running at %lu.%03lu MHz\n",
	593	((cpu_hz + 500) / 1000) / 1000,
	594	((cpu_hz + 500) / 1000) % 1000);
	595	}
	596
bf4352c0	597	strlcpy(command_line, boot_command_line, COMMAND_LINE_SIZE);
5f97f7f9 HS	598	*cmdline_p = command_line;
	599	parse_early_param();
	600
	601	setup_bootmem();
	602
5f97f7f9 HS	603	#ifdef CONFIG_VT
	604	conswitchp = &dummy_con;
	605	#endif
	606
	607	paging_init();
5f97f7f9 HS	608	resource_init();
5f97f7f9 HS	609	}