[deliverable/linux.git] / arch / arm / kernel / devtree.c

/*
 *  linux/arch/arm/kernel/devtree.c
 *
 *  Copyright (C) 2009 Canonical Ltd. <jeremy.kerr@canonical.com>
 *
 * 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/init.h>
#include <linux/export.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/bootmem.h>
#include <linux/memblock.h>
#include <linux/of.h>
#include <linux/of_fdt.h>
#include <linux/of_irq.h>
#include <linux/of_platform.h>

#include <asm/cputype.h>
#include <asm/setup.h>
#include <asm/page.h>
#include <asm/smp_plat.h>
#include <asm/mach/arch.h>
#include <asm/mach-types.h>

void __init early_init_dt_add_memory_arch(u64 base, u64 size)
{
	arm_add_memory(base, size);
}

void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
{
	return alloc_bootmem_align(size, align);
}

void __init arm_dt_memblock_reserve(void)
{
	u64 *reserve_map, base, size;

	if (!initial_boot_params)
		return;

	/* Reserve the dtb region */
	memblock_reserve(virt_to_phys(initial_boot_params),
			 be32_to_cpu(initial_boot_params->totalsize));

	/*
	 * Process the reserve map.  This will probably overlap the initrd
	 * and dtb locations which are already reserved, but overlaping
	 * doesn't hurt anything
	 */
	reserve_map = ((void*)initial_boot_params) +
			be32_to_cpu(initial_boot_params->off_mem_rsvmap);
	while (1) {
		base = be64_to_cpup(reserve_map++);
		size = be64_to_cpup(reserve_map++);
		if (!size)
			break;
		memblock_reserve(base, size);
	}
}

/*
 * arm_dt_init_cpu_maps - Function retrieves cpu nodes from the device tree
 * and builds the cpu logical map array containing MPIDR values related to
 * logical cpus
 *
 * Updates the cpu possible mask with the number of parsed cpu nodes
 */
void __init arm_dt_init_cpu_maps(void)
{
	/*
	 * Temp logical map is initialized with UINT_MAX values that are
	 * considered invalid logical map entries since the logical map must
	 * contain a list of MPIDR[23:0] values where MPIDR[31:24] must
	 * read as 0.
	 */
	struct device_node *cpu, *cpus;
	u32 i, j, cpuidx = 1;
	u32 mpidr = is_smp() ? read_cpuid_mpidr() & MPIDR_HWID_BITMASK : 0;

	u32 tmp_map[NR_CPUS] = { [0 ... NR_CPUS-1] = UINT_MAX };
	bool bootcpu_valid = false;
	cpus = of_find_node_by_path("/cpus");

	if (!cpus)
		return;

	for_each_child_of_node(cpus, cpu) {
		u32 hwid;

		pr_debug(" * %s...\n", cpu->full_name);
		/*
		 * A device tree containing CPU nodes with missing "reg"
		 * properties is considered invalid to build the
		 * cpu_logical_map.
		 */
		if (of_property_read_u32(cpu, "reg", &hwid)) {
			pr_debug(" * %s missing reg property\n",
				     cpu->full_name);
			return;
		}

		/*
		 * 8 MSBs must be set to 0 in the DT since the reg property
		 * defines the MPIDR[23:0].
		 */
		if (hwid & ~MPIDR_HWID_BITMASK)
			return;

		/*
		 * Duplicate MPIDRs are a recipe for disaster.
		 * Scan all initialized entries and check for
		 * duplicates. If any is found just bail out.
		 * temp values were initialized to UINT_MAX
		 * to avoid matching valid MPIDR[23:0] values.
		 */
		for (j = 0; j < cpuidx; j++)
			if (WARN(tmp_map[j] == hwid, "Duplicate /cpu reg "
						     "properties in the DT\n"))
				return;

		/*
		 * Build a stashed array of MPIDR values. Numbering scheme
		 * requires that if detected the boot CPU must be assigned
		 * logical id 0. Other CPUs get sequential indexes starting
		 * from 1. If a CPU node with a reg property matching the
		 * boot CPU MPIDR is detected, this is recorded so that the
		 * logical map built from DT is validated and can be used
		 * to override the map created in smp_setup_processor_id().
		 */
		if (hwid == mpidr) {
			i = 0;
			bootcpu_valid = true;
		} else {
			i = cpuidx++;
		}

		tmp_map[i] = hwid;

		if (cpuidx > nr_cpu_ids)
			break;
	}

	if (WARN(!bootcpu_valid, "DT missing boot CPU MPIDR[23:0], "
				 "fall back to default cpu_logical_map\n"))
		return;

	/*
	 * Since the boot CPU node contains proper data, and all nodes have
	 * a reg property, the DT CPU list can be considered valid and the
	 * logical map created in smp_setup_processor_id() can be overridden
	 */
	for (i = 0; i < cpuidx; i++) {
		set_cpu_possible(i, true);
		cpu_logical_map(i) = tmp_map[i];
		pr_debug("cpu logical map 0x%x\n", cpu_logical_map(i));
	}
}

/**
 * setup_machine_fdt - Machine setup when an dtb was passed to the kernel
 * @dt_phys: physical address of dt blob
 *
 * If a dtb was passed to the kernel in r2, then use it to choose the
 * correct machine_desc and to setup the system.
 */
struct machine_desc * __init setup_machine_fdt(unsigned int dt_phys)
{
	struct boot_param_header *devtree;
	struct machine_desc *mdesc, *mdesc_best = NULL;
	unsigned int score, mdesc_score = ~1;
	unsigned long dt_root;
	const char *model;

	if (!dt_phys)
		return NULL;

	devtree = phys_to_virt(dt_phys);

	/* check device tree validity */
	if (be32_to_cpu(devtree->magic) != OF_DT_HEADER)
		return NULL;

	/* Search the mdescs for the 'best' compatible value match */
	initial_boot_params = devtree;
	dt_root = of_get_flat_dt_root();
	for_each_machine_desc(mdesc) {
		score = of_flat_dt_match(dt_root, mdesc->dt_compat);
		if (score > 0 && score < mdesc_score) {
			mdesc_best = mdesc;
			mdesc_score = score;
		}
	}
	if (!mdesc_best) {
		const char *prop;
		long size;

		early_print("\nError: unrecognized/unsupported "
			    "device tree compatible list:\n[ ");

		prop = of_get_flat_dt_prop(dt_root, "compatible", &size);
		while (size > 0) {
			early_print("'%s' ", prop);
			size -= strlen(prop) + 1;
			prop += strlen(prop) + 1;
		}
		early_print("]\n\n");

		dump_machine_table(); /* does not return */
	}

	model = of_get_flat_dt_prop(dt_root, "model", NULL);
	if (!model)
		model = of_get_flat_dt_prop(dt_root, "compatible", NULL);
	if (!model)
		model = "<unknown>";
	pr_info("Machine: %s, model: %s\n", mdesc_best->name, model);

	/* Retrieve various information from the /chosen node */
	of_scan_flat_dt(early_init_dt_scan_chosen, boot_command_line);
	/* Initialize {size,address}-cells info */
	of_scan_flat_dt(early_init_dt_scan_root, NULL);
	/* Setup memory, calling early_init_dt_add_memory_arch */
	of_scan_flat_dt(early_init_dt_scan_memory, NULL);

	/* Change machine number to match the mdesc we're using */
	__machine_arch_type = mdesc_best->nr;

	return mdesc_best;
}
Commit	Line	Data
9eb8f674 GL	1	/*
	2	* linux/arch/arm/kernel/devtree.c
	3	*
	4	* Copyright (C) 2009 Canonical Ltd. <jeremy.kerr@canonical.com>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/init.h>
ecea4ab6	12	#include <linux/export.h>
9eb8f674 GL	13	#include <linux/errno.h>
	14	#include <linux/types.h>
	15	#include <linux/bootmem.h>
	16	#include <linux/memblock.h>
	17	#include <linux/of.h>
	18	#include <linux/of_fdt.h>
	19	#include <linux/of_irq.h>
	20	#include <linux/of_platform.h>
	21
a0ae0240	22	#include <asm/cputype.h>
9eb8f674 GL	23	#include <asm/setup.h>
9eb8f674 GL	24	#include <asm/page.h>
a0ae0240	25	#include <asm/smp_plat.h>
93c02ab4 GL	26	#include <asm/mach/arch.h>
93c02ab4 GL	27	#include <asm/mach-types.h>
9eb8f674 GL	28
	29	void __init early_init_dt_add_memory_arch(u64 base, u64 size)
	30	{
	31	arm_add_memory(base, size);
	32	}
	33
	34	void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
	35	{
	36	return alloc_bootmem_align(size, align);
	37	}
	38
93c02ab4 GL	39	void __init arm_dt_memblock_reserve(void)
	40	{
	41	u64 *reserve_map, base, size;
	42
	43	if (!initial_boot_params)
	44	return;
	45
	46	/* Reserve the dtb region */
	47	memblock_reserve(virt_to_phys(initial_boot_params),
	48	be32_to_cpu(initial_boot_params->totalsize));
	49
	50	/*
	51	* Process the reserve map. This will probably overlap the initrd
	52	* and dtb locations which are already reserved, but overlaping
	53	* doesn't hurt anything
	54	*/
	55	reserve_map = ((void*)initial_boot_params) +
	56	be32_to_cpu(initial_boot_params->off_mem_rsvmap);
	57	while (1) {
	58	base = be64_to_cpup(reserve_map++);
	59	size = be64_to_cpup(reserve_map++);
	60	if (!size)
	61	break;
	62	memblock_reserve(base, size);
	63	}
	64	}
	65
a0ae0240 LP	66	/*
	67	* arm_dt_init_cpu_maps - Function retrieves cpu nodes from the device tree
	68	* and builds the cpu logical map array containing MPIDR values related to
	69	* logical cpus
	70	*
	71	* Updates the cpu possible mask with the number of parsed cpu nodes
	72	*/
	73	void __init arm_dt_init_cpu_maps(void)
	74	{
	75	/*
	76	* Temp logical map is initialized with UINT_MAX values that are
	77	* considered invalid logical map entries since the logical map must
	78	* contain a list of MPIDR[23:0] values where MPIDR[31:24] must
	79	* read as 0.
	80	*/
	81	struct device_node cpu, cpus;
	82	u32 i, j, cpuidx = 1;
	83	u32 mpidr = is_smp() ? read_cpuid_mpidr() & MPIDR_HWID_BITMASK : 0;
	84
	85	u32 tmp_map[NR_CPUS] = { [0 ... NR_CPUS-1] = UINT_MAX };
	86	bool bootcpu_valid = false;
	87	cpus = of_find_node_by_path("/cpus");
	88
	89	if (!cpus)
	90	return;
	91
	92	for_each_child_of_node(cpus, cpu) {
	93	u32 hwid;
	94
	95	pr_debug(" * %s...\n", cpu->full_name);
	96	/*
	97	* A device tree containing CPU nodes with missing "reg"
	98	* properties is considered invalid to build the
	99	* cpu_logical_map.
	100	*/
	101	if (of_property_read_u32(cpu, "reg", &hwid)) {
	102	pr_debug(" * %s missing reg property\n",
	103	cpu->full_name);
	104	return;
	105	}
	106
	107	/*
	108	* 8 MSBs must be set to 0 in the DT since the reg property
	109	* defines the MPIDR[23:0].
	110	*/
	111	if (hwid & ~MPIDR_HWID_BITMASK)
	112	return;
	113
	114	/*
	115	* Duplicate MPIDRs are a recipe for disaster.
	116	* Scan all initialized entries and check for
	117	* duplicates. If any is found just bail out.
	118	* temp values were initialized to UINT_MAX
	119	* to avoid matching valid MPIDR[23:0] values.
	120	*/
	121	for (j = 0; j < cpuidx; j++)
	122	if (WARN(tmp_map[j] == hwid, "Duplicate /cpu reg "
	123	"properties in the DT\n"))
	124	return;
	125
	126	/*
	127	* Build a stashed array of MPIDR values. Numbering scheme
	128	* requires that if detected the boot CPU must be assigned
	129	* logical id 0. Other CPUs get sequential indexes starting
130	* from 1. If a CPU node with a reg property matching the
131	* boot CPU MPIDR is detected, this is recorded so that the
132	* logical map built from DT is validated and can be used
133	* to override the map created in smp_setup_processor_id().
134	*/
135	if (hwid == mpidr) {
136	i = 0;
137	bootcpu_valid = true;
138	} else {
139	i = cpuidx++;
140	}
141
142	tmp_map[i] = hwid;
143
144	if (cpuidx > nr_cpu_ids)
145	break;
146	}
147
148	if (WARN(!bootcpu_valid, "DT missing boot CPU MPIDR[23:0], "
149	"fall back to default cpu_logical_map\n"))
150	return;
151
152	/*
153	* Since the boot CPU node contains proper data, and all nodes have
154	* a reg property, the DT CPU list can be considered valid and the
155	* logical map created in smp_setup_processor_id() can be overridden
156	*/
157	for (i = 0; i < cpuidx; i++) {
158	set_cpu_possible(i, true);
159	cpu_logical_map(i) = tmp_map[i];
160	pr_debug("cpu logical map 0x%x\n", cpu_logical_map(i));
161	}
162	}
163
93c02ab4 GL	164	/**
	165	* setup_machine_fdt - Machine setup when an dtb was passed to the kernel
	166	* @dt_phys: physical address of dt blob
	167	*
	168	* If a dtb was passed to the kernel in r2, then use it to choose the
	169	* correct machine_desc and to setup the system.
	170	*/
	171	struct machine_desc * __init setup_machine_fdt(unsigned int dt_phys)
	172	{
	173	struct boot_param_header *devtree;
	174	struct machine_desc mdesc, mdesc_best = NULL;
	175	unsigned int score, mdesc_score = ~1;
	176	unsigned long dt_root;
	177	const char *model;
	178
f506cd48 NP	179	if (!dt_phys)
	180	return NULL;
	181
93c02ab4 GL	182	devtree = phys_to_virt(dt_phys);
	183
	184	/* check device tree validity */
	185	if (be32_to_cpu(devtree->magic) != OF_DT_HEADER)
	186	return NULL;
	187
	188	/* Search the mdescs for the 'best' compatible value match */
	189	initial_boot_params = devtree;
	190	dt_root = of_get_flat_dt_root();
	191	for_each_machine_desc(mdesc) {
	192	score = of_flat_dt_match(dt_root, mdesc->dt_compat);
	193	if (score > 0 && score < mdesc_score) {
	194	mdesc_best = mdesc;
	195	mdesc_score = score;
	196	}
	197	}
	198	if (!mdesc_best) {
	199	const char *prop;
	200	long size;
	201
	202	early_print("\nError: unrecognized/unsupported "
	203	"device tree compatible list:\n[ ");
	204
	205	prop = of_get_flat_dt_prop(dt_root, "compatible", &size);
	206	while (size > 0) {
	207	early_print("'%s' ", prop);
	208	size -= strlen(prop) + 1;
	209	prop += strlen(prop) + 1;
	210	}
	211	early_print("]\n\n");
	212
	213	dump_machine_table(); /* does not return */
	214	}
	215
	216	model = of_get_flat_dt_prop(dt_root, "model", NULL);
	217	if (!model)
	218	model = of_get_flat_dt_prop(dt_root, "compatible", NULL);
	219	if (!model)
	220	model = "<unknown>";
	221	pr_info("Machine: %s, model: %s\n", mdesc_best->name, model);
	222
	223	/* Retrieve various information from the /chosen node */
	224	of_scan_flat_dt(early_init_dt_scan_chosen, boot_command_line);
	225	/* Initialize {size,address}-cells info */
	226	of_scan_flat_dt(early_init_dt_scan_root, NULL);
	227	/* Setup memory, calling early_init_dt_add_memory_arch */
	228	of_scan_flat_dt(early_init_dt_scan_memory, NULL);
	229
	230	/* Change machine number to match the mdesc we're using */
	231	__machine_arch_type = mdesc_best->nr;
	232
	233	return mdesc_best;
	234	}