switch-coreboot/util/dtc/flattree.c
Ronald G. Minnich 28ecbeab88 The K8 is one example, but there are other devices (e.g. I2C) that also have
multiple links. The way this was done in v2 was a big confusing; this way is 
less so. 

The changes are easy. Getting them right has been hard :-)

First, for a k8 north that has three links, you can name each one as follows:
pci0@18,0
pci1@18,0
pci2@18,0

We have to have the same pcidevfn on these because that is how the k8 works. 
But the unit numbers (pci0, pci1, etc.) distinguish them. 

The dts will properly generate a "v3 device code" 
compatible static tree that puts the links in the right place in the 
data structure. 

The changes to dts are trivial. 
As before, dts nodes with children are understood to be a bridge. 
But what if there is a dts entry like this:
pci1@18,0 {/config/("northbridge/amd/k8/pci");};


This entry has no children in the dts. 
How does dt compiler know it is a bridge? It can not know unless 
we add information to the dts for that northbridge part. 
To ensure that all bridge devices are detected, we support the following: 
if a dts node for a device has a bridge property, e.g.: 
 {
        device_operations = "k8_ops";
       bridge;
 };

The dt compiler will treat it as a bridge whether it has children or not. 

Why would a device not have children? Because it might be attached to a
pci or other socket, and we don't know at build time if the socket is empty, 
or what might be in the socket. 

This code has been tested on dbe62 and k8 simnow, and works on each. 
It is minimal in size and it does what we need. I hope it resolves our 
discussion for now. We might want to improve or change the device code
later but, at this point, forward motion is important -- I'm on a deadline for
a very important demo Oct. 22!

Also included in this patch are new debug prints in k8 north. 

Signed-off-by: Ronald G. Minnich <rminnich@gmail.com>

Acked-by: Carl-Daniel Hailfinger <c-d.hailfinger.devel.2006@gmx.net>


git-svn-id: svn://coreboot.org/repository/coreboot-v3@865 f3766cd6-281f-0410-b1cd-43a5c92072e9
2008-09-17 16:36:20 +00:00

1963 lines
47 KiB
C

/*
* (C) Copyright David Gibson <dwg@au1.ibm.com>, IBM Corporation. 2005.
*
*
* 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 "dtc.h"
#include "flat_dt.h"
#define FTF_FULLPATH 0x1
#define FTF_VARALIGN 0x2
#define FTF_NAMEPROPS 0x4
#define FTF_BOOTCPUID 0x8
#define FTF_STRTABSIZE 0x10
static struct version_info {
int version;
int last_comp_version;
int hdr_size;
int flags;
} version_table[] = {
{1, 1, BPH_V1_SIZE,
FTF_FULLPATH|FTF_VARALIGN|FTF_NAMEPROPS},
{2, 1, BPH_V2_SIZE,
FTF_FULLPATH|FTF_VARALIGN|FTF_NAMEPROPS|FTF_BOOTCPUID},
{3, 1, BPH_V3_SIZE,
FTF_FULLPATH|FTF_VARALIGN|FTF_NAMEPROPS|FTF_BOOTCPUID|FTF_STRTABSIZE},
{0x10, 0x10, BPH_V3_SIZE,
FTF_BOOTCPUID|FTF_STRTABSIZE},
};
struct emitter {
void (*cell)(void *, cell_t);
void (*string)(void *, char *, int);
void (*align)(void *, int);
void (*data)(void *, struct property *);
void (*beginnode)(void *, char *);
void (*endnode)(void *, char *);
void (*property)(void *, char *);
void(*special)(FILE *f, struct node *);
};
char *
clean(char *name, int instantiate){
char *cleanname = strdup(name), *cp;
for(cp = cleanname; *cp; cp++)
switch(*cp) {
case '#':
*cp = 'H';
break;
case '@':
/* if we are declaring it, this is an instance. If not, this is a struct type */
if (instantiate)
*cp = '_';
else
*cp = 0;
break;
case '-':
case ',':
*cp = '_';
break;
}
return cleanname;
}
char *
topath(struct property *p){
struct data d = p->val;
int i = 0;
char *pathname, *cp;
pathname = malloc(d.len + 1);
for(cp = pathname, i = 0; i < d.len; i++, cp++) {
switch(d.val[i]){
case '@':
*cp = 0;
break;
case ',':
*cp = '/';
break;
default:
*cp = d.val[i];
break;
}
}
*cp++ = 0;
return pathname;
}
char *toname(char *path, char *suffix){
char *ret = malloc(strlen(path) + strlen(suffix) + 1), *cp, *src;
for(cp = ret, src = path; *src; cp++, src++){
if (*src == '/')
*cp = '_';
else
*cp = *src;
}
*cp = 0;
cp = ret;
if (suffix)
strcat(cp, suffix);
return cp;
}
static void bin_emit_cell(void *e, cell_t val)
{
struct data *dtbuf = e;
*dtbuf = data_append_cell(*dtbuf, val);
}
static void bin_emit_string(void *e, char *str, int len)
{
struct data *dtbuf = e;
if (len == 0)
len = strlen(str);
*dtbuf = data_append_data(*dtbuf, str, len);
*dtbuf = data_append_byte(*dtbuf, '\0');
}
static void bin_emit_align(void *e, int a)
{
struct data *dtbuf = e;
*dtbuf = data_append_align(*dtbuf, a);
}
static void bin_emit_data(void *e, struct property *p)
{
struct data d = p->val;
struct data *dtbuf = e;
*dtbuf = data_append_data(*dtbuf, d.val, d.len);
}
static void bin_emit_beginnode(void *e, char *label)
{
bin_emit_cell(e, OF_DT_BEGIN_NODE);
}
static void bin_emit_endnode(void *e, char *label)
{
bin_emit_cell(e, OF_DT_END_NODE);
}
static void bin_emit_property(void *e, char *label)
{
bin_emit_cell(e, OF_DT_PROP);
}
static struct emitter bin_emitter = {
.cell = bin_emit_cell,
.string = bin_emit_string,
.align = bin_emit_align,
.data = bin_emit_data,
.beginnode = bin_emit_beginnode,
.endnode = bin_emit_endnode,
.property = bin_emit_property,
};
static void emit_label(FILE *f, char *prefix, char *label)
{
fprintf(f, "\t.globl\t%s_%s\n", prefix, label);
fprintf(f, "%s_%s:\n", prefix, label);
fprintf(f, "_%s_%s:\n", prefix, label);
}
static void asm_emit_cell(void *e, cell_t val)
{
FILE *f = e;
fprintf(f, "\t.long\t0x%x\n", val);
}
static void asm_emit_string(void *e, char *str, int len)
{
FILE *f = e;
char c = 0;
if (len != 0) {
/* XXX: ewww */
c = str[len];
str[len] = '\0';
}
fprintf(f, "\t.string\t\"%s\"\n", str);
if (len != 0) {
str[len] = c;
}
}
static void asm_emit_align(void *e, int a)
{
FILE *f = e;
fprintf(f, "\t.balign\t%d\n", a);
}
static void asm_emit_data(void *e, struct property *p)
{
struct data d = p->val;
FILE *f = e;
int off = 0;
while ((d.len - off) >= sizeof(u32)) {
fprintf(f, "\t.long\t0x%x\n",
be32_to_cpu(*((u32 *)(d.val+off))));
off += sizeof(u32);
}
if ((d.len - off) >= sizeof(u16)) {
fprintf(f, "\t.short\t0x%hx\n",
be16_to_cpu(*((u16 *)(d.val+off))));
off += sizeof(u16);
}
if ((d.len - off) >= 1) {
fprintf(f, "\t.byte\t0x%hhx\n", d.val[off]);
off += 1;
}
assert(off == d.len);
}
static void asm_emit_beginnode(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "\t.globl\t%s\n", label);
fprintf(f, "%s:\n", label);
}
fprintf(f, "\t.long\tOF_DT_BEGIN_NODE\n");
}
static void asm_emit_endnode(void *e, char *label)
{
FILE *f = e;
fprintf(f, "\t.long\tOF_DT_END_NODE\n");
if (label) {
fprintf(f, "\t.globl\t%s_end\n", label);
fprintf(f, "%s_end:\n", label);
}
}
static void asm_emit_property(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "\t.globl\t%s\n", label);
fprintf(f, "%s:\n", label);
}
fprintf(f, "\t.long\tOF_DT_PROP\n");
}
static struct emitter asm_emitter = {
.cell = asm_emit_cell,
.string = asm_emit_string,
.align = asm_emit_align,
.data = asm_emit_data,
.beginnode = asm_emit_beginnode,
.endnode = asm_emit_endnode,
.property = asm_emit_property,
};
int unique = 0;
static void C_emit_cell(void *e, cell_t val)
{
FILE *f = e;
fprintf(f, "\tu32\tc%d = 0x%x;\n", unique++, val);
}
static void C_emit_string(void *e, char *str, int len)
{
FILE *f = e;
char c = 0;
if (len != 0) {
/* XXX: ewww */
c = str[len];
str[len] = '\0';
}
fprintf(f, "\tunsigned char *c%d = \t\"%s\";\n", unique++, str);
if (len != 0) {
str[len] = c;
}
}
static void C_emit_align(void *e, int a)
{
FILE *f = e;
fprintf(f, "\tALIGN(x)\t%d\n", a);
}
static void C_emit_data(void *e, struct property *p)
{
struct data d = p->val;
FILE *f = e;
int off = 0;
while ((d.len - off) >= sizeof(u32)) {
fprintf(f, "\tu32 d%d = \t0x%x;\n",unique++,
be32_to_cpu(*((u32 *)(d.val+off))));
off += sizeof(u32);
}
if ((d.len - off) >= sizeof(u16)) {
fprintf(f, "\tu16 d%d = \t0x%hx;\n", unique++,
be16_to_cpu(*((u16 *)(d.val+off))));
off += sizeof(u16);
}
if ((d.len - off) >= 1) {
fprintf(f, "\tu8 d%d = \t0x%hhx;\n", unique++, d.val[off]);
off += 1;
}
assert(off == d.len);
}
static void C_emit_beginnode(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "struct\t%s {\n", label);
}
fprintf(f, "\tu32\tn%d = OF_DT_BEGIN_NODE;\n", unique++);
}
static void C_emit_endnode(void *e, char *label)
{
FILE *f = e;
fprintf(f, "\tu32\ten%d = OF_DT_END_NODE;\n", unique++);
if (label) {
fprintf(f, "\t\t%s;\n", label);
}
}
static void C_emit_struct_start(void *e, char *prefix, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "struct\t%s {\n", label);
}
}
static void C_emit_struct_end(void *e, char *prefix, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "}; /*%s*/\n", label);
}
}
static void C_emit_property(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "\tstruct p%d\t%s{\n", unique++, label);
}
fprintf(f, "\tu32 p%d = \tOF_DT_PROP;\n", unique++);
}
static struct emitter C_emitter = {
.cell = C_emit_cell,
.string = C_emit_string,
.align = C_emit_align,
.data = C_emit_data,
.beginnode = C_emit_beginnode,
.endnode = C_emit_endnode,
.property = C_emit_property,
};
/* coreboot static.c */
static void coreboot_emit_cell(void *e, cell_t val)
{
FILE *f = e;
fprintf(f, "\tu32\tc%d = 0x%x;\n", unique++, val);
}
static void coreboot_emit_string(void *e, char *str, int len)
{
FILE *f = e;
char c = 0;
if (len != 0) {
/* XXX: ewww */
c = str[len];
str[len] = '\0';
}
fprintf(f, "\tunsigned char *c%d = \t\"%s\";\n", unique++, str);
if (len != 0) {
str[len] = c;
}
}
static void coreboot_emit_align(void *e, int a)
{
FILE *f = e;
fprintf(f, "\tALIGN(x)\t%d\n", a);
}
static void coreboot_emit_data(void *e, struct property *p)
{
struct data d = p->val;
FILE *f = e;
int i;
char *cleanname;
int vallen = d.len > 4 ? 4 : d.len;
/* nothing to do? */
if (d.len == 0)
return;
cleanname = clean(p->name, 1);
if (d.type == 'S') {
// Standard property (scalar)
fprintf(f, "\t.%s = ", cleanname);
fprintf(f, "0x%lx,\n", strtoul((char *)d.val, 0, 0));
} else if (d.type == 'C') {
// 'Cell' property (array of 4-byte elements)
fprintf(f, "\t.%s = {\n", cleanname);
int i;
for (i = 0; (i < d.len) && (0 != *(u32 *)(d.val+i)); i = i+4) {
fprintf(f, "\t\t[%d] = 0x%08X,\n",i/4,*(u32 *)(d.val+i));
}
fprintf(f, "\t\t[%d] = 0x0,\n",i/4); // Make sure to end our array with a zero element
fprintf(f, "\t},\n");
} else if (d.type == 'B') {
fprintf(f, "\tUNIMPLEMENTED: FIXME\n");
}
free(cleanname);
#if 0
/* sorry, but right now, u32 is all you get */
fprintf(f, "0");
for(i = 0; i < vallen; i++)
fprintf(f, "|(0x%02x<<%d)", d.val[i], (3-i)*8);
fprintf(f, ",\n");
#endif
}
static void coreboot_emit_beginnode(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "struct\t%s {\n", label);
}
}
static void coreboot_emit_endnode(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "}; /*%s*/\n", label);
}
}
#ifdef COREBOOT_OUTPUT
static void coreboot_emit_struct_start(void *e, char *prefix, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "struct\t%s {\n", label);
}
}
static void coreboot_emit_struct_end(void *e, char *prefix, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "}; /*%s*/\n", label);
}
}
#endif
static void coreboot_emit_property(void *e, char *label)
{
FILE *f = e;
if (label) {
fprintf(f, "\tstruct p%d\t%s{\n", unique++, label);
}
fprintf(f, "\tu32 p%d = \tOF_DT_PROP;\n", unique++);
}
/* Is the node a bridge?
* If it has children, yes.
* OR if it has a config, if the config has
* the 'bridge' property, yes.
*/
static int is_bridge(struct node *tree)
{
int bridge = 0;
struct property *prop;
/* simple test: does it have children? If so, it's a bridge */
if (tree->children)
return 1;
if (tree->config){
for_each_config(tree, prop) {
if (streq(prop->name, "bridge")){
bridge = 1;
}
}
}
return bridge;
}
static void coreboot_emit_special(FILE *e, struct node *tree)
{
FILE *f = e;
struct property *prop;
int ops_set = 0;
int is_root = 0;
char *configname;
char *path;
int enabled = 1;
int linkcount = 0;
fprintf(f, "struct device dev_%s = {\n", tree->label);
/* special case -- the root has a distinguished path */
if (! strncmp(tree->label, "root", 4)){
is_root = 1;
fprintf(f, "\t.path = { .type = DEVICE_PATH_ROOT },\n");
}
/* from the node names (tree->name) we derive the path */
path = index(tree->name, '@');
if (path && path[1]) {
path++;
if (!strncmp(tree->name, "cpu", 3)){
fprintf(f, "\t.path = {.type=DEVICE_PATH_CPU,{.cpu={ .id = 0x%s }}},\n",
path);
}
if (!strncmp(tree->name, "bus", 3)){
fprintf(f, "\t.path = {.type=DEVICE_PATH_PCI_BUS,{.pci_bus={ .bus = 0x%s }}},\n",
path);
}
if (!strncmp(tree->name, "apic", 4)){
fprintf(f, "\t.path = {.type=DEVICE_PATH_APIC,{.apic={ 0x%s }}},\n",
path);
}
if (!strncmp(tree->name, "domain", 6)){
fprintf(f, "\t.path = {.type=DEVICE_PATH_PCI_DOMAIN,{.pci_domain={ .domain = 0x%s }}},\n",
path);
}
if (!strncmp(tree->name, "pci", 3)){
/* it's in two parts */
char *devfn = strdup(path);
char *dev = devfn;
char *fn;
fn = index(devfn, ',');
/* if there is no fn we assume 0 */
/* the Rules are unclear on this point */
if (fn)
*fn++ = 0;
else
fn = "0";
fprintf(f, "\t.path = {.type=DEVICE_PATH_PCI,{.pci={ .devfn = PCI_DEVFN(0x%s, 0x%s)}}},\n",
dev, fn);
}
if (!strncmp(tree->name, "ioport", 6)){
fprintf(f, "\t.path = {.type=DEVICE_PATH_IOPORT,{.ioport={.iobase=0x%s}}},\n",
path);
}
}
if (tree->config){
configname = clean(tree->label, 0);
printf("\t.device_configuration = &%s,\n", configname);
/* The config property list for a device is derived from the
* device dts, e.g. northbridge/intel/i440bx/dts, not the
* mainboard dts.
* Almost all of these properties are specific to the device.
* Some, such as the device id, are part of the common
* device struct. Check the config properties and
* pull out those properties that are for the common
* (a.k.a. generic) device struct.
*/
/* get the properties out that are generic device props */
for_each_config(tree, prop) {
if (streq(prop->name, "constructor")){
fprintf(f, "\t.ops = &%s,\n", prop->val.val);
}
if (streq(prop->name, "device_operations")){
fprintf(f, "\t.ops = &%s,\n", prop->val.val);
}
if (streq(prop->name, "ops_pci_bus")){
fprintf(f, "\t.ops_pci_bus = &%s,\n", clean((char *)prop->val.val, 0));
ops_set = 1;
}
}
}
/* Process the properties specified in the mainboard dts.
* Some of these properties require special initialization
* (e.g. the path); some are flags, i.e. if the property exists
* then a variable is set to 1 (e.g. on_mainboard);
* and some are just set directly into the code (e.g. ops_pci).
*/
for_each_property(tree, prop) {
/* to do: check the value, maybe. Kinda pointless though. */
if (streq(prop->name, "on_mainboard")){
fprintf(f, "\t.on_mainboard = 1,\n");
}
if (streq(prop->name, "subsystem_vendor")){
fprintf(f, "\t.subsystem_vendor = %s,\n", prop->val.val);
}
if (streq(prop->name, "subsystem_device")){
fprintf(f, "\t.subsystem_device = %s,\n", prop->val.val);
}
if (streq(prop->name, "enabled")){
enabled = 1;
}
if (streq(prop->name, "disabled")){
enabled = 0;
}
if (streq(prop->name, "config")){
fprintf(f, "\t.device_configuration = &%s,\n", clean(tree->label, 1));
}
if (streq(prop->name, "ops")){
fprintf(f, "\t.ops = &%s,\n", clean((char *)prop->val.val, 0));
ops_set = 1;
}
if (streq(prop->name, "ops_pci")){
fprintf(f, "\t.ops_pci = &%s,\n", clean((char *)prop->val.val, 0));
ops_set = 1;
}
if (streq(prop->name, "ops_pci_bus")){
fprintf(f, "\t.ops_pci_bus = &%s,\n", clean((char *)prop->val.val, 0));
ops_set = 1;
}
if (streq(prop->name, "ops_smbus_bus")){
fprintf(f, "\t.ops_smbus_bus = &%s,\n", clean((char *)prop->val.val, 0));
ops_set = 1;
}
}
if (tree->next_sibling)
fprintf(f, "\t.sibling = &dev_%s,\n", tree->next_sibling->label);
/* If we are a bridge, and we have not been linked, then set up our links.
* There is a good chance we could expand the for loop to contain this first bit of code.
* OTOH, the compiler can do it for us, and the initial conditions are clearer this way.
*/
if ((! tree->linked) && is_bridge(tree)){
struct node *siblings;
fprintf(f,"\t.link = {\n");
fprintf(f,"\t\t[%d] = {\n", linkcount);
fprintf(f,"\t\t\t.dev = &dev_%s,\n", tree->label);
fprintf(f,"\t\t\t.link = %d,\n", linkcount);
if (tree->children)
fprintf(f,"\t\t\t.children = &dev_%s\n", tree->children->label);
fprintf(f,"\t\t},\n");
/* now we need to handle our siblings. */
linkcount++;
for_all_siblings(tree, siblings) {
if (is_bridge(siblings) && (!siblings->linked)){
fprintf(f,"\t\t[%d] = {\n", linkcount);
fprintf(f,"\t\t\t.dev = &dev_%s,\n", siblings->label);
fprintf(f,"\t\t\t.link = %d,\n", linkcount);
if (siblings->children) {
fprintf(f,"\t\t\t.children = &dev_%s\n", siblings->children->label);
siblings->children->linked = 1;
siblings->children->linknode = tree;
siblings->children->whichlink = linkcount;
}
fprintf(f,"\t\t},\n");
siblings->linked = 1;
siblings->whichlink = linkcount;
siblings->linknode = tree;
linkcount++;
}
}
fprintf(f,"\t},\n");
}
fprintf(f,"\t.links = %d,\n", linkcount);
/* fill in the 'bus I am on' entry */
/* being 'linked' on a bus overrides the parent link */
if (tree->linked)
fprintf(f, "\t.bus = &dev_%s.link[%d],\n", tree->linknode->label, tree->whichlink);
else if (tree->parent)
fprintf(f, "\t.bus = &dev_%s.link[0],\n", tree->parent->label);
else /* this is a very unusual case: the root */
fprintf(f, "\t.bus = &dev_%s.link[0],\n", tree->label);
if (tree->next)
fprintf(f, "\t.next = &dev_%s,\n", tree->next->label);
if ((! ops_set) && is_root)
fprintf(f, "\t.ops = &default_dev_ops_root,\n");
fprintf(f, "\t.dtsname = \"%s\",\n", tree->label);
fprintf(f, "\t.enabled = %d\n", enabled);
fprintf(f, "};\n");
}
static struct emitter coreboot_emitter = {
.cell = coreboot_emit_cell,
.string = coreboot_emit_string,
.align = coreboot_emit_align,
.data = coreboot_emit_data,
.beginnode = coreboot_emit_beginnode,
.endnode = coreboot_emit_endnode,
.property = coreboot_emit_property,
.special = coreboot_emit_special,
};
static int stringtable_insert(struct data *d, char *str)
{
int i;
/* FIXME: do this more efficiently? */
for (i = 0; i < d->len; i++) {
if (streq(str, d->val + i))
return i;
}
*d = data_append_data(*d, str, strlen(str)+1);
return i;
}
/* we're going to overload the name node for testing. This may be the wrong thing long-term */
static void flatten_tree_emit_includes(struct node *tree, struct emitter *emit,
void *etarget, struct data *strbuf,
struct version_info *vi)
{
char *pathname;
struct property *prop;
struct node *child;
FILE *f = etarget;
for_each_property(tree, prop) {
if (streq(prop->name, "config")) {
pathname = topath(prop);
fprintf(f, "#include <%s/config.h>\n", pathname);
free(pathname);
}
}
for_each_child(tree, child) {
flatten_tree_emit_includes(child, emit, etarget, strbuf, vi);
}
}
static void flatten_tree_emit_device_operations(struct node *tree, struct emitter *emit,
void *etarget, struct data *strbuf,
struct version_info *vi)
{
struct property *prop;
struct node *child;
/* find any/all properties with the name constructor */
for_each_config(tree, prop) {
if (streq(prop->name, "constructor")){
fprintf(stderr, "LEFT OVER CONSTRUCTOR -- FIX ME\n");
printf("\t&%s,\n", prop->val.val);
}
}
for_each_property(tree, prop) {
if (streq(prop->name, "constructor")){
printf("\t&%s,\n", prop->val.val);
fprintf(stderr, "LEFT OVER CONSTRUCTOR -- FIX ME\n");
}
}
for_each_config(tree, prop) {
if (streq(prop->name, "device_operations")){
printf("\t&%s,\n", prop->val.val);
}
}
for_each_property(tree, prop) {
if (streq(prop->name, "device_operations")){
printf("\t&%s,\n", prop->val.val);
}
}
for_each_child(tree, child) {
flatten_tree_emit_device_operations(child, emit, etarget, strbuf, vi);
}
}
char *emitted_names[256];
int emitted_names_count = 0;
static void flatten_tree_emit_structdecls(struct node *tree, struct emitter *emit,
void *etarget, struct data *strbuf,
struct version_info *vi)
{
char *treename;
struct property *prop;
struct node *child;
int seen_name_prop = 0;
FILE *f = etarget;
int doconfig = 0;
int already_done = 0;
if (tree->config){
int i;
// treename = clean(tree->label, 0);
treename = toname(tree->config->label, "_config");
for(i = 0; i < emitted_names_count; i++)
if (!strcmp(treename, emitted_names[i]))
already_done++;
if (! already_done) {
emitted_names[emitted_names_count++] = treename;
doconfig = 1;
}
}
if (doconfig) {
emit->beginnode(etarget, treename);
#if 0
if (vi->flags & FTF_FULLPATH)
emit->string(etarget, tree->fullpath, 0);
else
emit->string(etarget, tree->name, 0);
#endif
for_each_config(tree, prop) {
char *cleanname;
if (streq(prop->name, "name"))
seen_name_prop = 1;
if (streq(prop->name, "constructor")) /* this is special */
continue;
if (streq(prop->name, "device_operations")) /* this is special */
continue;
cleanname = clean(prop->name, 0);
if (prop->val.type == 'S') {
// Standard property, scalar
fprintf(f, "\tu32 %s;\n", cleanname);
} else if (prop->val.type == 'C') {
// 'Cell' property (array of 4-byte elements)
fprintf(f, "\tu32 %s[%d];\n", cleanname,prop->val.len/4+1);
} else if (prop->val.type == 'B') {
// Byte property
fprintf(f, "\tUNIMPLEMENTED: FIXME\n");
}
free(cleanname);
}
#if 0
if ((vi->flags & FTF_NAMEPROPS) && !seen_name_prop) {
fprintf(f, "\tu8 %s[%d];\n", prop->name, prop->val.len);
}
#endif
emit->endnode(etarget, treename);
}
for_each_config(tree, prop) {
if (! streq(prop->name, "constructor")) /* this is special */
continue;
fprintf(f, "extern struct device_operations %s;\n", prop->val.val);
}
for_each_config(tree, prop) {
if (! streq(prop->name, "device_operations")) /* this is special */
continue;
fprintf(f, "extern struct device_operations %s;\n", prop->val.val);
}
for_each_property(tree, prop) {
if (! streq(prop->name, "constructor")) /* this is special */
continue;
fprintf(f, "extern struct device_operations %s;\n", prop->val.val);
}
for_each_property(tree, prop) {
if (! streq(prop->name, "device_operations")) /* this is special */
continue;
fprintf(f, "extern struct device_operations %s;\n", prop->val.val);
}
for_each_property(tree, prop) {
if (! streq(prop->name, "ops")) /* this is special */
continue;
fprintf(f, "extern struct device_operations %s;\n", prop->val.val);
}
for_each_child(tree, child) {
flatten_tree_emit_structdecls(child, emit, etarget, strbuf, vi);
}
}
int structunique = 0;
static void flatten_tree_emit_structinits(struct node *tree, struct emitter *emit,
void *etarget, struct data *strbuf,
struct version_info *vi)
{
char *treename, *treelabel, *structname;
struct property *configprop, *dtsprop;
struct node *child;
int seen_name_prop = 0;
FILE *f = etarget;
/* here is the real action. What we have to do, given a -> config entry, is this:
* foreach property(tree->config)
* search for the property in this node's property list
* if found, then emit that with its initialization
* else emit the one from the config
* if there is a property in the list not in the config -> error
* later on, get smart, and remove properties as they are found.
* for now, be stupid.
*/
if (tree->config){
treelabel = clean(tree->label, 0);
structname = toname(tree->config->label, "_config");
/* beginnode does not work here.
* the design of this code is wrong and must be fixed.
* the operator should take the node itself, not a string.
*/
printf("struct %s %s = {\n", structname, treelabel);
for_each_config(tree, configprop) {
char *cleanname;
int found = 0;
if (streq(configprop->name, "constructor")) /* this is special */
continue;
if (streq(configprop->name, "device_operations")) /* this is special */
continue;
for_each_property(tree, dtsprop) {
if (streq(dtsprop->name,configprop->name)){
emit->data(etarget, dtsprop);
found = 1;
}
}
if (! found)
emit->data(etarget, configprop);
}
emit->endnode(etarget, treelabel);
}
/* now emit the device for this node, with sibling and child pointers etc. */
emit->special(f, tree);
for_each_child(tree, child) {
flatten_tree_emit_structinits(child, emit, etarget, strbuf, vi);
}
}
static void flatten_tree(struct node *tree, struct emitter *emit,
void *etarget, struct data *strbuf,
struct version_info *vi)
{
struct property *prop, *config;
struct node *child;
int seen_name_prop = 0;
emit->beginnode(etarget, tree->label);
if (vi->flags & FTF_FULLPATH)
emit->string(etarget, tree->fullpath, 0);
else
emit->string(etarget, tree->name, 0);
emit->align(etarget, sizeof(cell_t));
for_each_property(tree, prop) {
int nameoff;
if (streq(prop->name, "name"))
seen_name_prop = 1;
nameoff = stringtable_insert(strbuf, prop->name);
emit->property(etarget, prop->label);
emit->cell(etarget, prop->val.len);
emit->cell(etarget, nameoff);
if ((vi->flags & FTF_VARALIGN) && (prop->val.len >= 8))
emit->align(etarget, 8);
emit->data(etarget, prop);
emit->align(etarget, sizeof(cell_t));
}
if ((vi->flags & FTF_NAMEPROPS) && !seen_name_prop) {
emit->property(etarget, NULL);
emit->cell(etarget, tree->basenamelen+1);
emit->cell(etarget, stringtable_insert(strbuf, "name"));
if ((vi->flags & FTF_VARALIGN) && ((tree->basenamelen+1) >= 8))
emit->align(etarget, 8);
emit->string(etarget, tree->name, tree->basenamelen);
emit->align(etarget, sizeof(cell_t));
}
for_each_child(tree, child) {
flatten_tree(child, emit, etarget, strbuf, vi);
}
for_each_config(tree, prop) {
int nameoff;
if (streq(prop->name, "name"))
seen_name_prop = 1;
nameoff = stringtable_insert(strbuf, prop->name);
emit->property(etarget, prop->label);
emit->cell(etarget, prop->val.len);
emit->cell(etarget, nameoff);
if ((vi->flags & FTF_VARALIGN) && (prop->val.len >= 8))
emit->align(etarget, 8);
emit->data(etarget, prop);
emit->align(etarget, sizeof(cell_t));
}
emit->endnode(etarget, tree->label);
}
static struct data flatten_reserve_list(struct reserve_info *reservelist,
struct version_info *vi)
{
struct reserve_info *re;
struct data d = empty_data;
for (re = reservelist; re; re = re->next) {
d = data_append_re(d, &re->re);
}
return d;
}
static void make_bph(struct boot_param_header *bph,
struct version_info *vi,
int reservesize, int dtsize, int strsize,
int boot_cpuid_phys)
{
int reserve_off;
reservesize += sizeof(struct reserve_entry);
memset(bph, 0xff, sizeof(*bph));
bph->magic = cpu_to_be32(OF_DT_HEADER);
bph->version = cpu_to_be32(vi->version);
bph->last_comp_version = cpu_to_be32(vi->last_comp_version);
/* Reserve map should be doubleword aligned */
reserve_off = DALIGN(vi->hdr_size, 8);
bph->off_mem_rsvmap = cpu_to_be32(reserve_off);
bph->off_dt_struct = cpu_to_be32(reserve_off + reservesize);
bph->off_dt_strings = cpu_to_be32(reserve_off + reservesize
+ dtsize);
bph->totalsize = cpu_to_be32(reserve_off + reservesize
+ dtsize + strsize);
if (vi->flags & FTF_BOOTCPUID)
bph->boot_cpuid_phys = cpu_to_be32(boot_cpuid_phys);
if (vi->flags & FTF_STRTABSIZE)
bph->size_dt_strings = cpu_to_be32(strsize);
}
void dt_to_blob(FILE *f, struct boot_info *bi, int version,
int boot_cpuid_phys)
{
struct version_info *vi = NULL;
int i;
struct data dtbuf = empty_data;
struct data strbuf = empty_data;
struct data reservebuf;
struct boot_param_header bph;
struct reserve_entry termre = {.address = 0, .size = 0};
for (i = 0; i < ARRAY_SIZE(version_table); i++) {
if (version_table[i].version == version)
vi = &version_table[i];
}
if (!vi)
die("Unknown device tree blob version %d\n", version);
dtbuf = empty_data;
strbuf = empty_data;
flatten_tree(bi->dt, &bin_emitter, &dtbuf, &strbuf, vi);
bin_emit_cell(&dtbuf, OF_DT_END);
reservebuf = flatten_reserve_list(bi->reservelist, vi);
/* Make header */
make_bph(&bph, vi, reservebuf.len, dtbuf.len, strbuf.len,
boot_cpuid_phys);
fwrite(&bph, vi->hdr_size, 1, f);
/* Align the reserve map to an 8 byte boundary */
for (i = vi->hdr_size; i < be32_to_cpu(bph.off_mem_rsvmap); i++)
fputc(0, f);
/*
* Reserve map entries.
* Each entry is an (address, size) pair of u64 values.
* Always supply a zero-sized temination entry.
*/
fwrite(reservebuf.val, reservebuf.len, 1, f);
fwrite(&termre, sizeof(termre), 1, f);
fwrite(dtbuf.val, dtbuf.len, 1, f);
fwrite(strbuf.val, strbuf.len, 1, f);
if (ferror(f))
die("Error writing device tree blob: %s\n", strerror(errno));
data_free(dtbuf);
data_free(strbuf);
}
static void dump_stringtable_asm(FILE *f, struct data strbuf)
{
unsigned char *p;
int len;
p = strbuf.val;
while (p < (strbuf.val + strbuf.len)) {
len = strlen((char *)p);
fprintf(f, "\t.string \"%s\"\n", p);
p += len+1;
}
}
void dt_to_asm(FILE *f, struct boot_info *bi, int version, int boot_cpuid_phys)
{
struct version_info *vi = NULL;
int i;
struct data strbuf = empty_data;
struct reserve_info *re;
char *symprefix = "dt";
for (i = 0; i < ARRAY_SIZE(version_table); i++) {
if (version_table[i].version == version)
vi = &version_table[i];
}
if (!vi)
die("Unknown device tree blob version %d\n", version);
fprintf(f, "/* autogenerated by dtc, do not edit */\n\n");
fprintf(f, "#define OF_DT_HEADER 0x%x\n", OF_DT_HEADER);
fprintf(f, "#define OF_DT_BEGIN_NODE 0x%x\n", OF_DT_BEGIN_NODE);
fprintf(f, "#define OF_DT_END_NODE 0x%x\n", OF_DT_END_NODE);
fprintf(f, "#define OF_DT_PROP 0x%x\n", OF_DT_PROP);
fprintf(f, "#define OF_DT_END 0x%x\n", OF_DT_END);
fprintf(f, "\n");
emit_label(f, symprefix, "blob_start");
emit_label(f, symprefix, "header");
fprintf(f, "\t.long\tOF_DT_HEADER /* magic */\n");
fprintf(f, "\t.long\t_%s_blob_end - _%s_blob_start /* totalsize */\n",
symprefix, symprefix);
fprintf(f, "\t.long\t_%s_struct_start - _%s_blob_start /* off_dt_struct */\n",
symprefix, symprefix);
fprintf(f, "\t.long\t_%s_strings_start - _%s_blob_start /* off_dt_strings */\n",
symprefix, symprefix);
fprintf(f, "\t.long\t_%s_reserve_map - _%s_blob_start /* off_dt_strings */\n",
symprefix, symprefix);
fprintf(f, "\t.long\t%d /* version */\n", vi->version);
fprintf(f, "\t.long\t%d /* last_comp_version */\n",
vi->last_comp_version);
if (vi->flags & FTF_BOOTCPUID)
fprintf(f, "\t.long\t%i\t/*boot_cpuid_phys*/\n",
boot_cpuid_phys);
if (vi->flags & FTF_STRTABSIZE)
fprintf(f, "\t.long\t_%s_strings_end - _%s_strings_start\t/* size_dt_strings */\n",
symprefix, symprefix);
/*
* Reserve map entries.
* Align the reserve map to a doubleword boundary.
* Each entry is an (address, size) pair of u64 values.
* Always supply a zero-sized temination entry.
*/
asm_emit_align(f, 8);
emit_label(f, symprefix, "reserve_map");
fprintf(f, "/* Memory reserve map from source file */\n");
/*
* Use .long on high and low halfs of u64s to avoid .quad
* as it appears .quad isn't available in some assemblers.
*/
for (re = bi->reservelist; re; re = re->next) {
fprintf(f, "\t.long\t0x%08x\n\t.long\t0x%08x\n",
(unsigned int)(re->re.address >> 32),
(unsigned int)(re->re.address & 0xffffffff));
fprintf(f, "\t.long\t0x%08x\n\t.long\t0x%08x\n",
(unsigned int)(re->re.size >> 32),
(unsigned int)(re->re.size & 0xffffffff));
}
fprintf(f, "\t.long\t0, 0\n\t.long\t0, 0\n");
emit_label(f, symprefix, "struct_start");
flatten_tree(bi->dt, &asm_emitter, f, &strbuf, vi);
fprintf(f, "\t.long\tOF_DT_END\n");
emit_label(f, symprefix, "struct_end");
emit_label(f, symprefix, "strings_start");
dump_stringtable_asm(f, strbuf);
emit_label(f, symprefix, "strings_end");
emit_label(f, symprefix, "blob_end");
data_free(strbuf);
}
static void dump_stringtable_C(FILE *f, struct data strbuf)
{
unsigned char *p;
int len;
p = strbuf.val;
fprintf(f, "\tchar *stringtable[] = {\n");
while (p < (strbuf.val + strbuf.len)) {
len = strlen((char *)p);
fprintf(f, "\t\"%s\"\n", p);
p += len+1;
}
fprintf(f, "\t};\n");
}
void dt_to_C(FILE *f, struct boot_info *bi, int version, int boot_cpuid_phys)
{
struct version_info *vi = NULL;
int i;
struct data strbuf = empty_data;
struct reserve_info *re;
char *symprefix = "dt";
for (i = 0; i < ARRAY_SIZE(version_table); i++) {
if (version_table[i].version == version)
vi = &version_table[i];
}
if (!vi)
die("Unknown device tree blob version %d\n", version);
fprintf(f, "/* autogenerated by dtc, do not edit */\n\n");
fprintf(f, "#define OF_DT_HEADER 0x%x\n", OF_DT_HEADER);
fprintf(f, "#define OF_DT_BEGIN_NODE 0x%x\n", OF_DT_BEGIN_NODE);
fprintf(f, "#define OF_DT_END_NODE 0x%x\n", OF_DT_END_NODE);
fprintf(f, "#define OF_DT_PROP 0x%x\n", OF_DT_PROP);
fprintf(f, "#define OF_DT_END 0x%x\n", OF_DT_END);
fprintf(f, "\n");
C_emit_struct_start(f, symprefix, "blob");
fprintf(f, "\tu32\tmagic = OF_DT_HEADER;\n");
fprintf(f, "\tu32\ttotalsize = sizeof(struct blob);\n");
fprintf(f, "\tu32\toffdt = offsetof(struct blob, dt);\n");
fprintf(f, "\tu32\toffstrings = offsetof(struct blob, strings);\n");
fprintf(f, "\tu32\toffreserve = offsetof(struct blob, reserve);\n");
fprintf(f, "\tu32\tversion = %d;\n", vi->version);
fprintf(f, "\tu32\tlast_comp_version = %d;\n",
vi->last_comp_version);
if (vi->flags & FTF_BOOTCPUID)
fprintf(f, "\tu32\tboot_cpuid_phys = 0x%x;\n",
boot_cpuid_phys);
if (vi->flags & FTF_STRTABSIZE)
fprintf(f, "\tu32\tsize_%s_strings_end = sizeof(dt.strings);\n",
symprefix);
/*
* Reserve map entries.
* Align the reserve map to a doubleword boundary.
* Each entry is an (address, size) pair of u64 values.
* Always supply a zero-sized temination entry.
*/
C_emit_align(f, 8);
fprintf(f, "\t/* Memory reserve map from source file */\n");
/*
* Use .long on high and low halfs of u64s to avoid .quad
* as it appears .quad isn't available in some assemblers.
*/
fprintf(f, "\tu64 reservemap[] = {\n");
for (re = bi->reservelist; re; re = re->next) {
fprintf(f, "\tu64\t0x%lx\n", (long unsigned int)re->re.address);
fprintf(f, "\tu64\t0x%lx\n", (long unsigned int)re->re.size);
}
fprintf(f, "\t0, 0\n");
fprintf(f, "\t};\n");
C_emit_struct_start(f, symprefix, "dt_blob");
flatten_tree(bi->dt, &C_emitter, f, &strbuf, vi);
fprintf(f, "\tu32\tend = OF_DT_END;\n");
C_emit_struct_end(f, symprefix, "dt_blob");
dump_stringtable_C(f, strbuf);
C_emit_struct_end(f, symprefix, "blob");
data_free(strbuf);
}
/*Set up the clean label */
void
labeltree(struct node *tree)
{
struct node *child;
char *tmp1;
char *tmp2;
tree->label = clean(tree->name, 1);
if (tree->parent && tree->label) {
tmp1 = strdup(tree->parent->label);
if (strlen(tmp1)) {
tmp2 = tree->label;
tree->label = malloc(strlen(tmp1) + strlen(tmp2) + 2);
strcpy(tree->label, tmp1);
strcat(tree->label, "_");
strcat(tree->label, tmp2);
free(tmp2);
}
free(tmp1);
}
if (tree->next_sibling)
labeltree(tree->next_sibling);
for_each_child(tree, child) {
labeltree(child);
}
}
/* the root, weirdly enough, is last on the 'next' chain. yuck. */
void fix_next(struct node *root){
extern struct node *first_node;
struct node *next2last=NULL, *next;
for(next = first_node; next; next = next->next)
if (next->next == root)
next2last = next;
next2last->next = NULL;
root->next = first_node;
first_node = root;
}
void dt_to_coreboot(FILE *f, struct boot_info *bi, int version, int boot_cpuid_phys)
{
struct property *prop;
struct version_info *vi = NULL;
int i;
struct data strbuf = empty_data;
char *symprefix = "dt";
extern char *code;
struct node *next;
extern struct node *first_node;
int found_mainboard_vendor = 0, found_mainboard_name = 0, found_mainboard_subsys = 0;
labeltree(bi->dt);
for (i = 0; i < ARRAY_SIZE(version_table); i++) {
if (version_table[i].version == version)
vi = &version_table[i];
}
if (!vi)
die("Unknown device tree blob version %d\n", version);
/* the root is special -- the parser gives it no name. We fix that here.
* fix in parser?
*/
bi->dt->name = bi->dt->label = "root";
/* steps: emit all structs. Then emit the initializers, with the pointers to other structs etc. */
fix_next(bi->dt);
fprintf(f, "#include <statictree.h>\n");
/* forward declarations */
for(next = first_node; next; next = next->next)
fprintf(f, "struct device dev_%s;\n", next->label);
/* special for the root. Emit the names for the mainboard vendor and part # */
for_each_property(bi->dt, prop) {
if (streq(prop->name, "mainboard_vendor")){
found_mainboard_vendor = 1;
fprintf(f, "const char *mainboard_vendor = \"%s\";\n", prop->val.val);
}
if (streq(prop->name, "mainboard_name")){
found_mainboard_name = 1;
fprintf(f, "const char *mainboard_name = \"%s\";\n", prop->val.val);
}
if (streq(prop->name, "mainboard_pci_subsystem_vendor")){
found_mainboard_subsys++;
fprintf(f, "const u16 mainboard_pci_subsystem_vendor = %s;\n", prop->val.val);
}
if (streq(prop->name, "mainboard_pci_subsystem_device")){
found_mainboard_subsys++;
fprintf(f, "const u16 mainboard_pci_subsystem_device = %s;\n", prop->val.val);
}
}
if (! found_mainboard_vendor){
die("There is no mainboard_vendor property in the root. Please add one."
"(and make sure there is a mainboard_name property too");
}
if (! found_mainboard_name){
die("There is no mainboard_name property in the root. "
"Please add one."
"(and make sure there is a mainboard_vendor property too");
}
switch (found_mainboard_subsys) {
case 0:
break;
case 1:
die("There is only one of mainboard_pci_subsystem_vendor and "
"mainboard_pci_subsystem_device properties in the root. "
"Please add the other one or remove the existing one.");
break;
case 2:
break;
}
/* emit the code, if any */
if (code)
fprintf(f, "%s\n", code);
flatten_tree_emit_structinits(bi->dt, &coreboot_emitter, f, &strbuf, vi);
fprintf(f, "struct device_operations *all_device_operations[] = {\n");
flatten_tree_emit_device_operations(bi->dt, &coreboot_emitter, f, &strbuf, vi);
fprintf(f, "\t0\n};\n");
data_free(strbuf);
/* */
}
void dt_to_corebooth(FILE *f, struct boot_info *bi, int version, int boot_cpuid_phys)
{
struct version_info *vi = NULL;
int i;
struct data strbuf = empty_data;
char *symprefix = "dt";
extern char *code;
struct node *next;
struct property *prop;
int found_mainboard_subsys = 0;
extern struct node *first_node;
labeltree(bi->dt);
for (i = 0; i < ARRAY_SIZE(version_table); i++) {
if (version_table[i].version == version)
vi = &version_table[i];
}
if (!vi)
die("Unknown device tree blob version %d\n", version);
/* the root is special -- the parser gives it no name. We fix that here.
* fix in parser?
*/
bi->dt->name = bi->dt->label = "root";
/* steps: emit all structs. Then emit the initializers, with the pointers to other structs etc. */
fix_next(bi->dt);
/* emit any includes that we need -- TODO: ONLY ONCE PER TYPE*/
fprintf(f, "#include <device/device.h>\n#include <device/pci.h>\n");
fprintf(f, "extern const char *mainboard_vendor, *mainboard_name;\n");
for_each_property(bi->dt, prop) {
if (streq(prop->name, "mainboard_pci_subsystem_vendor")){
found_mainboard_subsys++;
}
if (streq(prop->name, "mainboard_pci_subsystem_device")){
found_mainboard_subsys++;
}
}
switch (found_mainboard_subsys) {
case 0:
break;
case 1:
die("There is only one of mainboard_pci_subsystem_vendor and "
"mainboard_pci_subsystem_device properties in the root. "
"Please add the other one or remove the existing one.");
break;
case 2:
fprintf(f, "#define HAVE_MAINBOARD_PCI_SUBSYSTEM_ID\n");
fprintf(f, "extern const u16 mainboard_pci_subsystem_vendor;\n");
fprintf(f, "extern const u16 mainboard_pci_subsystem_device;\n");
break;
}
flatten_tree_emit_includes(bi->dt, &coreboot_emitter, f, &strbuf, vi);
flatten_tree_emit_structdecls(bi->dt, &coreboot_emitter, f, &strbuf, vi);
/* */
}
struct inbuf {
char *base, *limit, *ptr;
};
static void inbuf_init(struct inbuf *inb, void *base, void *limit)
{
inb->base = base;
inb->limit = limit;
inb->ptr = inb->base;
}
static void flat_read_chunk(struct inbuf *inb, void *p, int len)
{
if ((inb->ptr + len) > inb->limit)
die("Premature end of data parsing flat device tree\n");
memcpy(p, inb->ptr, len);
inb->ptr += len;
}
static u32 flat_read_word(struct inbuf *inb)
{
u32 val;
assert(((inb->ptr - inb->base) % sizeof(val)) == 0);
flat_read_chunk(inb, &val, sizeof(val));
return be32_to_cpu(val);
}
static void flat_realign(struct inbuf *inb, int align)
{
int off = inb->ptr - inb->base;
inb->ptr = inb->base + DALIGN(off, align);
if (inb->ptr > inb->limit)
die("Premature end of data parsing flat device tree\n");
}
static char *flat_read_string(struct inbuf *inb)
{
int len = 0;
char *p = inb->ptr;
char *str;
do {
if (p >= inb->limit)
die("Premature end of data parsing flat device tree\n");
len++;
} while ((*p++) != '\0');
str = strdup(inb->ptr);
inb->ptr += len;
flat_realign(inb, sizeof(u32));
return str;
}
static struct data flat_read_data(struct inbuf *inb, int len)
{
struct data d = empty_data;
if (len == 0)
return empty_data;
d = data_grow_for(d, len);
d.len = len;
flat_read_chunk(inb, d.val, len);
flat_realign(inb, sizeof(u32));
return d;
}
static char *flat_read_stringtable(struct inbuf *inb, int offset)
{
char *p;
p = inb->base + offset;
while (1) {
if (p >= inb->limit || p < inb->base)
die("String offset %d overruns string table\n",
offset);
if (*p == '\0')
break;
p++;
}
return strdup(inb->base + offset);
}
static struct property *flat_read_property(struct inbuf *dtbuf,
struct inbuf *strbuf, int flags)
{
u32 proplen, stroff;
char *name;
struct data val;
proplen = flat_read_word(dtbuf);
stroff = flat_read_word(dtbuf);
name = flat_read_stringtable(strbuf, stroff);
if ((flags & FTF_VARALIGN) && (proplen >= 8))
flat_realign(dtbuf, 8);
val = flat_read_data(dtbuf, proplen);
return build_property(name, val, NULL);
}
static struct reserve_info *flat_read_mem_reserve(struct inbuf *inb)
{
struct reserve_info *reservelist = NULL;
struct reserve_info *new;
char *p;
struct reserve_entry re;
/*
* Each entry is a pair of u64 (addr, size) values for 4 cell_t's.
* List terminates at an entry with size equal to zero.
*
* First pass, count entries.
*/
p = inb->ptr;
while (1) {
flat_read_chunk(inb, &re, sizeof(re));
re.address = be64_to_cpu(re.address);
re.size = be64_to_cpu(re.size);
if (re.size == 0)
break;
new = build_reserve_entry(re.address, re.size, NULL);
reservelist = add_reserve_entry(reservelist, new);
}
return reservelist;
}
static char *nodename_from_path(char *ppath, char *cpath)
{
char *lslash;
int plen;
lslash = strrchr(cpath, '/');
if (! lslash)
return NULL;
plen = lslash - cpath;
if (streq(cpath, "/") && streq(ppath, ""))
return "";
if ((plen == 0) && streq(ppath, "/"))
return strdup(lslash+1);
if (! strneq(ppath, cpath, plen))
return NULL;
return strdup(lslash+1);
}
static const char PROPCHAR[] = "abcdefghijklmnopqrstuvwxyzABCDEFGHIJKLMNOPQRSTUVWXYZ0123456789,._+*#?-";
static const char UNITCHAR[] = "0123456789abcdef,";
static int check_node_name(char *name)
{
char *atpos;
unsigned int basenamelen;
atpos = strrchr(name, '@');
if (atpos)
basenamelen = atpos - name;
else
basenamelen = strlen(name);
if (strspn(name, PROPCHAR) < basenamelen)
return -1;
if (atpos
&& ((basenamelen + 1 + strspn(atpos+1, UNITCHAR)) < strlen(name)))
return -1;
return basenamelen;
}
static struct node *unflatten_tree(struct inbuf *dtbuf,
struct inbuf *strbuf,
char *parent_path, int flags)
{
struct node *node;
u32 val;
node = build_node(NULL, NULL, NULL);
if (flags & FTF_FULLPATH) {
node->fullpath = flat_read_string(dtbuf);
node->name = nodename_from_path(parent_path, node->fullpath);
if (! node->name)
die("Path \"%s\" is not valid as a child of \"%s\"\n",
node->fullpath, parent_path);
} else {
node->name = flat_read_string(dtbuf);
node->fullpath = join_path(parent_path, node->name);
}
node->basenamelen = check_node_name(node->name);
if (node->basenamelen < 0) {
fprintf(stderr, "Warning \"%s\" has incorrect format\n", node->name);
}
do {
struct property *prop;
struct node *child;
val = flat_read_word(dtbuf);
switch (val) {
case OF_DT_PROP:
prop = flat_read_property(dtbuf, strbuf, flags);
add_property(node, prop);
break;
case OF_DT_BEGIN_NODE:
child = unflatten_tree(dtbuf,strbuf, node->fullpath,
flags);
add_child(node, child);
break;
case OF_DT_END_NODE:
break;
case OF_DT_END:
die("Premature OF_DT_END in device tree blob\n");
break;
default:
die("Invalid opcode word %08x in device tree blob\n",
val);
}
} while (val != OF_DT_END_NODE);
return node;
}
struct boot_info *dt_from_blob(FILE *f)
{
u32 magic, totalsize, version, size_str = 0;
u32 off_dt, off_str, off_mem_rsvmap;
int rc;
char *blob;
struct boot_param_header *bph;
char *p;
struct inbuf dtbuf, strbuf;
struct inbuf memresvbuf;
int sizeleft;
struct reserve_info *reservelist;
struct node *tree;
u32 val;
int flags = 0;
rc = fread(&magic, sizeof(magic), 1, f);
if (ferror(f))
die("Error reading DT blob magic number: %s\n",
strerror(errno));
if (rc < 1) {
if (feof(f))
die("EOF reading DT blob magic number\n");
else
die("Mysterious short read reading magic number\n");
}
magic = be32_to_cpu(magic);
if (magic != OF_DT_HEADER)
die("Blob has incorrect magic number\n");
rc = fread(&totalsize, sizeof(totalsize), 1, f);
if (ferror(f))
die("Error reading DT blob size: %s\n", strerror(errno));
if (rc < 1) {
if (feof(f))
die("EOF reading DT blob size\n");
else
die("Mysterious short read reading blob size\n");
}
totalsize = be32_to_cpu(totalsize);
if (totalsize < BPH_V1_SIZE)
die("DT blob size (%d) is too small\n", totalsize);
blob = xmalloc(totalsize);
bph = (struct boot_param_header *)blob;
bph->magic = cpu_to_be32(magic);
bph->totalsize = cpu_to_be32(totalsize);
sizeleft = totalsize - sizeof(magic) - sizeof(totalsize);
p = blob + sizeof(magic) + sizeof(totalsize);
while (sizeleft) {
if (feof(f))
die("EOF before reading %d bytes of DT blob\n",
totalsize);
rc = fread(p, 1, sizeleft, f);
if (ferror(f))
die("Error reading DT blob: %s\n",
strerror(errno));
sizeleft -= rc;
p += rc;
}
off_dt = be32_to_cpu(bph->off_dt_struct);
off_str = be32_to_cpu(bph->off_dt_strings);
off_mem_rsvmap = be32_to_cpu(bph->off_mem_rsvmap);
version = be32_to_cpu(bph->version);
fprintf(stderr, "\tmagic:\t\t\t0x%x\n", magic);
fprintf(stderr, "\ttotalsize:\t\t%d\n", totalsize);
fprintf(stderr, "\toff_dt_struct:\t\t0x%x\n", off_dt);
fprintf(stderr, "\toff_dt_strings:\t\t0x%x\n", off_str);
fprintf(stderr, "\toff_mem_rsvmap:\t\t0x%x\n", off_mem_rsvmap);
fprintf(stderr, "\tversion:\t\t0x%x\n", version );
fprintf(stderr, "\tlast_comp_version:\t0x%x\n",
be32_to_cpu(bph->last_comp_version));
if (off_mem_rsvmap >= totalsize)
die("Mem Reserve structure offset exceeds total size\n");
if (off_dt >= totalsize)
die("DT structure offset exceeds total size\n");
if (off_str > totalsize)
die("String table offset exceeds total size\n");
if (version >= 2)
fprintf(stderr, "\tboot_cpuid_phys:\t0x%x\n",
be32_to_cpu(bph->boot_cpuid_phys));
if (version >= 3) {
size_str = be32_to_cpu(bph->size_dt_strings);
fprintf(stderr, "\tsize_dt_strings:\t%d\n", size_str);
if (off_str+size_str > totalsize)
die("String table extends past total size\n");
}
if (version < 0x10) {
flags |= FTF_FULLPATH | FTF_NAMEPROPS | FTF_VARALIGN;
}
inbuf_init(&memresvbuf,
blob + off_mem_rsvmap, blob + totalsize);
inbuf_init(&dtbuf, blob + off_dt, blob + totalsize);
inbuf_init(&strbuf, blob + off_str, blob + totalsize);
if (version >= 3)
strbuf.limit = strbuf.base + size_str;
reservelist = flat_read_mem_reserve(&memresvbuf);
val = flat_read_word(&dtbuf);
if (val != OF_DT_BEGIN_NODE)
die("Device tree blob doesn't begin with OF_DT_BEGIN_NODE (begins with 0x%08x)\n", val);
tree = unflatten_tree(&dtbuf, &strbuf, "", flags);
val = flat_read_word(&dtbuf);
if (val != OF_DT_END)
die("Device tree blob doesn't end with OF_DT_END\n");
free(blob);
return build_boot_info(reservelist, tree);
}