[PATCH] powerpc: make iSeries flattened device tree dynamic - part 2

This actually simplies things as we just figure out how much space we
used at the end and adjust klimit then.

Signed-off-by: Stephen Rothwell <sfr@canb.auug.org.au>
Signed-off-by: Paul Mackerras <paulus@samba.org>
This commit is contained in:
Stephen Rothwell 2006-05-19 17:04:12 +10:00 коммит произвёл Paul Mackerras
Родитель c4e3ea2553
Коммит 72a14eafb2
1 изменённых файлов: 19 добавлений и 43 удалений

Просмотреть файл

@ -27,7 +27,6 @@
#include <asm/machdep.h> #include <asm/machdep.h>
#include <asm/prom.h> #include <asm/prom.h>
#include <asm/lppaca.h> #include <asm/lppaca.h>
#include <asm/page.h>
#include <asm/cputable.h> #include <asm/cputable.h>
#include <asm/abs_addr.h> #include <asm/abs_addr.h>
#include <asm/system.h> #include <asm/system.h>
@ -51,15 +50,10 @@
extern char __dt_strings_start[]; extern char __dt_strings_start[];
extern char __dt_strings_end[]; extern char __dt_strings_end[];
struct blob {
unsigned char data[PAGE_SIZE * 2];
unsigned long next;
};
struct iseries_flat_dt { struct iseries_flat_dt {
struct boot_param_header header; struct boot_param_header header;
u64 reserve_map[2]; u64 reserve_map[2];
struct blob *dt; void *data;
}; };
static struct iseries_flat_dt *iseries_dt; static struct iseries_flat_dt *iseries_dt;
@ -76,15 +70,12 @@ static struct iseries_flat_dt * __init dt_init(void)
dt->header.off_dt_strings = ALIGN(sizeof(*dt), 8); dt->header.off_dt_strings = ALIGN(sizeof(*dt), 8);
dt->header.off_dt_struct = dt->header.off_dt_strings dt->header.off_dt_struct = dt->header.off_dt_strings
+ ALIGN(str_len, 8); + ALIGN(str_len, 8);
dt->dt = (struct blob *)((unsigned long)dt + dt->header.off_dt_struct); dt->data = (void *)((unsigned long)dt + dt->header.off_dt_struct);
klimit = ALIGN((unsigned long)(dt->dt) + sizeof(struct blob), 8);
dt->header.totalsize = klimit - (unsigned long)dt;
dt->header.dt_strings_size = str_len; dt->header.dt_strings_size = str_len;
/* There is no notion of hardware cpu id on iSeries */ /* There is no notion of hardware cpu id on iSeries */
dt->header.boot_cpuid_phys = smp_processor_id(); dt->header.boot_cpuid_phys = smp_processor_id();
dt->dt->next = (unsigned long)&dt->dt->data;
memcpy((char *)dt + dt->header.off_dt_strings, __dt_strings_start, memcpy((char *)dt + dt->header.off_dt_strings, __dt_strings_start,
str_len); str_len);
@ -98,54 +89,37 @@ static struct iseries_flat_dt * __init dt_init(void)
return dt; return dt;
} }
static void __init dt_check_blob(struct blob *b)
{
if (b->next >= (unsigned long)&b->next) {
DBG("Ran out of space in flat device tree blob!\n");
BUG();
}
}
static void __init dt_push_u32(struct iseries_flat_dt *dt, u32 value) static void __init dt_push_u32(struct iseries_flat_dt *dt, u32 value)
{ {
*((u32*)dt->dt->next) = value; *((u32 *)dt->data) = value;
dt->dt->next += sizeof(u32); dt->data += sizeof(u32);
dt_check_blob(dt->dt);
} }
#ifdef notyet #ifdef notyet
static void __init dt_push_u64(struct iseries_flat_dt *dt, u64 value) static void __init dt_push_u64(struct iseries_flat_dt *dt, u64 value)
{ {
*((u64*)dt->dt->next) = value; *((u64 *)dt->data) = value;
dt->dt->next += sizeof(u64); dt->data += sizeof(u64);
dt_check_blob(dt->dt);
} }
#endif #endif
static unsigned long __init dt_push_bytes(struct blob *blob, char *data, int len) static void __init dt_push_bytes(struct iseries_flat_dt *dt, char *data,
int len)
{ {
unsigned long start = blob->next - (unsigned long)blob->data; memcpy(dt->data, data, len);
dt->data += ALIGN(len, 4);
memcpy((char *)blob->next, data, len);
blob->next = _ALIGN(blob->next + len, 4);
dt_check_blob(blob);
return start;
} }
static void __init dt_start_node(struct iseries_flat_dt *dt, char *name) static void __init dt_start_node(struct iseries_flat_dt *dt, char *name)
{ {
dt_push_u32(dt, OF_DT_BEGIN_NODE); dt_push_u32(dt, OF_DT_BEGIN_NODE);
dt_push_bytes(dt->dt, name, strlen(name) + 1); dt_push_bytes(dt, name, strlen(name) + 1);
} }
#define dt_end_node(dt) dt_push_u32(dt, OF_DT_END_NODE) #define dt_end_node(dt) dt_push_u32(dt, OF_DT_END_NODE)
static void __init dt_prop(struct iseries_flat_dt *dt, char *name, static void __init dt_prop(struct iseries_flat_dt *dt, char *name,
char *data, int len) void *data, int len)
{ {
unsigned long offset; unsigned long offset;
@ -160,7 +134,7 @@ static void __init dt_prop(struct iseries_flat_dt *dt, char *name,
dt_push_u32(dt, (u32)offset); dt_push_u32(dt, (u32)offset);
/* The actual data. */ /* The actual data. */
dt_push_bytes(dt->dt, data, len); dt_push_bytes(dt, data, len);
} }
static void __init dt_prop_str(struct iseries_flat_dt *dt, char *name, static void __init dt_prop_str(struct iseries_flat_dt *dt, char *name,
@ -171,24 +145,24 @@ static void __init dt_prop_str(struct iseries_flat_dt *dt, char *name,
static void __init dt_prop_u32(struct iseries_flat_dt *dt, char *name, u32 data) static void __init dt_prop_u32(struct iseries_flat_dt *dt, char *name, u32 data)
{ {
dt_prop(dt, name, (char *)&data, sizeof(u32)); dt_prop(dt, name, &data, sizeof(u32));
} }
static void __init dt_prop_u64(struct iseries_flat_dt *dt, char *name, u64 data) static void __init dt_prop_u64(struct iseries_flat_dt *dt, char *name, u64 data)
{ {
dt_prop(dt, name, (char *)&data, sizeof(u64)); dt_prop(dt, name, &data, sizeof(u64));
} }
static void __init dt_prop_u64_list(struct iseries_flat_dt *dt, char *name, static void __init dt_prop_u64_list(struct iseries_flat_dt *dt, char *name,
u64 *data, int n) u64 *data, int n)
{ {
dt_prop(dt, name, (char *)data, sizeof(u64) * n); dt_prop(dt, name, data, sizeof(u64) * n);
} }
static void __init dt_prop_u32_list(struct iseries_flat_dt *dt, char *name, static void __init dt_prop_u32_list(struct iseries_flat_dt *dt, char *name,
u32 *data, int n) u32 *data, int n)
{ {
dt_prop(dt, name, (char *)data, sizeof(u32) * n); dt_prop(dt, name, data, sizeof(u32) * n);
} }
#ifdef notyet #ifdef notyet
@ -595,6 +569,8 @@ static void __init dt_pci_devices(struct iseries_flat_dt *dt)
static void dt_finish(struct iseries_flat_dt *dt) static void dt_finish(struct iseries_flat_dt *dt)
{ {
dt_push_u32(dt, OF_DT_END); dt_push_u32(dt, OF_DT_END);
dt->header.totalsize = (unsigned long)dt->data - (unsigned long)dt;
klimit = ALIGN((unsigned long)dt->data, 8);
} }
void * __init build_flat_dt(unsigned long phys_mem_size) void * __init build_flat_dt(unsigned long phys_mem_size)