148 lines
		
	
	
		
			3.9 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			148 lines
		
	
	
		
			3.9 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * Copyright (c) 2011 The Chromium OS Authors.
 | 
						|
 * See file CREDITS for list of people who contributed to this
 | 
						|
 * project.
 | 
						|
 *
 | 
						|
 * This program is free software; you can redistribute it and/or
 | 
						|
 * modify it under the terms of the GNU General Public License as
 | 
						|
 * published by the Free Software Foundation; either version 2 of
 | 
						|
 * the License, or (at your option) any later version.
 | 
						|
 *
 | 
						|
 * This program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * You should have received a copy of the GNU General Public License
 | 
						|
 * along with this program; if not, write to the Free Software
 | 
						|
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 | 
						|
 * MA 02111-1307 USA
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <serial.h>
 | 
						|
#include <libfdt.h>
 | 
						|
#include <fdtdec.h>
 | 
						|
 | 
						|
DECLARE_GLOBAL_DATA_PTR;
 | 
						|
 | 
						|
/*
 | 
						|
 * Here are the type we know about. One day we might allow drivers to
 | 
						|
 * register. For now we just put them here. The COMPAT macro allows us to
 | 
						|
 * turn this into a sparse list later, and keeps the ID with the name.
 | 
						|
 */
 | 
						|
#define COMPAT(id, name) name
 | 
						|
static const char * const compat_names[COMPAT_COUNT] = {
 | 
						|
};
 | 
						|
 | 
						|
/**
 | 
						|
 * Look in the FDT for an alias with the given name and return its node.
 | 
						|
 *
 | 
						|
 * @param blob	FDT blob
 | 
						|
 * @param name	alias name to look up
 | 
						|
 * @return node offset if found, or an error code < 0 otherwise
 | 
						|
 */
 | 
						|
static int find_alias_node(const void *blob, const char *name)
 | 
						|
{
 | 
						|
	const char *path;
 | 
						|
	int alias_node;
 | 
						|
 | 
						|
	debug("find_alias_node: %s\n", name);
 | 
						|
	alias_node = fdt_path_offset(blob, "/aliases");
 | 
						|
	if (alias_node < 0)
 | 
						|
		return alias_node;
 | 
						|
	path = fdt_getprop(blob, alias_node, name, NULL);
 | 
						|
	if (!path)
 | 
						|
		return -FDT_ERR_NOTFOUND;
 | 
						|
	return fdt_path_offset(blob, path);
 | 
						|
}
 | 
						|
 | 
						|
fdt_addr_t fdtdec_get_addr(const void *blob, int node,
 | 
						|
		const char *prop_name)
 | 
						|
{
 | 
						|
	const fdt_addr_t *cell;
 | 
						|
	int len;
 | 
						|
 | 
						|
	debug("get_addr: %s\n", prop_name);
 | 
						|
	cell = fdt_getprop(blob, node, prop_name, &len);
 | 
						|
	if (cell && (len == sizeof(fdt_addr_t) ||
 | 
						|
			len == sizeof(fdt_addr_t) * 2))
 | 
						|
		return fdt_addr_to_cpu(*cell);
 | 
						|
	return FDT_ADDR_T_NONE;
 | 
						|
}
 | 
						|
 | 
						|
s32 fdtdec_get_int(const void *blob, int node, const char *prop_name,
 | 
						|
		s32 default_val)
 | 
						|
{
 | 
						|
	const s32 *cell;
 | 
						|
	int len;
 | 
						|
 | 
						|
	debug("get_size: %s\n", prop_name);
 | 
						|
	cell = fdt_getprop(blob, node, prop_name, &len);
 | 
						|
	if (cell && len >= sizeof(s32))
 | 
						|
		return fdt32_to_cpu(cell[0]);
 | 
						|
	return default_val;
 | 
						|
}
 | 
						|
 | 
						|
int fdtdec_get_is_enabled(const void *blob, int node, int default_val)
 | 
						|
{
 | 
						|
	const char *cell;
 | 
						|
 | 
						|
	cell = fdt_getprop(blob, node, "status", NULL);
 | 
						|
	if (cell)
 | 
						|
		return 0 == strcmp(cell, "ok");
 | 
						|
	return default_val;
 | 
						|
}
 | 
						|
 | 
						|
enum fdt_compat_id fd_dec_lookup(const void *blob, int node)
 | 
						|
{
 | 
						|
	enum fdt_compat_id id;
 | 
						|
 | 
						|
	/* Search our drivers */
 | 
						|
	for (id = COMPAT_UNKNOWN; id < COMPAT_COUNT; id++)
 | 
						|
		if (0 == fdt_node_check_compatible(blob, node,
 | 
						|
				compat_names[id]))
 | 
						|
			return id;
 | 
						|
	return COMPAT_UNKNOWN;
 | 
						|
}
 | 
						|
 | 
						|
int fdtdec_next_compatible(const void *blob, int node,
 | 
						|
		enum fdt_compat_id id)
 | 
						|
{
 | 
						|
	return fdt_node_offset_by_compatible(blob, node, compat_names[id]);
 | 
						|
}
 | 
						|
 | 
						|
int fdtdec_next_alias(const void *blob, const char *name,
 | 
						|
		enum fdt_compat_id id, int *upto)
 | 
						|
{
 | 
						|
#define MAX_STR_LEN 20
 | 
						|
	char str[MAX_STR_LEN + 20];
 | 
						|
	int node, err;
 | 
						|
 | 
						|
	/* snprintf() is not available */
 | 
						|
	assert(strlen(name) < MAX_STR_LEN);
 | 
						|
	sprintf(str, "%.*s%d", MAX_STR_LEN, name, *upto);
 | 
						|
	(*upto)++;
 | 
						|
	node = find_alias_node(blob, str);
 | 
						|
	if (node < 0)
 | 
						|
		return node;
 | 
						|
	err = fdt_node_check_compatible(blob, node, compat_names[id]);
 | 
						|
	if (err < 0)
 | 
						|
		return err;
 | 
						|
	return err ? -FDT_ERR_NOTFOUND : node;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * This function is a little odd in that it accesses global data. At some
 | 
						|
 * point if the architecture board.c files merge this will make more sense.
 | 
						|
 * Even now, it is common code.
 | 
						|
 */
 | 
						|
int fdtdec_check_fdt(void)
 | 
						|
{
 | 
						|
	/* We must have an fdt */
 | 
						|
	if (fdt_check_header(gd->fdt_blob))
 | 
						|
		panic("No valid fdt found - please append one to U-Boot\n"
 | 
						|
			"binary or define CONFIG_OF_EMBED\n");
 | 
						|
	return 0;
 | 
						|
}
 |