[deliverable/linux.git] / arch / mips / ralink / of.c

/*
 * 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.
 *
 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
 * Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>
 * Copyright (C) 2013 John Crispin <blogic@openwrt.org>
 */

#include <linux/io.h>
#include <linux/clk.h>
#include <linux/init.h>
#include <linux/sizes.h>
#include <linux/of_fdt.h>
#include <linux/kernel.h>
#include <linux/bootmem.h>
#include <linux/of_platform.h>
#include <linux/of_address.h>

#include <asm/reboot.h>
#include <asm/bootinfo.h>
#include <asm/addrspace.h>

#include "common.h"

__iomem void *rt_sysc_membase;
__iomem void *rt_memc_membase;

extern struct boot_param_header __dtb_start;

__iomem void *plat_of_remap_node(const char *node)
{
	struct resource res;
	struct device_node *np;

	np = of_find_compatible_node(NULL, NULL, node);
	if (!np)
		panic("Failed to find %s node", node);

	if (of_address_to_resource(np, 0, &res))
		panic("Failed to get resource for %s", node);

	if ((request_mem_region(res.start,
				resource_size(&res),
				res.name) < 0))
		panic("Failed to request resources for %s", node);

	return ioremap_nocache(res.start, resource_size(&res));
}

void __init device_tree_init(void)
{
	unsigned long base, size;
	void *fdt_copy;

	if (!initial_boot_params)
		return;

	base = virt_to_phys((void *)initial_boot_params);
	size = be32_to_cpu(initial_boot_params->totalsize);

	/* Before we do anything, lets reserve the dt blob */
	reserve_bootmem(base, size, BOOTMEM_DEFAULT);

	/* The strings in the flattened tree are referenced directly by the
	 * device tree, so copy the flattened device tree from init memory
	 * to regular memory.
	 */
	fdt_copy = alloc_bootmem(size);
	memcpy(fdt_copy, initial_boot_params, size);
	initial_boot_params = fdt_copy;

	unflatten_device_tree();

	/* free the space reserved for the dt blob */
	free_bootmem(base, size);
}

void __init plat_mem_setup(void)
{
	set_io_port_base(KSEG1);

	/*
	 * Load the builtin devicetree. This causes the chosen node to be
	 * parsed resulting in our memory appearing
	 */
	__dt_setup_arch(&__dtb_start);

	if (soc_info.mem_size)
		add_memory_region(soc_info.mem_base, soc_info.mem_size * SZ_1M,
				  BOOT_MEM_RAM);
	else
		detect_memory_region(soc_info.mem_base,
				     soc_info.mem_size_min * SZ_1M,
				     soc_info.mem_size_max * SZ_1M);
}

static int __init plat_of_setup(void)
{
	static struct of_device_id of_ids[3];
	int len = sizeof(of_ids[0].compatible);

	if (!of_have_populated_dt())
		panic("device tree not present");

	strlcpy(of_ids[0].compatible, soc_info.compatible, len);
	strncpy(of_ids[1].compatible, "palmbus", len);

	if (of_platform_populate(NULL, of_ids, NULL, NULL))
		panic("failed to populate DT");

	/* make sure ithat the reset controller is setup early */
	ralink_rst_init();

	return 0;
}

arch_initcall(plat_of_setup);
Commit	Line	Data
3a5bfe7b JC	1	/*
	2	* This program is free software; you can redistribute it and/or modify it
	3	* under the terms of the GNU General Public License version 2 as published
	4	* by the Free Software Foundation.
	5	*
	6	* Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
	7	* Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>
	8	* Copyright (C) 2013 John Crispin <blogic@openwrt.org>
	9	*/
	10
	11	#include <linux/io.h>
	12	#include <linux/clk.h>
	13	#include <linux/init.h>
dd63b008	14	#include <linux/sizes.h>
3a5bfe7b JC	15	#include <linux/of_fdt.h>
	16	#include <linux/kernel.h>
	17	#include <linux/bootmem.h>
	18	#include <linux/of_platform.h>
	19	#include <linux/of_address.h>
	20
	21	#include <asm/reboot.h>
	22	#include <asm/bootinfo.h>
	23	#include <asm/addrspace.h>
	24
	25	#include "common.h"
	26
	27	__iomem void *rt_sysc_membase;
	28	__iomem void *rt_memc_membase;
	29
	30	extern struct boot_param_header __dtb_start;
	31
	32	__iomem void plat_of_remap_node(const char node)
	33	{
	34	struct resource res;
	35	struct device_node *np;
	36
	37	np = of_find_compatible_node(NULL, NULL, node);
	38	if (!np)
	39	panic("Failed to find %s node", node);
	40
	41	if (of_address_to_resource(np, 0, &res))
	42	panic("Failed to get resource for %s", node);
	43
	44	if ((request_mem_region(res.start,
	45	resource_size(&res),
	46	res.name) < 0))
	47	panic("Failed to request resources for %s", node);
	48
	49	return ioremap_nocache(res.start, resource_size(&res));
	50	}
	51
	52	void __init device_tree_init(void)
	53	{
	54	unsigned long base, size;
	55	void *fdt_copy;
	56
	57	if (!initial_boot_params)
	58	return;
	59
	60	base = virt_to_phys((void *)initial_boot_params);
	61	size = be32_to_cpu(initial_boot_params->totalsize);
	62
	63	/* Before we do anything, lets reserve the dt blob */
	64	reserve_bootmem(base, size, BOOTMEM_DEFAULT);
	65
	66	/* The strings in the flattened tree are referenced directly by the
	67	* device tree, so copy the flattened device tree from init memory
	68	* to regular memory.
	69	*/
	70	fdt_copy = alloc_bootmem(size);
	71	memcpy(fdt_copy, initial_boot_params, size);
	72	initial_boot_params = fdt_copy;
	73
	74	unflatten_device_tree();
	75
	76	/* free the space reserved for the dt blob */
	77	free_bootmem(base, size);
	78	}
79
80	void __init plat_mem_setup(void)
81	{
82	set_io_port_base(KSEG1);
83
84	/*
85	* Load the builtin devicetree. This causes the chosen node to be
86	* parsed resulting in our memory appearing
87	*/
88	__dt_setup_arch(&__dtb_start);
dd63b008 JC	89
dd63b008 JC	90	if (soc_info.mem_size)
cdfce539	91	add_memory_region(soc_info.mem_base, soc_info.mem_size * SZ_1M,
dd63b008 JC	92	BOOT_MEM_RAM);
	93	else
	94	detect_memory_region(soc_info.mem_base,
	95	soc_info.mem_size_min * SZ_1M,
	96	soc_info.mem_size_max * SZ_1M);
3a5bfe7b JC	97	}
	98
	99	static int __init plat_of_setup(void)
	100	{
	101	static struct of_device_id of_ids[3];
	102	int len = sizeof(of_ids[0].compatible);
	103
	104	if (!of_have_populated_dt())
	105	panic("device tree not present");
	106
24b1944f	107	strlcpy(of_ids[0].compatible, soc_info.compatible, len);
3a5bfe7b JC	108	strncpy(of_ids[1].compatible, "palmbus", len);
	109
	110	if (of_platform_populate(NULL, of_ids, NULL, NULL))
f7777dcc	111	panic("failed to populate DT");
3a5bfe7b	112
2a153f1c JC	113	/* make sure ithat the reset controller is setup early */
	114	ralink_rst_init();
	115
3a5bfe7b JC	116	return 0;
	117	}
	118
	119	arch_initcall(plat_of_setup);