|
@@ -12,7 +12,6 @@
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/initrd.h>
|
|
#include <linux/initrd.h>
|
|
#include <linux/memblock.h>
|
|
#include <linux/memblock.h>
|
|
-#include <linux/module.h>
|
|
|
|
#include <linux/of.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_fdt.h>
|
|
#include <linux/of_fdt.h>
|
|
#include <linux/of_reserved_mem.h>
|
|
#include <linux/of_reserved_mem.h>
|
|
@@ -20,62 +19,13 @@
|
|
#include <linux/string.h>
|
|
#include <linux/string.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/slab.h>
|
|
|
|
+#include <linux/libfdt.h>
|
|
|
|
+#include <linux/debugfs.h>
|
|
|
|
+#include <linux/serial_core.h>
|
|
|
|
|
|
#include <asm/setup.h> /* for COMMAND_LINE_SIZE */
|
|
#include <asm/setup.h> /* for COMMAND_LINE_SIZE */
|
|
-#ifdef CONFIG_PPC
|
|
|
|
-#include <asm/machdep.h>
|
|
|
|
-#endif /* CONFIG_PPC */
|
|
|
|
-
|
|
|
|
#include <asm/page.h>
|
|
#include <asm/page.h>
|
|
|
|
|
|
-char *of_fdt_get_string(struct boot_param_header *blob, u32 offset)
|
|
|
|
-{
|
|
|
|
- return ((char *)blob) +
|
|
|
|
- be32_to_cpu(blob->off_dt_strings) + offset;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-/**
|
|
|
|
- * of_fdt_get_property - Given a node in the given flat blob, return
|
|
|
|
- * the property ptr
|
|
|
|
- */
|
|
|
|
-void *of_fdt_get_property(struct boot_param_header *blob,
|
|
|
|
- unsigned long node, const char *name,
|
|
|
|
- unsigned long *size)
|
|
|
|
-{
|
|
|
|
- unsigned long p = node;
|
|
|
|
-
|
|
|
|
- do {
|
|
|
|
- u32 tag = be32_to_cpup((__be32 *)p);
|
|
|
|
- u32 sz, noff;
|
|
|
|
- const char *nstr;
|
|
|
|
-
|
|
|
|
- p += 4;
|
|
|
|
- if (tag == OF_DT_NOP)
|
|
|
|
- continue;
|
|
|
|
- if (tag != OF_DT_PROP)
|
|
|
|
- return NULL;
|
|
|
|
-
|
|
|
|
- sz = be32_to_cpup((__be32 *)p);
|
|
|
|
- noff = be32_to_cpup((__be32 *)(p + 4));
|
|
|
|
- p += 8;
|
|
|
|
- if (be32_to_cpu(blob->version) < 0x10)
|
|
|
|
- p = ALIGN(p, sz >= 8 ? 8 : 4);
|
|
|
|
-
|
|
|
|
- nstr = of_fdt_get_string(blob, noff);
|
|
|
|
- if (nstr == NULL) {
|
|
|
|
- pr_warning("Can't find property index name !\n");
|
|
|
|
- return NULL;
|
|
|
|
- }
|
|
|
|
- if (strcmp(name, nstr) == 0) {
|
|
|
|
- if (size)
|
|
|
|
- *size = sz;
|
|
|
|
- return (void *)p;
|
|
|
|
- }
|
|
|
|
- p += sz;
|
|
|
|
- p = ALIGN(p, 4);
|
|
|
|
- } while (1);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
/**
|
|
/**
|
|
* of_fdt_is_compatible - Return true if given node from the given blob has
|
|
* of_fdt_is_compatible - Return true if given node from the given blob has
|
|
* compat in its compatible list
|
|
* compat in its compatible list
|
|
@@ -86,13 +36,14 @@ void *of_fdt_get_property(struct boot_param_header *blob,
|
|
* On match, returns a non-zero value with smaller values returned for more
|
|
* On match, returns a non-zero value with smaller values returned for more
|
|
* specific compatible values.
|
|
* specific compatible values.
|
|
*/
|
|
*/
|
|
-int of_fdt_is_compatible(struct boot_param_header *blob,
|
|
|
|
|
|
+int of_fdt_is_compatible(const void *blob,
|
|
unsigned long node, const char *compat)
|
|
unsigned long node, const char *compat)
|
|
{
|
|
{
|
|
const char *cp;
|
|
const char *cp;
|
|
- unsigned long cplen, l, score = 0;
|
|
|
|
|
|
+ int cplen;
|
|
|
|
+ unsigned long l, score = 0;
|
|
|
|
|
|
- cp = of_fdt_get_property(blob, node, "compatible", &cplen);
|
|
|
|
|
|
+ cp = fdt_getprop(blob, node, "compatible", &cplen);
|
|
if (cp == NULL)
|
|
if (cp == NULL)
|
|
return 0;
|
|
return 0;
|
|
while (cplen > 0) {
|
|
while (cplen > 0) {
|
|
@@ -110,7 +61,7 @@ int of_fdt_is_compatible(struct boot_param_header *blob,
|
|
/**
|
|
/**
|
|
* of_fdt_match - Return true if node matches a list of compatible values
|
|
* of_fdt_match - Return true if node matches a list of compatible values
|
|
*/
|
|
*/
|
|
-int of_fdt_match(struct boot_param_header *blob, unsigned long node,
|
|
|
|
|
|
+int of_fdt_match(const void *blob, unsigned long node,
|
|
const char *const *compat)
|
|
const char *const *compat)
|
|
{
|
|
{
|
|
unsigned int tmp, score = 0;
|
|
unsigned int tmp, score = 0;
|
|
@@ -149,30 +100,29 @@ static void *unflatten_dt_alloc(void **mem, unsigned long size,
|
|
* @allnextpp: pointer to ->allnext from last allocated device_node
|
|
* @allnextpp: pointer to ->allnext from last allocated device_node
|
|
* @fpsize: Size of the node path up at the current depth.
|
|
* @fpsize: Size of the node path up at the current depth.
|
|
*/
|
|
*/
|
|
-static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
|
|
|
|
+static void * unflatten_dt_node(void *blob,
|
|
void *mem,
|
|
void *mem,
|
|
- void **p,
|
|
|
|
|
|
+ int *poffset,
|
|
struct device_node *dad,
|
|
struct device_node *dad,
|
|
struct device_node ***allnextpp,
|
|
struct device_node ***allnextpp,
|
|
unsigned long fpsize)
|
|
unsigned long fpsize)
|
|
{
|
|
{
|
|
|
|
+ const __be32 *p;
|
|
struct device_node *np;
|
|
struct device_node *np;
|
|
struct property *pp, **prev_pp = NULL;
|
|
struct property *pp, **prev_pp = NULL;
|
|
- char *pathp;
|
|
|
|
- u32 tag;
|
|
|
|
|
|
+ const char *pathp;
|
|
unsigned int l, allocl;
|
|
unsigned int l, allocl;
|
|
|
|
+ static int depth = 0;
|
|
|
|
+ int old_depth;
|
|
|
|
+ int offset;
|
|
int has_name = 0;
|
|
int has_name = 0;
|
|
int new_format = 0;
|
|
int new_format = 0;
|
|
|
|
|
|
- tag = be32_to_cpup(*p);
|
|
|
|
- if (tag != OF_DT_BEGIN_NODE) {
|
|
|
|
- pr_err("Weird tag at start of node: %x\n", tag);
|
|
|
|
|
|
+ pathp = fdt_get_name(blob, *poffset, &l);
|
|
|
|
+ if (!pathp)
|
|
return mem;
|
|
return mem;
|
|
- }
|
|
|
|
- *p += 4;
|
|
|
|
- pathp = *p;
|
|
|
|
- l = allocl = strlen(pathp) + 1;
|
|
|
|
- *p = PTR_ALIGN(*p + l, 4);
|
|
|
|
|
|
+
|
|
|
|
+ allocl = l++;
|
|
|
|
|
|
/* version 0x10 has a more compact unit name here instead of the full
|
|
/* version 0x10 has a more compact unit name here instead of the full
|
|
* path. we accumulate the full path size using "fpsize", we'll rebuild
|
|
* path. we accumulate the full path size using "fpsize", we'll rebuild
|
|
@@ -190,7 +140,7 @@ static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
fpsize = 1;
|
|
fpsize = 1;
|
|
allocl = 2;
|
|
allocl = 2;
|
|
l = 1;
|
|
l = 1;
|
|
- *pathp = '\0';
|
|
|
|
|
|
+ pathp = "";
|
|
} else {
|
|
} else {
|
|
/* account for '/' and path size minus terminal 0
|
|
/* account for '/' and path size minus terminal 0
|
|
* already in 'l'
|
|
* already in 'l'
|
|
@@ -237,32 +187,23 @@ static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
}
|
|
}
|
|
}
|
|
}
|
|
/* process properties */
|
|
/* process properties */
|
|
- while (1) {
|
|
|
|
- u32 sz, noff;
|
|
|
|
- char *pname;
|
|
|
|
-
|
|
|
|
- tag = be32_to_cpup(*p);
|
|
|
|
- if (tag == OF_DT_NOP) {
|
|
|
|
- *p += 4;
|
|
|
|
- continue;
|
|
|
|
- }
|
|
|
|
- if (tag != OF_DT_PROP)
|
|
|
|
|
|
+ for (offset = fdt_first_property_offset(blob, *poffset);
|
|
|
|
+ (offset >= 0);
|
|
|
|
+ (offset = fdt_next_property_offset(blob, offset))) {
|
|
|
|
+ const char *pname;
|
|
|
|
+ u32 sz;
|
|
|
|
+
|
|
|
|
+ if (!(p = fdt_getprop_by_offset(blob, offset, &pname, &sz))) {
|
|
|
|
+ offset = -FDT_ERR_INTERNAL;
|
|
break;
|
|
break;
|
|
- *p += 4;
|
|
|
|
- sz = be32_to_cpup(*p);
|
|
|
|
- noff = be32_to_cpup(*p + 4);
|
|
|
|
- *p += 8;
|
|
|
|
- if (be32_to_cpu(blob->version) < 0x10)
|
|
|
|
- *p = PTR_ALIGN(*p, sz >= 8 ? 8 : 4);
|
|
|
|
-
|
|
|
|
- pname = of_fdt_get_string(blob, noff);
|
|
|
|
|
|
+ }
|
|
|
|
+
|
|
if (pname == NULL) {
|
|
if (pname == NULL) {
|
|
pr_info("Can't find property name in list !\n");
|
|
pr_info("Can't find property name in list !\n");
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
if (strcmp(pname, "name") == 0)
|
|
if (strcmp(pname, "name") == 0)
|
|
has_name = 1;
|
|
has_name = 1;
|
|
- l = strlen(pname) + 1;
|
|
|
|
pp = unflatten_dt_alloc(&mem, sizeof(struct property),
|
|
pp = unflatten_dt_alloc(&mem, sizeof(struct property),
|
|
__alignof__(struct property));
|
|
__alignof__(struct property));
|
|
if (allnextpp) {
|
|
if (allnextpp) {
|
|
@@ -274,26 +215,25 @@ static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
if ((strcmp(pname, "phandle") == 0) ||
|
|
if ((strcmp(pname, "phandle") == 0) ||
|
|
(strcmp(pname, "linux,phandle") == 0)) {
|
|
(strcmp(pname, "linux,phandle") == 0)) {
|
|
if (np->phandle == 0)
|
|
if (np->phandle == 0)
|
|
- np->phandle = be32_to_cpup((__be32*)*p);
|
|
|
|
|
|
+ np->phandle = be32_to_cpup(p);
|
|
}
|
|
}
|
|
/* And we process the "ibm,phandle" property
|
|
/* And we process the "ibm,phandle" property
|
|
* used in pSeries dynamic device tree
|
|
* used in pSeries dynamic device tree
|
|
* stuff */
|
|
* stuff */
|
|
if (strcmp(pname, "ibm,phandle") == 0)
|
|
if (strcmp(pname, "ibm,phandle") == 0)
|
|
- np->phandle = be32_to_cpup((__be32 *)*p);
|
|
|
|
- pp->name = pname;
|
|
|
|
|
|
+ np->phandle = be32_to_cpup(p);
|
|
|
|
+ pp->name = (char *)pname;
|
|
pp->length = sz;
|
|
pp->length = sz;
|
|
- pp->value = *p;
|
|
|
|
|
|
+ pp->value = (__be32 *)p;
|
|
*prev_pp = pp;
|
|
*prev_pp = pp;
|
|
prev_pp = &pp->next;
|
|
prev_pp = &pp->next;
|
|
}
|
|
}
|
|
- *p = PTR_ALIGN((*p) + sz, 4);
|
|
|
|
}
|
|
}
|
|
/* with version 0x10 we may not have the name property, recreate
|
|
/* with version 0x10 we may not have the name property, recreate
|
|
* it here from the unit name if absent
|
|
* it here from the unit name if absent
|
|
*/
|
|
*/
|
|
if (!has_name) {
|
|
if (!has_name) {
|
|
- char *p1 = pathp, *ps = pathp, *pa = NULL;
|
|
|
|
|
|
+ const char *p1 = pathp, *ps = pathp, *pa = NULL;
|
|
int sz;
|
|
int sz;
|
|
|
|
|
|
while (*p1) {
|
|
while (*p1) {
|
|
@@ -330,19 +270,18 @@ static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
if (!np->type)
|
|
if (!np->type)
|
|
np->type = "<NULL>";
|
|
np->type = "<NULL>";
|
|
}
|
|
}
|
|
- while (tag == OF_DT_BEGIN_NODE || tag == OF_DT_NOP) {
|
|
|
|
- if (tag == OF_DT_NOP)
|
|
|
|
- *p += 4;
|
|
|
|
- else
|
|
|
|
- mem = unflatten_dt_node(blob, mem, p, np, allnextpp,
|
|
|
|
- fpsize);
|
|
|
|
- tag = be32_to_cpup(*p);
|
|
|
|
- }
|
|
|
|
- if (tag != OF_DT_END_NODE) {
|
|
|
|
- pr_err("Weird tag at end of node: %x\n", tag);
|
|
|
|
- return mem;
|
|
|
|
- }
|
|
|
|
- *p += 4;
|
|
|
|
|
|
+
|
|
|
|
+ old_depth = depth;
|
|
|
|
+ *poffset = fdt_next_node(blob, *poffset, &depth);
|
|
|
|
+ if (depth < 0)
|
|
|
|
+ depth = 0;
|
|
|
|
+ while (*poffset > 0 && depth > old_depth)
|
|
|
|
+ mem = unflatten_dt_node(blob, mem, poffset, np, allnextpp,
|
|
|
|
+ fpsize);
|
|
|
|
+
|
|
|
|
+ if (*poffset < 0 && *poffset != -FDT_ERR_NOTFOUND)
|
|
|
|
+ pr_err("unflatten: error %d processing FDT\n", *poffset);
|
|
|
|
+
|
|
return mem;
|
|
return mem;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -358,12 +297,13 @@ static void * unflatten_dt_node(struct boot_param_header *blob,
|
|
* @dt_alloc: An allocator that provides a virtual address to memory
|
|
* @dt_alloc: An allocator that provides a virtual address to memory
|
|
* for the resulting tree
|
|
* for the resulting tree
|
|
*/
|
|
*/
|
|
-static void __unflatten_device_tree(struct boot_param_header *blob,
|
|
|
|
|
|
+static void __unflatten_device_tree(void *blob,
|
|
struct device_node **mynodes,
|
|
struct device_node **mynodes,
|
|
void * (*dt_alloc)(u64 size, u64 align))
|
|
void * (*dt_alloc)(u64 size, u64 align))
|
|
{
|
|
{
|
|
unsigned long size;
|
|
unsigned long size;
|
|
- void *start, *mem;
|
|
|
|
|
|
+ int start;
|
|
|
|
+ void *mem;
|
|
struct device_node **allnextp = mynodes;
|
|
struct device_node **allnextp = mynodes;
|
|
|
|
|
|
pr_debug(" -> unflatten_device_tree()\n");
|
|
pr_debug(" -> unflatten_device_tree()\n");
|
|
@@ -374,18 +314,18 @@ static void __unflatten_device_tree(struct boot_param_header *blob,
|
|
}
|
|
}
|
|
|
|
|
|
pr_debug("Unflattening device tree:\n");
|
|
pr_debug("Unflattening device tree:\n");
|
|
- pr_debug("magic: %08x\n", be32_to_cpu(blob->magic));
|
|
|
|
- pr_debug("size: %08x\n", be32_to_cpu(blob->totalsize));
|
|
|
|
- pr_debug("version: %08x\n", be32_to_cpu(blob->version));
|
|
|
|
|
|
+ pr_debug("magic: %08x\n", fdt_magic(blob));
|
|
|
|
+ pr_debug("size: %08x\n", fdt_totalsize(blob));
|
|
|
|
+ pr_debug("version: %08x\n", fdt_version(blob));
|
|
|
|
|
|
- if (be32_to_cpu(blob->magic) != OF_DT_HEADER) {
|
|
|
|
|
|
+ if (fdt_check_header(blob)) {
|
|
pr_err("Invalid device tree blob header\n");
|
|
pr_err("Invalid device tree blob header\n");
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
/* First pass, scan for size */
|
|
/* First pass, scan for size */
|
|
- start = ((void *)blob) + be32_to_cpu(blob->off_dt_struct);
|
|
|
|
- size = (unsigned long)unflatten_dt_node(blob, 0, &start, NULL, NULL, 0);
|
|
|
|
|
|
+ start = 0;
|
|
|
|
+ size = (unsigned long)unflatten_dt_node(blob, NULL, &start, NULL, NULL, 0);
|
|
size = ALIGN(size, 4);
|
|
size = ALIGN(size, 4);
|
|
|
|
|
|
pr_debug(" size is %lx, allocating...\n", size);
|
|
pr_debug(" size is %lx, allocating...\n", size);
|
|
@@ -399,10 +339,8 @@ static void __unflatten_device_tree(struct boot_param_header *blob,
|
|
pr_debug(" unflattening %p...\n", mem);
|
|
pr_debug(" unflattening %p...\n", mem);
|
|
|
|
|
|
/* Second pass, do actual unflattening */
|
|
/* Second pass, do actual unflattening */
|
|
- start = ((void *)blob) + be32_to_cpu(blob->off_dt_struct);
|
|
|
|
|
|
+ start = 0;
|
|
unflatten_dt_node(blob, mem, &start, NULL, &allnextp, 0);
|
|
unflatten_dt_node(blob, mem, &start, NULL, &allnextp, 0);
|
|
- if (be32_to_cpup(start) != OF_DT_END)
|
|
|
|
- pr_warning("Weird tag at end of tree: %08x\n", be32_to_cpup(start));
|
|
|
|
if (be32_to_cpup(mem + size) != 0xdeadbeef)
|
|
if (be32_to_cpup(mem + size) != 0xdeadbeef)
|
|
pr_warning("End of tree marker overwritten: %08x\n",
|
|
pr_warning("End of tree marker overwritten: %08x\n",
|
|
be32_to_cpup(mem + size));
|
|
be32_to_cpup(mem + size));
|
|
@@ -427,9 +365,7 @@ static void *kernel_tree_alloc(u64 size, u64 align)
|
|
void of_fdt_unflatten_tree(unsigned long *blob,
|
|
void of_fdt_unflatten_tree(unsigned long *blob,
|
|
struct device_node **mynodes)
|
|
struct device_node **mynodes)
|
|
{
|
|
{
|
|
- struct boot_param_header *device_tree =
|
|
|
|
- (struct boot_param_header *)blob;
|
|
|
|
- __unflatten_device_tree(device_tree, mynodes, &kernel_tree_alloc);
|
|
|
|
|
|
+ __unflatten_device_tree(blob, mynodes, &kernel_tree_alloc);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(of_fdt_unflatten_tree);
|
|
EXPORT_SYMBOL_GPL(of_fdt_unflatten_tree);
|
|
|
|
|
|
@@ -437,7 +373,7 @@ EXPORT_SYMBOL_GPL(of_fdt_unflatten_tree);
|
|
int __initdata dt_root_addr_cells;
|
|
int __initdata dt_root_addr_cells;
|
|
int __initdata dt_root_size_cells;
|
|
int __initdata dt_root_size_cells;
|
|
|
|
|
|
-struct boot_param_header *initial_boot_params;
|
|
|
|
|
|
+void *initial_boot_params;
|
|
|
|
|
|
#ifdef CONFIG_OF_EARLY_FLATTREE
|
|
#ifdef CONFIG_OF_EARLY_FLATTREE
|
|
|
|
|
|
@@ -449,8 +385,8 @@ static int __init __reserved_mem_reserve_reg(unsigned long node,
|
|
{
|
|
{
|
|
int t_len = (dt_root_addr_cells + dt_root_size_cells) * sizeof(__be32);
|
|
int t_len = (dt_root_addr_cells + dt_root_size_cells) * sizeof(__be32);
|
|
phys_addr_t base, size;
|
|
phys_addr_t base, size;
|
|
- unsigned long len;
|
|
|
|
- __be32 *prop;
|
|
|
|
|
|
+ int len;
|
|
|
|
+ const __be32 *prop;
|
|
int nomap, first = 1;
|
|
int nomap, first = 1;
|
|
|
|
|
|
prop = of_get_flat_dt_prop(node, "reg", &len);
|
|
prop = of_get_flat_dt_prop(node, "reg", &len);
|
|
@@ -493,7 +429,7 @@ static int __init __reserved_mem_reserve_reg(unsigned long node,
|
|
*/
|
|
*/
|
|
static int __init __reserved_mem_check_root(unsigned long node)
|
|
static int __init __reserved_mem_check_root(unsigned long node)
|
|
{
|
|
{
|
|
- __be32 *prop;
|
|
|
|
|
|
+ const __be32 *prop;
|
|
|
|
|
|
prop = of_get_flat_dt_prop(node, "#size-cells", NULL);
|
|
prop = of_get_flat_dt_prop(node, "#size-cells", NULL);
|
|
if (!prop || be32_to_cpup(prop) != dt_root_size_cells)
|
|
if (!prop || be32_to_cpup(prop) != dt_root_size_cells)
|
|
@@ -557,9 +493,25 @@ static int __init __fdt_scan_reserved_mem(unsigned long node, const char *uname,
|
|
*/
|
|
*/
|
|
void __init early_init_fdt_scan_reserved_mem(void)
|
|
void __init early_init_fdt_scan_reserved_mem(void)
|
|
{
|
|
{
|
|
|
|
+ int n;
|
|
|
|
+ u64 base, size;
|
|
|
|
+
|
|
if (!initial_boot_params)
|
|
if (!initial_boot_params)
|
|
return;
|
|
return;
|
|
|
|
|
|
|
|
+ /* Reserve the dtb region */
|
|
|
|
+ early_init_dt_reserve_memory_arch(__pa(initial_boot_params),
|
|
|
|
+ fdt_totalsize(initial_boot_params),
|
|
|
|
+ 0);
|
|
|
|
+
|
|
|
|
+ /* Process header /memreserve/ fields */
|
|
|
|
+ for (n = 0; ; n++) {
|
|
|
|
+ fdt_get_mem_rsv(initial_boot_params, n, &base, &size);
|
|
|
|
+ if (!size)
|
|
|
|
+ break;
|
|
|
|
+ early_init_dt_reserve_memory_arch(base, size, 0);
|
|
|
|
+ }
|
|
|
|
+
|
|
of_scan_flat_dt(__fdt_scan_reserved_mem, NULL);
|
|
of_scan_flat_dt(__fdt_scan_reserved_mem, NULL);
|
|
fdt_init_reserved_mem();
|
|
fdt_init_reserved_mem();
|
|
}
|
|
}
|
|
@@ -578,47 +530,19 @@ int __init of_scan_flat_dt(int (*it)(unsigned long node,
|
|
void *data),
|
|
void *data),
|
|
void *data)
|
|
void *data)
|
|
{
|
|
{
|
|
- unsigned long p = ((unsigned long)initial_boot_params) +
|
|
|
|
- be32_to_cpu(initial_boot_params->off_dt_struct);
|
|
|
|
- int rc = 0;
|
|
|
|
- int depth = -1;
|
|
|
|
-
|
|
|
|
- do {
|
|
|
|
- u32 tag = be32_to_cpup((__be32 *)p);
|
|
|
|
- const char *pathp;
|
|
|
|
-
|
|
|
|
- p += 4;
|
|
|
|
- if (tag == OF_DT_END_NODE) {
|
|
|
|
- depth--;
|
|
|
|
- continue;
|
|
|
|
- }
|
|
|
|
- if (tag == OF_DT_NOP)
|
|
|
|
- continue;
|
|
|
|
- if (tag == OF_DT_END)
|
|
|
|
- break;
|
|
|
|
- if (tag == OF_DT_PROP) {
|
|
|
|
- u32 sz = be32_to_cpup((__be32 *)p);
|
|
|
|
- p += 8;
|
|
|
|
- if (be32_to_cpu(initial_boot_params->version) < 0x10)
|
|
|
|
- p = ALIGN(p, sz >= 8 ? 8 : 4);
|
|
|
|
- p += sz;
|
|
|
|
- p = ALIGN(p, 4);
|
|
|
|
- continue;
|
|
|
|
- }
|
|
|
|
- if (tag != OF_DT_BEGIN_NODE) {
|
|
|
|
- pr_err("Invalid tag %x in flat device tree!\n", tag);
|
|
|
|
- return -EINVAL;
|
|
|
|
- }
|
|
|
|
- depth++;
|
|
|
|
- pathp = (char *)p;
|
|
|
|
- p = ALIGN(p + strlen(pathp) + 1, 4);
|
|
|
|
|
|
+ const void *blob = initial_boot_params;
|
|
|
|
+ const char *pathp;
|
|
|
|
+ int offset, rc = 0, depth = -1;
|
|
|
|
+
|
|
|
|
+ for (offset = fdt_next_node(blob, -1, &depth);
|
|
|
|
+ offset >= 0 && depth >= 0 && !rc;
|
|
|
|
+ offset = fdt_next_node(blob, offset, &depth)) {
|
|
|
|
+
|
|
|
|
+ pathp = fdt_get_name(blob, offset, NULL);
|
|
if (*pathp == '/')
|
|
if (*pathp == '/')
|
|
pathp = kbasename(pathp);
|
|
pathp = kbasename(pathp);
|
|
- rc = it(p, pathp, depth, data);
|
|
|
|
- if (rc != 0)
|
|
|
|
- break;
|
|
|
|
- } while (1);
|
|
|
|
-
|
|
|
|
|
|
+ rc = it(offset, pathp, depth, data);
|
|
|
|
+ }
|
|
return rc;
|
|
return rc;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -627,14 +551,15 @@ int __init of_scan_flat_dt(int (*it)(unsigned long node,
|
|
*/
|
|
*/
|
|
unsigned long __init of_get_flat_dt_root(void)
|
|
unsigned long __init of_get_flat_dt_root(void)
|
|
{
|
|
{
|
|
- unsigned long p = ((unsigned long)initial_boot_params) +
|
|
|
|
- be32_to_cpu(initial_boot_params->off_dt_struct);
|
|
|
|
-
|
|
|
|
- while (be32_to_cpup((__be32 *)p) == OF_DT_NOP)
|
|
|
|
- p += 4;
|
|
|
|
- BUG_ON(be32_to_cpup((__be32 *)p) != OF_DT_BEGIN_NODE);
|
|
|
|
- p += 4;
|
|
|
|
- return ALIGN(p + strlen((char *)p) + 1, 4);
|
|
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * of_get_flat_dt_size - Return the total size of the FDT
|
|
|
|
+ */
|
|
|
|
+int __init of_get_flat_dt_size(void)
|
|
|
|
+{
|
|
|
|
+ return fdt_totalsize(initial_boot_params);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -643,10 +568,10 @@ unsigned long __init of_get_flat_dt_root(void)
|
|
* This function can be used within scan_flattened_dt callback to get
|
|
* This function can be used within scan_flattened_dt callback to get
|
|
* access to properties
|
|
* access to properties
|
|
*/
|
|
*/
|
|
-void *__init of_get_flat_dt_prop(unsigned long node, const char *name,
|
|
|
|
- unsigned long *size)
|
|
|
|
|
|
+const void *__init of_get_flat_dt_prop(unsigned long node, const char *name,
|
|
|
|
+ int *size)
|
|
{
|
|
{
|
|
- return of_fdt_get_property(initial_boot_params, node, name, size);
|
|
|
|
|
|
+ return fdt_getprop(initial_boot_params, node, name, size);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -676,73 +601,6 @@ struct fdt_scan_status {
|
|
void *data;
|
|
void *data;
|
|
};
|
|
};
|
|
|
|
|
|
-/**
|
|
|
|
- * fdt_scan_node_by_path - iterator for of_scan_flat_dt_by_path function
|
|
|
|
- */
|
|
|
|
-static int __init fdt_scan_node_by_path(unsigned long node, const char *uname,
|
|
|
|
- int depth, void *data)
|
|
|
|
-{
|
|
|
|
- struct fdt_scan_status *st = data;
|
|
|
|
-
|
|
|
|
- /*
|
|
|
|
- * if scan at the requested fdt node has been completed,
|
|
|
|
- * return -ENXIO to abort further scanning
|
|
|
|
- */
|
|
|
|
- if (depth <= st->depth)
|
|
|
|
- return -ENXIO;
|
|
|
|
-
|
|
|
|
- /* requested fdt node has been found, so call iterator function */
|
|
|
|
- if (st->found)
|
|
|
|
- return st->iterator(node, uname, depth, st->data);
|
|
|
|
-
|
|
|
|
- /* check if scanning automata is entering next level of fdt nodes */
|
|
|
|
- if (depth == st->depth + 1 &&
|
|
|
|
- strncmp(st->name, uname, st->namelen) == 0 &&
|
|
|
|
- uname[st->namelen] == 0) {
|
|
|
|
- st->depth += 1;
|
|
|
|
- if (st->name[st->namelen] == 0) {
|
|
|
|
- st->found = 1;
|
|
|
|
- } else {
|
|
|
|
- const char *next = st->name + st->namelen + 1;
|
|
|
|
- st->name = next;
|
|
|
|
- st->namelen = strcspn(next, "/");
|
|
|
|
- }
|
|
|
|
- return 0;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- /* scan next fdt node */
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-/**
|
|
|
|
- * of_scan_flat_dt_by_path - scan flattened tree blob and call callback on each
|
|
|
|
- * child of the given path.
|
|
|
|
- * @path: path to start searching for children
|
|
|
|
- * @it: callback function
|
|
|
|
- * @data: context data pointer
|
|
|
|
- *
|
|
|
|
- * This function is used to scan the flattened device-tree starting from the
|
|
|
|
- * node given by path. It is used to extract information (like reserved
|
|
|
|
- * memory), which is required on ealy boot before we can unflatten the tree.
|
|
|
|
- */
|
|
|
|
-int __init of_scan_flat_dt_by_path(const char *path,
|
|
|
|
- int (*it)(unsigned long node, const char *name, int depth, void *data),
|
|
|
|
- void *data)
|
|
|
|
-{
|
|
|
|
- struct fdt_scan_status st = {path, 0, -1, 0, it, data};
|
|
|
|
- int ret = 0;
|
|
|
|
-
|
|
|
|
- if (initial_boot_params)
|
|
|
|
- ret = of_scan_flat_dt(fdt_scan_node_by_path, &st);
|
|
|
|
-
|
|
|
|
- if (!st.found)
|
|
|
|
- return -ENOENT;
|
|
|
|
- else if (ret == -ENXIO) /* scan has been completed */
|
|
|
|
- return 0;
|
|
|
|
- else
|
|
|
|
- return ret;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
const char * __init of_flat_dt_get_machine_name(void)
|
|
const char * __init of_flat_dt_get_machine_name(void)
|
|
{
|
|
{
|
|
const char *name;
|
|
const char *name;
|
|
@@ -782,7 +640,7 @@ const void * __init of_flat_dt_match_machine(const void *default_match,
|
|
}
|
|
}
|
|
if (!best_data) {
|
|
if (!best_data) {
|
|
const char *prop;
|
|
const char *prop;
|
|
- long size;
|
|
|
|
|
|
+ int size;
|
|
|
|
|
|
pr_err("\n unrecognized device tree list:\n[ ");
|
|
pr_err("\n unrecognized device tree list:\n[ ");
|
|
|
|
|
|
@@ -811,8 +669,8 @@ const void * __init of_flat_dt_match_machine(const void *default_match,
|
|
static void __init early_init_dt_check_for_initrd(unsigned long node)
|
|
static void __init early_init_dt_check_for_initrd(unsigned long node)
|
|
{
|
|
{
|
|
u64 start, end;
|
|
u64 start, end;
|
|
- unsigned long len;
|
|
|
|
- __be32 *prop;
|
|
|
|
|
|
+ int len;
|
|
|
|
+ const __be32 *prop;
|
|
|
|
|
|
pr_debug("Looking for initrd properties... ");
|
|
pr_debug("Looking for initrd properties... ");
|
|
|
|
|
|
@@ -839,13 +697,68 @@ static inline void early_init_dt_check_for_initrd(unsigned long node)
|
|
}
|
|
}
|
|
#endif /* CONFIG_BLK_DEV_INITRD */
|
|
#endif /* CONFIG_BLK_DEV_INITRD */
|
|
|
|
|
|
|
|
+#ifdef CONFIG_SERIAL_EARLYCON
|
|
|
|
+extern struct of_device_id __earlycon_of_table[];
|
|
|
|
+
|
|
|
|
+int __init early_init_dt_scan_chosen_serial(void)
|
|
|
|
+{
|
|
|
|
+ int offset;
|
|
|
|
+ const char *p;
|
|
|
|
+ int l;
|
|
|
|
+ const struct of_device_id *match = __earlycon_of_table;
|
|
|
|
+ const void *fdt = initial_boot_params;
|
|
|
|
+
|
|
|
|
+ offset = fdt_path_offset(fdt, "/chosen");
|
|
|
|
+ if (offset < 0)
|
|
|
|
+ offset = fdt_path_offset(fdt, "/chosen@0");
|
|
|
|
+ if (offset < 0)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+
|
|
|
|
+ p = fdt_getprop(fdt, offset, "stdout-path", &l);
|
|
|
|
+ if (!p)
|
|
|
|
+ p = fdt_getprop(fdt, offset, "linux,stdout-path", &l);
|
|
|
|
+ if (!p || !l)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+
|
|
|
|
+ /* Get the node specified by stdout-path */
|
|
|
|
+ offset = fdt_path_offset(fdt, p);
|
|
|
|
+ if (offset < 0)
|
|
|
|
+ return -ENODEV;
|
|
|
|
+
|
|
|
|
+ while (match->compatible) {
|
|
|
|
+ unsigned long addr;
|
|
|
|
+ if (fdt_node_check_compatible(fdt, offset, match->compatible)) {
|
|
|
|
+ match++;
|
|
|
|
+ continue;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ addr = fdt_translate_address(fdt, offset);
|
|
|
|
+ if (!addr)
|
|
|
|
+ return -ENXIO;
|
|
|
|
+
|
|
|
|
+ of_setup_earlycon(addr, match->data);
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+ return -ENODEV;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int __init setup_of_earlycon(char *buf)
|
|
|
|
+{
|
|
|
|
+ if (buf)
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+ return early_init_dt_scan_chosen_serial();
|
|
|
|
+}
|
|
|
|
+early_param("earlycon", setup_of_earlycon);
|
|
|
|
+#endif
|
|
|
|
+
|
|
/**
|
|
/**
|
|
* early_init_dt_scan_root - fetch the top level address and size cells
|
|
* early_init_dt_scan_root - fetch the top level address and size cells
|
|
*/
|
|
*/
|
|
int __init early_init_dt_scan_root(unsigned long node, const char *uname,
|
|
int __init early_init_dt_scan_root(unsigned long node, const char *uname,
|
|
int depth, void *data)
|
|
int depth, void *data)
|
|
{
|
|
{
|
|
- __be32 *prop;
|
|
|
|
|
|
+ const __be32 *prop;
|
|
|
|
|
|
if (depth != 0)
|
|
if (depth != 0)
|
|
return 0;
|
|
return 0;
|
|
@@ -867,9 +780,9 @@ int __init early_init_dt_scan_root(unsigned long node, const char *uname,
|
|
return 1;
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
|
|
-u64 __init dt_mem_next_cell(int s, __be32 **cellp)
|
|
|
|
|
|
+u64 __init dt_mem_next_cell(int s, const __be32 **cellp)
|
|
{
|
|
{
|
|
- __be32 *p = *cellp;
|
|
|
|
|
|
+ const __be32 *p = *cellp;
|
|
|
|
|
|
*cellp = p + s;
|
|
*cellp = p + s;
|
|
return of_read_number(p, s);
|
|
return of_read_number(p, s);
|
|
@@ -881,9 +794,9 @@ u64 __init dt_mem_next_cell(int s, __be32 **cellp)
|
|
int __init early_init_dt_scan_memory(unsigned long node, const char *uname,
|
|
int __init early_init_dt_scan_memory(unsigned long node, const char *uname,
|
|
int depth, void *data)
|
|
int depth, void *data)
|
|
{
|
|
{
|
|
- char *type = of_get_flat_dt_prop(node, "device_type", NULL);
|
|
|
|
- __be32 *reg, *endp;
|
|
|
|
- unsigned long l;
|
|
|
|
|
|
+ const char *type = of_get_flat_dt_prop(node, "device_type", NULL);
|
|
|
|
+ const __be32 *reg, *endp;
|
|
|
|
+ int l;
|
|
|
|
|
|
/* We are scanning "memory" nodes only */
|
|
/* We are scanning "memory" nodes only */
|
|
if (type == NULL) {
|
|
if (type == NULL) {
|
|
@@ -891,7 +804,7 @@ int __init early_init_dt_scan_memory(unsigned long node, const char *uname,
|
|
* The longtrail doesn't have a device_type on the
|
|
* The longtrail doesn't have a device_type on the
|
|
* /memory node, so look for the node called /memory@0.
|
|
* /memory node, so look for the node called /memory@0.
|
|
*/
|
|
*/
|
|
- if (depth != 1 || strcmp(uname, "memory@0") != 0)
|
|
|
|
|
|
+ if (!IS_ENABLED(CONFIG_PPC32) || depth != 1 || strcmp(uname, "memory@0") != 0)
|
|
return 0;
|
|
return 0;
|
|
} else if (strcmp(type, "memory") != 0)
|
|
} else if (strcmp(type, "memory") != 0)
|
|
return 0;
|
|
return 0;
|
|
@@ -904,7 +817,7 @@ int __init early_init_dt_scan_memory(unsigned long node, const char *uname,
|
|
|
|
|
|
endp = reg + (l / sizeof(__be32));
|
|
endp = reg + (l / sizeof(__be32));
|
|
|
|
|
|
- pr_debug("memory scan node %s, reg size %ld, data: %x %x %x %x,\n",
|
|
|
|
|
|
+ pr_debug("memory scan node %s, reg size %d, data: %x %x %x %x,\n",
|
|
uname, l, reg[0], reg[1], reg[2], reg[3]);
|
|
uname, l, reg[0], reg[1], reg[2], reg[3]);
|
|
|
|
|
|
while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) {
|
|
while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) {
|
|
@@ -927,8 +840,8 @@ int __init early_init_dt_scan_memory(unsigned long node, const char *uname,
|
|
int __init early_init_dt_scan_chosen(unsigned long node, const char *uname,
|
|
int __init early_init_dt_scan_chosen(unsigned long node, const char *uname,
|
|
int depth, void *data)
|
|
int depth, void *data)
|
|
{
|
|
{
|
|
- unsigned long l;
|
|
|
|
- char *p;
|
|
|
|
|
|
+ int l;
|
|
|
|
+ const char *p;
|
|
|
|
|
|
pr_debug("search \"chosen\", depth: %d, uname: %s\n", depth, uname);
|
|
pr_debug("search \"chosen\", depth: %d, uname: %s\n", depth, uname);
|
|
|
|
|
|
@@ -1003,8 +916,8 @@ void * __init __weak early_init_dt_alloc_memory_arch(u64 size, u64 align)
|
|
int __init __weak early_init_dt_reserve_memory_arch(phys_addr_t base,
|
|
int __init __weak early_init_dt_reserve_memory_arch(phys_addr_t base,
|
|
phys_addr_t size, bool nomap)
|
|
phys_addr_t size, bool nomap)
|
|
{
|
|
{
|
|
- pr_err("Reserved memory not supported, ignoring range 0x%llx - 0x%llx%s\n",
|
|
|
|
- base, size, nomap ? " (nomap)" : "");
|
|
|
|
|
|
+ pr_err("Reserved memory not supported, ignoring range 0x%pa - 0x%pa%s\n",
|
|
|
|
+ &base, &size, nomap ? " (nomap)" : "");
|
|
return -ENOSYS;
|
|
return -ENOSYS;
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
@@ -1018,7 +931,7 @@ bool __init early_init_dt_scan(void *params)
|
|
initial_boot_params = params;
|
|
initial_boot_params = params;
|
|
|
|
|
|
/* check device tree validity */
|
|
/* check device tree validity */
|
|
- if (be32_to_cpu(initial_boot_params->magic) != OF_DT_HEADER) {
|
|
|
|
|
|
+ if (fdt_check_header(params)) {
|
|
initial_boot_params = NULL;
|
|
initial_boot_params = NULL;
|
|
return false;
|
|
return false;
|
|
}
|
|
}
|
|
@@ -1073,9 +986,9 @@ void __init unflatten_and_copy_device_tree(void)
|
|
return;
|
|
return;
|
|
}
|
|
}
|
|
|
|
|
|
- size = __be32_to_cpu(initial_boot_params->totalsize);
|
|
|
|
|
|
+ size = fdt_totalsize(initial_boot_params);
|
|
dt = early_init_dt_alloc_memory_arch(size,
|
|
dt = early_init_dt_alloc_memory_arch(size,
|
|
- __alignof__(struct boot_param_header));
|
|
|
|
|
|
+ roundup_pow_of_two(FDT_V17_SIZE));
|
|
|
|
|
|
if (dt) {
|
|
if (dt) {
|
|
memcpy(dt, initial_boot_params, size);
|
|
memcpy(dt, initial_boot_params, size);
|
|
@@ -1084,4 +997,27 @@ void __init unflatten_and_copy_device_tree(void)
|
|
unflatten_device_tree();
|
|
unflatten_device_tree();
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+#if defined(CONFIG_DEBUG_FS) && defined(DEBUG)
|
|
|
|
+static struct debugfs_blob_wrapper flat_dt_blob;
|
|
|
|
+
|
|
|
|
+static int __init of_flat_dt_debugfs_export_fdt(void)
|
|
|
|
+{
|
|
|
|
+ struct dentry *d = debugfs_create_dir("device-tree", NULL);
|
|
|
|
+
|
|
|
|
+ if (!d)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+
|
|
|
|
+ flat_dt_blob.data = initial_boot_params;
|
|
|
|
+ flat_dt_blob.size = fdt_totalsize(initial_boot_params);
|
|
|
|
+
|
|
|
|
+ d = debugfs_create_blob("flat-device-tree", S_IFREG | S_IRUSR,
|
|
|
|
+ d, &flat_dt_blob);
|
|
|
|
+ if (!d)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+module_init(of_flat_dt_debugfs_export_fdt);
|
|
|
|
+#endif
|
|
|
|
+
|
|
#endif /* CONFIG_OF_EARLY_FLATTREE */
|
|
#endif /* CONFIG_OF_EARLY_FLATTREE */
|