[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arc / kernel / devtree.c

/*
 * Copyright (C) 2012 Synopsys, Inc. (www.synopsys.com)
 *
 * Based on reduced version of METAG
 *
 * 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/reboot.h>
#include <linux/memblock.h>
#include <linux/of.h>
#include <linux/of_fdt.h>
#include <asm/prom.h>
#include <asm/clk.h>
#include <asm/mach_desc.h>

/**
 * setup_machine_fdt - Machine setup when an dtb was passed to the kernel
 * @dt:		virtual address pointer to dt blob
 *
 * If a dtb was passed to the kernel, then use it to choose the correct
 * machine_desc and to setup the system.
 */
struct machine_desc * __init setup_machine_fdt(void *dt)
{
	struct boot_param_header *devtree = dt;
	struct machine_desc *mdesc = NULL, *mdesc_best = NULL;
	unsigned int score, mdesc_score = ~1;
	unsigned long dt_root;
	const char *model, *compat;
	void *clk;
	char manufacturer[16];
	unsigned long len;

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

	initial_boot_params = devtree;
	dt_root = of_get_flat_dt_root();

	/*
	 * The kernel could be multi-platform enabled, thus could have many
	 * "baked-in" machine descriptors. Search thru all for the best
	 * "compatible" string match.
	 */
	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;

		pr_err("\n unrecognized device tree list:\n[ ");

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

		machine_halt();
	}

	/* compat = "<manufacturer>,<model>" */
	compat =  mdesc_best->dt_compat[0];

	model = strchr(compat, ',');
	if (model)
		model++;

	strlcpy(manufacturer, compat, model ? model - compat : strlen(compat));

	pr_info("Board \"%s\" from %s (Manufacturer)\n", model, manufacturer);

	/* 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);

	clk = of_get_flat_dt_prop(dt_root, "clock-frequency", &len);
	if (clk)
		arc_set_core_freq(of_read_ulong(clk, len/4));

	return mdesc_best;
}

/*
 * Copy the flattened DT out of .init since unflattening doesn't copy strings
 * and the normal DT APIs refs them from orig flat DT
 */
void __init copy_devtree(void)
{
	void *alloc = early_init_dt_alloc_memory_arch(
			be32_to_cpu(initial_boot_params->totalsize), 64);
	if (alloc) {
		memcpy(alloc, initial_boot_params,
				be32_to_cpu(initial_boot_params->totalsize));
		initial_boot_params = alloc;
	}
}
Commit	Line	Data
999159a5 VG	1	/*
	2	* Copyright (C) 2012 Synopsys, Inc. (www.synopsys.com)
	3	*
	4	* Based on reduced version of METAG
	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
	12	#include <linux/init.h>
	13	#include <linux/reboot.h>
	14	#include <linux/memblock.h>
	15	#include <linux/of.h>
	16	#include <linux/of_fdt.h>
	17	#include <asm/prom.h>
450dd430	18	#include <asm/clk.h>
03a6d28c	19	#include <asm/mach_desc.h>
999159a5	20
999159a5 VG	21	/**
	22	* setup_machine_fdt - Machine setup when an dtb was passed to the kernel
	23	* @dt: virtual address pointer to dt blob
	24	*
	25	* If a dtb was passed to the kernel, then use it to choose the correct
	26	* machine_desc and to setup the system.
	27	*/
03a6d28c	28	struct machine_desc * __init setup_machine_fdt(void *dt)
999159a5 VG	29	{
999159a5 VG	30	struct boot_param_header *devtree = dt;
03a6d28c VG	31	struct machine_desc mdesc = NULL, mdesc_best = NULL;
03a6d28c VG	32	unsigned int score, mdesc_score = ~1;
999159a5	33	unsigned long dt_root;
03a6d28c	34	const char model, compat;
450dd430	35	void *clk;
999159a5	36	char manufacturer[16];
450dd430	37	unsigned long len;
999159a5 VG	38
	39	/* check device tree validity */
	40	if (be32_to_cpu(devtree->magic) != OF_DT_HEADER)
03a6d28c	41	return NULL;
999159a5	42
999159a5 VG	43	initial_boot_params = devtree;
	44	dt_root = of_get_flat_dt_root();
	45
03a6d28c VG	46	/*
	47	* The kernel could be multi-platform enabled, thus could have many
	48	* "baked-in" machine descriptors. Search thru all for the best
	49	* "compatible" string match.
	50	*/
	51	for_each_machine_desc(mdesc) {
	52	score = of_flat_dt_match(dt_root, mdesc->dt_compat);
	53	if (score > 0 && score < mdesc_score) {
	54	mdesc_best = mdesc;
	55	mdesc_score = score;
	56	}
	57	}
	58	if (!mdesc_best) {
	59	const char *prop;
	60	long size;
	61
	62	pr_err("\n unrecognized device tree list:\n[ ");
	63
	64	prop = of_get_flat_dt_prop(dt_root, "compatible", &size);
	65	if (prop) {
	66	while (size > 0) {
	67	printk("'%s' ", prop);
	68	size -= strlen(prop) + 1;
	69	prop += strlen(prop) + 1;
	70	}
	71	}
	72	printk("]\n\n");
	73
	74	machine_halt();
	75	}
	76
999159a5	77	/* compat = "<manufacturer>,<model>" */
03a6d28c	78	compat = mdesc_best->dt_compat[0];
999159a5 VG	79
	80	model = strchr(compat, ',');
	81	if (model)
	82	model++;
	83
	84	strlcpy(manufacturer, compat, model ? model - compat : strlen(compat));
	85
	86	pr_info("Board \"%s\" from %s (Manufacturer)\n", model, manufacturer);
	87
	88	/* Retrieve various information from the /chosen node */
	89	of_scan_flat_dt(early_init_dt_scan_chosen, boot_command_line);
	90
450dd430 VG	91	/* Initialize {size,address}-cells info */
	92	of_scan_flat_dt(early_init_dt_scan_root, NULL);
	93
	94	/* Setup memory, calling early_init_dt_add_memory_arch */
	95	of_scan_flat_dt(early_init_dt_scan_memory, NULL);
	96
	97	clk = of_get_flat_dt_prop(dt_root, "clock-frequency", &len);
	98	if (clk)
	99	arc_set_core_freq(of_read_ulong(clk, len/4));
	100
03a6d28c	101	return mdesc_best;
999159a5	102	}
eab6a08c VG	103
	104	/*
	105	* Copy the flattened DT out of .init since unflattening doesn't copy strings
	106	* and the normal DT APIs refs them from orig flat DT
	107	*/
	108	void __init copy_devtree(void)
	109	{
	110	void *alloc = early_init_dt_alloc_memory_arch(
	111	be32_to_cpu(initial_boot_params->totalsize), 64);
	112	if (alloc) {
	113	memcpy(alloc, initial_boot_params,
	114	be32_to_cpu(initial_boot_params->totalsize));
	115	initial_boot_params = alloc;
	116	}
	117	}