mirror of
https://github.com/u-boot/u-boot.git
synced 2025-04-24 06:24:17 +00:00
Moved fdt command support code to fdt_support.c
...in preparation for improving the bootm command's handling of fdt blobs. Also cleaned up some coding sloppiness.
This commit is contained in:
parent
6679f92995
commit
64dbbd40c5
7 changed files with 412 additions and 275 deletions
|
@ -664,19 +664,28 @@ U_BOOT_CMD(ecc, 4, 0, do_ecc,
|
||||||
|
|
||||||
#if (defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)) \
|
#if (defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)) \
|
||||||
&& defined(CONFIG_OF_BOARD_SETUP)
|
&& defined(CONFIG_OF_BOARD_SETUP)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Prototypes of functions that we use.
|
||||||
|
*/
|
||||||
|
void ft_cpu_setup(void *blob, bd_t *bd);
|
||||||
|
|
||||||
|
#ifdef CONFIG_PCI
|
||||||
|
void ft_pci_setup(void *blob, bd_t *bd);
|
||||||
|
#endif
|
||||||
|
|
||||||
void
|
void
|
||||||
ft_board_setup(void *blob, bd_t *bd)
|
ft_board_setup(void *blob, bd_t *bd)
|
||||||
{
|
{
|
||||||
#if defined(CONFIG_OF_LIBFDT)
|
#if defined(CONFIG_OF_LIBFDT)
|
||||||
int nodeoffset;
|
int nodeoffset;
|
||||||
int err;
|
|
||||||
int tmp[2];
|
int tmp[2];
|
||||||
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/memory");
|
nodeoffset = fdt_path_offset (fdt, "/memory");
|
||||||
if (nodeoffset >= 0) {
|
if (nodeoffset >= 0) {
|
||||||
tmp[0] = cpu_to_be32(bd->bi_memstart);
|
tmp[0] = cpu_to_be32(bd->bi_memstart);
|
||||||
tmp[1] = cpu_to_be32(bd->bi_memsize);
|
tmp[1] = cpu_to_be32(bd->bi_memsize);
|
||||||
err = fdt_setprop(fdt, nodeoffset, "reg", tmp, sizeof(tmp));
|
fdt_setprop(fdt, nodeoffset, "reg", tmp, sizeof(tmp));
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
u32 *p;
|
u32 *p;
|
||||||
|
@ -694,4 +703,5 @@ ft_board_setup(void *blob, bd_t *bd)
|
||||||
#endif
|
#endif
|
||||||
ft_cpu_setup(blob, bd);
|
ft_cpu_setup(blob, bd);
|
||||||
}
|
}
|
||||||
#endif
|
#endif /* CONFIG_OF_x */
|
||||||
|
|
||||||
|
|
|
@ -45,7 +45,7 @@ COBJS = main.o ACEX1K.o altera.o bedbug.o circbuf.o cmd_autoscript.o \
|
||||||
env_nand.o env_dataflash.o env_flash.o env_eeprom.o \
|
env_nand.o env_dataflash.o env_flash.o env_eeprom.o \
|
||||||
env_nvram.o env_nowhere.o \
|
env_nvram.o env_nowhere.o \
|
||||||
exports.o \
|
exports.o \
|
||||||
flash.o fpga.o ft_build.o \
|
fdt_support.o flash.o fpga.o ft_build.o \
|
||||||
hush.o kgdb.o lcd.o lists.o lynxkdi.o \
|
hush.o kgdb.o lcd.o lists.o lynxkdi.o \
|
||||||
memsize.o miiphybb.o miiphyutil.o \
|
memsize.o miiphybb.o miiphyutil.o \
|
||||||
s_record.o serial.o soft_i2c.o soft_spi.o spartan2.o spartan3.o \
|
s_record.o serial.o soft_i2c.o soft_spi.o spartan2.o spartan3.o \
|
||||||
|
|
|
@ -950,7 +950,7 @@ do_bootm_linux (cmd_tbl_t *cmdtp, int flag,
|
||||||
|
|
||||||
printf (" Loading Device Tree to %08lx, end %08lx ... ",
|
printf (" Loading Device Tree to %08lx, end %08lx ... ",
|
||||||
of_start, of_start + of_len - 1);
|
of_start, of_start + of_len - 1);
|
||||||
err = fdt_open_into(of_start, of_data, of_len);
|
err = fdt_open_into((void *)of_start, (void *)of_data, of_len);
|
||||||
if (err != 0) {
|
if (err != 0) {
|
||||||
printf ("libfdt: %s\n", fdt_strerror(err));
|
printf ("libfdt: %s\n", fdt_strerror(err));
|
||||||
}
|
}
|
||||||
|
|
301
common/cmd_fdt.c
301
common/cmd_fdt.c
|
@ -30,9 +30,11 @@
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
|
|
||||||
#ifdef CONFIG_OF_LIBFDT
|
#ifdef CONFIG_OF_LIBFDT
|
||||||
|
|
||||||
#include <asm/global_data.h>
|
#include <asm/global_data.h>
|
||||||
#include <fdt.h>
|
#include <fdt.h>
|
||||||
#include <libfdt.h>
|
#include <libfdt.h>
|
||||||
|
#include <fdt_support.h>
|
||||||
|
|
||||||
#define MAX_LEVEL 32 /* how deeply nested we will go */
|
#define MAX_LEVEL 32 /* how deeply nested we will go */
|
||||||
#define SCRATCHPAD 1024 /* bytes of scratchpad memory */
|
#define SCRATCHPAD 1024 /* bytes of scratchpad memory */
|
||||||
|
@ -53,9 +55,6 @@ static char data[SCRATCHPAD];
|
||||||
*/
|
*/
|
||||||
static int fdt_valid(void);
|
static int fdt_valid(void);
|
||||||
static void print_data(const void *data, int len);
|
static void print_data(const void *data, int len);
|
||||||
static int fdt_chosen(void *fdt, ulong initrd_start, ulong initrd_end);
|
|
||||||
static int fdt_env(void *fdt);
|
|
||||||
static int fdt_bd_t(void *fdt);
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -437,7 +436,7 @@ int do_fdt (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
|
||||||
* Create a chosen node
|
* Create a chosen node
|
||||||
********************************************************************/
|
********************************************************************/
|
||||||
} else if (op == 'c') {
|
} else if (op == 'c') {
|
||||||
fdt_chosen(fdt, 0, 0);
|
fdt_chosen(fdt, 0, 0, 1);
|
||||||
|
|
||||||
/********************************************************************
|
/********************************************************************
|
||||||
* Create a u-boot-env node
|
* Create a u-boot-env node
|
||||||
|
@ -466,25 +465,36 @@ int do_fdt (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
|
||||||
|
|
||||||
static int fdt_valid(void)
|
static int fdt_valid(void)
|
||||||
{
|
{
|
||||||
|
int err;
|
||||||
|
|
||||||
if (fdt == NULL) {
|
if (fdt == NULL) {
|
||||||
printf ("The address of the fdt is invalid.\n");
|
printf ("The address of the fdt is invalid (NULL).\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
if (!fdt || (fdt_magic(fdt) != FDT_MAGIC)) {
|
|
||||||
fdt = NULL;
|
err = fdt_check_header(fdt);
|
||||||
printf ("Unrecognized fdt: bad magic\n");
|
if (err == 0)
|
||||||
return 0;
|
return 1; /* valid */
|
||||||
}
|
|
||||||
if (fdt_version(fdt) < FDT_FIRST_SUPPORTED_VERSION) {
|
if (err < 0) {
|
||||||
printf ("Unsupported fdt version: $d < %d\n",
|
printf("libfdt: %s", fdt_strerror(err));
|
||||||
FDT_FIRST_SUPPORTED_VERSION, fdt_version(fdt));
|
/*
|
||||||
fdt = NULL;
|
* Be more informative on bad version.
|
||||||
return 0;
|
*/
|
||||||
}
|
if (err == -FDT_ERR_BADVERSION) {
|
||||||
if (fdt_last_comp_version(fdt) > FDT_LAST_SUPPORTED_VERSION) {
|
if (fdt_version(fdt) < FDT_FIRST_SUPPORTED_VERSION) {
|
||||||
printf ("Unsupported fdt version: $d > %d\n",
|
printf (" - too old, fdt $d < %d",
|
||||||
fdt_version(fdt), FDT_LAST_SUPPORTED_VERSION);
|
fdt_version(fdt), FDT_FIRST_SUPPORTED_VERSION);
|
||||||
fdt = NULL;
|
fdt = NULL;
|
||||||
|
}
|
||||||
|
if (fdt_last_comp_version(fdt) > FDT_LAST_SUPPORTED_VERSION) {
|
||||||
|
printf (" - too new, fdt $d > %d",
|
||||||
|
fdt_version(fdt), FDT_LAST_SUPPORTED_VERSION);
|
||||||
|
fdt = NULL;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
printf("\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
return 1;
|
return 1;
|
||||||
|
@ -593,255 +603,6 @@ static void print_data(const void *data, int len)
|
||||||
|
|
||||||
/********************************************************************/
|
/********************************************************************/
|
||||||
|
|
||||||
static int fdt_chosen(void *fdt, ulong initrd_start, ulong initrd_end)
|
|
||||||
{
|
|
||||||
bd_t *bd = gd->bd;
|
|
||||||
int nodeoffset;
|
|
||||||
int err;
|
|
||||||
u32 tmp; /* used to set 32 bit integer properties */
|
|
||||||
char *str; /* used to set string properties */
|
|
||||||
ulong clock;
|
|
||||||
|
|
||||||
if (initrd_start && initrd_end) {
|
|
||||||
err = fdt_add_reservemap_entry(fdt,
|
|
||||||
initrd_start, initrd_end - initrd_start + 1);
|
|
||||||
if (err < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* See if we already have a "chosen" node, create it if not.
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/chosen");
|
|
||||||
if (nodeoffset < 0) {
|
|
||||||
/*
|
|
||||||
* Create a new node "/chosen" (offset 0 is root level)
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_add_subnode(fdt, 0, "chosen");
|
|
||||||
if (nodeoffset < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
|
||||||
return nodeoffset;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
str = getenv("bootargs");
|
|
||||||
if (str != NULL) {
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "bootargs", str, strlen(str)+1);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
}
|
|
||||||
if (initrd_start && initrd_end) {
|
|
||||||
tmp = __cpu_to_be32(initrd_start);
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "linux,initrd-start", &tmp, sizeof(tmp));
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
tmp = __cpu_to_be32(initrd_end);
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "linux,initrd-end", &tmp, sizeof(tmp));
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
}
|
|
||||||
#ifdef OF_STDOUT_PATH
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "linux,stdout-path", OF_STDOUT_PATH, strlen(OF_STDOUT_PATH)+1);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
#endif
|
|
||||||
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/cpus");
|
|
||||||
if (nodeoffset >= 0) {
|
|
||||||
clock = cpu_to_be32(bd->bi_intfreq);
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "clock-frequency", &clock, 4);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
}
|
|
||||||
#ifdef OF_TBCLK
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/cpus/" OF_CPU "/timebase-frequency");
|
|
||||||
if (nodeoffset >= 0) {
|
|
||||||
clock = cpu_to_be32(OF_TBCLK);
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "clock-frequency", &clock, 4);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
/********************************************************************/
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_HAS_BD_T
|
|
||||||
|
|
||||||
/* Function that returns a character from the environment */
|
|
||||||
extern uchar(*env_get_char) (int);
|
|
||||||
|
|
||||||
#define BDM(x) { .name = #x, .offset = offsetof(bd_t, bi_ ##x ) }
|
|
||||||
|
|
||||||
static const struct {
|
|
||||||
const char *name;
|
|
||||||
int offset;
|
|
||||||
} bd_map[] = {
|
|
||||||
BDM(memstart),
|
|
||||||
BDM(memsize),
|
|
||||||
BDM(flashstart),
|
|
||||||
BDM(flashsize),
|
|
||||||
BDM(flashoffset),
|
|
||||||
BDM(sramstart),
|
|
||||||
BDM(sramsize),
|
|
||||||
#if defined(CONFIG_5xx) || defined(CONFIG_8xx) || defined(CONFIG_8260) \
|
|
||||||
|| defined(CONFIG_E500)
|
|
||||||
BDM(immr_base),
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_MPC5xxx)
|
|
||||||
BDM(mbar_base),
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_MPC83XX)
|
|
||||||
BDM(immrbar),
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_MPC8220)
|
|
||||||
BDM(mbar_base),
|
|
||||||
BDM(inpfreq),
|
|
||||||
BDM(pcifreq),
|
|
||||||
BDM(pevfreq),
|
|
||||||
BDM(flbfreq),
|
|
||||||
BDM(vcofreq),
|
|
||||||
#endif
|
|
||||||
BDM(bootflags),
|
|
||||||
BDM(ip_addr),
|
|
||||||
BDM(intfreq),
|
|
||||||
BDM(busfreq),
|
|
||||||
#ifdef CONFIG_CPM2
|
|
||||||
BDM(cpmfreq),
|
|
||||||
BDM(brgfreq),
|
|
||||||
BDM(sccfreq),
|
|
||||||
BDM(vco),
|
|
||||||
#endif
|
|
||||||
#if defined(CONFIG_MPC5xxx)
|
|
||||||
BDM(ipbfreq),
|
|
||||||
BDM(pcifreq),
|
|
||||||
#endif
|
|
||||||
BDM(baudrate),
|
|
||||||
};
|
|
||||||
|
|
||||||
static int fdt_env(void *fdt)
|
|
||||||
{
|
|
||||||
int nodeoffset;
|
|
||||||
int err;
|
|
||||||
int k, nxt;
|
|
||||||
int i;
|
|
||||||
static char tmpenv[256];
|
|
||||||
|
|
||||||
/*
|
|
||||||
* See if we already have a "u-boot-env" node, delete it if so.
|
|
||||||
* Then create a new empty node.
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/u-boot-env");
|
|
||||||
if (nodeoffset >= 0) {
|
|
||||||
err = fdt_del_node(fdt, nodeoffset);
|
|
||||||
if (err < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/*
|
|
||||||
* Create a new node "/u-boot-env" (offset 0 is root level)
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_add_subnode(fdt, 0, "u-boot-env");
|
|
||||||
if (nodeoffset < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
|
||||||
return nodeoffset;
|
|
||||||
}
|
|
||||||
|
|
||||||
for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
|
|
||||||
char *s, *lval, *rval;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Find the end of the name=definition
|
|
||||||
*/
|
|
||||||
for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
|
|
||||||
;
|
|
||||||
s = tmpenv;
|
|
||||||
for (k = i; k < nxt && s < &tmpenv[sizeof(tmpenv) - 1]; ++k)
|
|
||||||
*s++ = env_get_char(k);
|
|
||||||
*s++ = '\0';
|
|
||||||
lval = tmpenv;
|
|
||||||
/*
|
|
||||||
* Find the first '=': it separates the name from the value
|
|
||||||
*/
|
|
||||||
s = strchr(tmpenv, '=');
|
|
||||||
if (s != NULL) {
|
|
||||||
*s++ = '\0';
|
|
||||||
rval = s;
|
|
||||||
} else
|
|
||||||
continue;
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, lval, rval, strlen(rval)+1);
|
|
||||||
if (err < 0) {
|
|
||||||
printf("\"%s\" - libfdt: %s\n", lval, fdt_strerror(err));
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
#endif /* CONFIG_OF_HAS_UBOOT_ENV */
|
|
||||||
|
|
||||||
/********************************************************************/
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_HAS_BD_T
|
|
||||||
static int fdt_bd_t(void *fdt)
|
|
||||||
{
|
|
||||||
bd_t *bd = gd->bd;
|
|
||||||
int nodeoffset;
|
|
||||||
int err;
|
|
||||||
u32 tmp; /* used to set 32 bit integer properties */
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* See if we already have a "bd_t" node, delete it if so.
|
|
||||||
* Then create a new empty node.
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_path_offset (fdt, "/bd_t");
|
|
||||||
if (nodeoffset >= 0) {
|
|
||||||
err = fdt_del_node(fdt, nodeoffset);
|
|
||||||
if (err < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/*
|
|
||||||
* Create a new node "/bd_t" (offset 0 is root level)
|
|
||||||
*/
|
|
||||||
nodeoffset = fdt_add_subnode(fdt, 0, "bd_t");
|
|
||||||
if (nodeoffset < 0) {
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
|
||||||
return nodeoffset;
|
|
||||||
}
|
|
||||||
/*
|
|
||||||
* Use the string/pointer structure to create the entries...
|
|
||||||
*/
|
|
||||||
for (i = 0; i < sizeof(bd_map)/sizeof(bd_map[0]); i++) {
|
|
||||||
tmp = cpu_to_be32(getenv("bootargs"));
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, bd_map[i].name, &tmp, sizeof(tmp));
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
}
|
|
||||||
/*
|
|
||||||
* Add a couple of oddball entries...
|
|
||||||
*/
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "enetaddr", &bd->bi_enetaddr, 6);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
err = fdt_setprop(fdt, nodeoffset, "ethspeed", &bd->bi_ethspeed, 4);
|
|
||||||
if (err < 0)
|
|
||||||
printf("libfdt: %s\n", fdt_strerror(err));
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF_BOARD_SETUP
|
|
||||||
ft_board_setup(fdt, bd);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
#endif /* CONFIG_OF_HAS_BD_T */
|
|
||||||
|
|
||||||
/********************************************************************/
|
|
||||||
|
|
||||||
U_BOOT_CMD(
|
U_BOOT_CMD(
|
||||||
fdt, 5, 0, do_fdt,
|
fdt, 5, 0, do_fdt,
|
||||||
"fdt - flattened device tree utility commands\n",
|
"fdt - flattened device tree utility commands\n",
|
||||||
|
@ -871,4 +632,4 @@ U_BOOT_CMD(
|
||||||
" fdt set /cpus \"#address-cells\" \"[00 00 00 01]\"\n"
|
" fdt set /cpus \"#address-cells\" \"[00 00 00 01]\"\n"
|
||||||
);
|
);
|
||||||
|
|
||||||
#endif /* CONFIG_OF_FLAT_TREE */
|
#endif /* CONFIG_OF_LIBFDT */
|
||||||
|
|
323
common/fdt_support.c
Normal file
323
common/fdt_support.c
Normal file
|
@ -0,0 +1,323 @@
|
||||||
|
/*
|
||||||
|
* (C) Copyright 2007
|
||||||
|
* Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
|
||||||
|
*
|
||||||
|
* 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 <linux/ctype.h>
|
||||||
|
#include <linux/types.h>
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_LIBFDT
|
||||||
|
|
||||||
|
#include <asm/global_data.h>
|
||||||
|
#include <fdt.h>
|
||||||
|
#include <libfdt.h>
|
||||||
|
#include <fdt_support.h>
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Global data (for the gd->bd)
|
||||||
|
*/
|
||||||
|
DECLARE_GLOBAL_DATA_PTR;
|
||||||
|
|
||||||
|
|
||||||
|
/********************************************************************/
|
||||||
|
|
||||||
|
int fdt_chosen(void *fdt, ulong initrd_start, ulong initrd_end, int force)
|
||||||
|
{
|
||||||
|
bd_t *bd = gd->bd;
|
||||||
|
int nodeoffset;
|
||||||
|
int err;
|
||||||
|
u32 tmp; /* used to set 32 bit integer properties */
|
||||||
|
char *str; /* used to set string properties */
|
||||||
|
ulong clock;
|
||||||
|
|
||||||
|
err = fdt_check_header(fdt);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
#warning "Don't double-add the reserved map"
|
||||||
|
if (initrd_start && initrd_end) {
|
||||||
|
err = fdt_add_reservemap_entry(fdt,
|
||||||
|
initrd_start, initrd_end - initrd_start + 1);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Find the "chosen" node.
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_path_offset (fdt, "/chosen");
|
||||||
|
|
||||||
|
/*
|
||||||
|
* If we have a "chosen" node already the "force the writing"
|
||||||
|
* is not set, our job is done.
|
||||||
|
*/
|
||||||
|
if ((nodeoffset >= 0) && !force)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* No "chosen" node in the blob: create it.
|
||||||
|
*/
|
||||||
|
if (nodeoffset < 0) {
|
||||||
|
/*
|
||||||
|
* Create a new node "/chosen" (offset 0 is root level)
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_add_subnode(fdt, 0, "chosen");
|
||||||
|
if (nodeoffset < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
||||||
|
return nodeoffset;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Update pre-existing properties, create them if non-existant.
|
||||||
|
*/
|
||||||
|
str = getenv("bootargs");
|
||||||
|
if (str != NULL) {
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "bootargs", str, strlen(str)+1);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
}
|
||||||
|
if (initrd_start && initrd_end) {
|
||||||
|
tmp = __cpu_to_be32(initrd_start);
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "linux,initrd-start", &tmp, sizeof(tmp));
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
tmp = __cpu_to_be32(initrd_end);
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "linux,initrd-end", &tmp, sizeof(tmp));
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
}
|
||||||
|
#ifdef OF_STDOUT_PATH
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "linux,stdout-path", OF_STDOUT_PATH, strlen(OF_STDOUT_PATH)+1);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
#endif
|
||||||
|
|
||||||
|
nodeoffset = fdt_path_offset (fdt, "/cpus");
|
||||||
|
if (nodeoffset >= 0) {
|
||||||
|
clock = cpu_to_be32(bd->bi_intfreq);
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "clock-frequency", &clock, 4);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
}
|
||||||
|
#ifdef OF_TBCLK
|
||||||
|
nodeoffset = fdt_path_offset (fdt, "/cpus/" OF_CPU "/timebase-frequency");
|
||||||
|
if (nodeoffset >= 0) {
|
||||||
|
clock = cpu_to_be32(OF_TBCLK);
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "clock-frequency", &clock, 4);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
/********************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_HAS_UBOOT_ENV
|
||||||
|
|
||||||
|
/* Function that returns a character from the environment */
|
||||||
|
extern uchar(*env_get_char) (int);
|
||||||
|
|
||||||
|
|
||||||
|
int fdt_env(void *fdt)
|
||||||
|
{
|
||||||
|
int nodeoffset;
|
||||||
|
int err;
|
||||||
|
int k, nxt;
|
||||||
|
int i;
|
||||||
|
static char tmpenv[256];
|
||||||
|
|
||||||
|
err = fdt_check_header(fdt);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* See if we already have a "u-boot-env" node, delete it if so.
|
||||||
|
* Then create a new empty node.
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_path_offset (fdt, "/u-boot-env");
|
||||||
|
if (nodeoffset >= 0) {
|
||||||
|
err = fdt_del_node(fdt, nodeoffset);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* Create a new node "/u-boot-env" (offset 0 is root level)
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_add_subnode(fdt, 0, "u-boot-env");
|
||||||
|
if (nodeoffset < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
||||||
|
return nodeoffset;
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
|
||||||
|
char *s, *lval, *rval;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Find the end of the name=definition
|
||||||
|
*/
|
||||||
|
for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
|
||||||
|
;
|
||||||
|
s = tmpenv;
|
||||||
|
for (k = i; k < nxt && s < &tmpenv[sizeof(tmpenv) - 1]; ++k)
|
||||||
|
*s++ = env_get_char(k);
|
||||||
|
*s++ = '\0';
|
||||||
|
lval = tmpenv;
|
||||||
|
/*
|
||||||
|
* Find the first '=': it separates the name from the value
|
||||||
|
*/
|
||||||
|
s = strchr(tmpenv, '=');
|
||||||
|
if (s != NULL) {
|
||||||
|
*s++ = '\0';
|
||||||
|
rval = s;
|
||||||
|
} else
|
||||||
|
continue;
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, lval, rval, strlen(rval)+1);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", lval, fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#endif /* CONFIG_OF_HAS_UBOOT_ENV */
|
||||||
|
|
||||||
|
/********************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_HAS_BD_T
|
||||||
|
|
||||||
|
#define BDM(x) { .name = #x, .offset = offsetof(bd_t, bi_ ##x ) }
|
||||||
|
|
||||||
|
static const struct {
|
||||||
|
const char *name;
|
||||||
|
int offset;
|
||||||
|
} bd_map[] = {
|
||||||
|
BDM(memstart),
|
||||||
|
BDM(memsize),
|
||||||
|
BDM(flashstart),
|
||||||
|
BDM(flashsize),
|
||||||
|
BDM(flashoffset),
|
||||||
|
BDM(sramstart),
|
||||||
|
BDM(sramsize),
|
||||||
|
#if defined(CONFIG_5xx) || defined(CONFIG_8xx) || defined(CONFIG_8260) \
|
||||||
|
|| defined(CONFIG_E500)
|
||||||
|
BDM(immr_base),
|
||||||
|
#endif
|
||||||
|
#if defined(CONFIG_MPC5xxx)
|
||||||
|
BDM(mbar_base),
|
||||||
|
#endif
|
||||||
|
#if defined(CONFIG_MPC83XX)
|
||||||
|
BDM(immrbar),
|
||||||
|
#endif
|
||||||
|
#if defined(CONFIG_MPC8220)
|
||||||
|
BDM(mbar_base),
|
||||||
|
BDM(inpfreq),
|
||||||
|
BDM(pcifreq),
|
||||||
|
BDM(pevfreq),
|
||||||
|
BDM(flbfreq),
|
||||||
|
BDM(vcofreq),
|
||||||
|
#endif
|
||||||
|
BDM(bootflags),
|
||||||
|
BDM(ip_addr),
|
||||||
|
BDM(intfreq),
|
||||||
|
BDM(busfreq),
|
||||||
|
#ifdef CONFIG_CPM2
|
||||||
|
BDM(cpmfreq),
|
||||||
|
BDM(brgfreq),
|
||||||
|
BDM(sccfreq),
|
||||||
|
BDM(vco),
|
||||||
|
#endif
|
||||||
|
#if defined(CONFIG_MPC5xxx)
|
||||||
|
BDM(ipbfreq),
|
||||||
|
BDM(pcifreq),
|
||||||
|
#endif
|
||||||
|
BDM(baudrate),
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
int fdt_bd_t(void *fdt)
|
||||||
|
{
|
||||||
|
bd_t *bd = gd->bd;
|
||||||
|
int nodeoffset;
|
||||||
|
int err;
|
||||||
|
u32 tmp; /* used to set 32 bit integer properties */
|
||||||
|
int i;
|
||||||
|
|
||||||
|
err = fdt_check_header(fdt);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* See if we already have a "bd_t" node, delete it if so.
|
||||||
|
* Then create a new empty node.
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_path_offset (fdt, "/bd_t");
|
||||||
|
if (nodeoffset >= 0) {
|
||||||
|
err = fdt_del_node(fdt, nodeoffset);
|
||||||
|
if (err < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* Create a new node "/bd_t" (offset 0 is root level)
|
||||||
|
*/
|
||||||
|
nodeoffset = fdt_add_subnode(fdt, 0, "bd_t");
|
||||||
|
if (nodeoffset < 0) {
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(nodeoffset));
|
||||||
|
return nodeoffset;
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* Use the string/pointer structure to create the entries...
|
||||||
|
*/
|
||||||
|
for (i = 0; i < sizeof(bd_map)/sizeof(bd_map[0]); i++) {
|
||||||
|
tmp = cpu_to_be32(getenv("bootargs"));
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, bd_map[i].name, &tmp, sizeof(tmp));
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* Add a couple of oddball entries...
|
||||||
|
*/
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "enetaddr", &bd->bi_enetaddr, 6);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
err = fdt_setprop(fdt, nodeoffset, "ethspeed", &bd->bi_ethspeed, 4);
|
||||||
|
if (err < 0)
|
||||||
|
printf("libfdt: %s\n", fdt_strerror(err));
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#endif /* CONFIG_OF_HAS_BD_T */
|
||||||
|
|
||||||
|
#endif /* CONFIG_OF_LIBFDT */
|
|
@ -364,6 +364,7 @@ ft_cpu_setup(void *blob, bd_t *bd)
|
||||||
/*
|
/*
|
||||||
* If unconditional create or the property already exists...
|
* If unconditional create or the property already exists...
|
||||||
*/
|
*/
|
||||||
|
err = 0;
|
||||||
if ((fixup_props[j].createflags & FT_CREATE) ||
|
if ((fixup_props[j].createflags & FT_CREATE) ||
|
||||||
(fdt_get_property(fdt, nodeoffset, fixup_props[j].prop, 0))) {
|
(fdt_get_property(fdt, nodeoffset, fixup_props[j].prop, 0))) {
|
||||||
if (fixup_props[j].createflags & FT_BUSFREQ) {
|
if (fixup_props[j].createflags & FT_BUSFREQ) {
|
||||||
|
|
42
include/fdt_support.h
Normal file
42
include/fdt_support.h
Normal file
|
@ -0,0 +1,42 @@
|
||||||
|
/*
|
||||||
|
* (C) Copyright 2007
|
||||||
|
* Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
|
||||||
|
*
|
||||||
|
* 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
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __FDT_SUPPORT_H
|
||||||
|
#define __FDT_SUPPORT_H
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_LIBFDT
|
||||||
|
|
||||||
|
#include <fdt.h>
|
||||||
|
|
||||||
|
int fdt_chosen(void *fdt, ulong initrd_start, ulong initrd_end, int force);
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_HAS_UBOOT_ENV
|
||||||
|
int fdt_env(void *fdt);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_HAS_BD_T
|
||||||
|
int fdt_bd_t(void *fdt);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif /* ifdef CONFIG_OF_LIBFDT */
|
||||||
|
#endif /* ifndef __FDT_SUPPORT_H */
|
Loading…
Add table
Reference in a new issue