ppc64 iSeries: Create a fake flat device tree on iSeries
authorMichael Ellerman <michael@ellerman.id.au>
Fri, 23 Sep 2005 04:56:09 +0000 (14:56 +1000)
committerStephen Rothwell <sfr@canb.auug.org.au>
Fri, 23 Sep 2005 04:56:09 +0000 (14:56 +1000)
This patch adds infrastructure for creating a fake flattened device tree
on iSeries.

We also need to build prom.o for iSeries which means we'll always need it.

Signed-off-by: Michael Ellerman <michael@ellerman.id.au>
Signed-off-by: Stephen Rothwell <sfr@canb.auug.org.au>
arch/ppc64/kernel/iSeries_setup.c

index 49d0f99996828fbb766a24ce4a2e4a6ba3c24d7a..99e4307affd68e48d0d8ff4666a48577dd04f006 100644 (file)
@@ -912,7 +912,144 @@ struct machdep_calls __initdata iseries_md = {
        /* XXX Implement enable_pmcs for iSeries */
 };
 
+struct blob {
+       unsigned char data[PAGE_SIZE];
+       unsigned long next;
+};
+
+struct iseries_flat_dt {
+       struct boot_param_header header;
+       u64 reserve_map[2];
+       struct blob dt;
+       struct blob strings;
+};
+
+struct iseries_flat_dt iseries_dt;
+
+void dt_init(struct iseries_flat_dt *dt)
+{
+       dt->header.off_mem_rsvmap =
+               offsetof(struct iseries_flat_dt, reserve_map);
+       dt->header.off_dt_struct = offsetof(struct iseries_flat_dt, dt);
+       dt->header.off_dt_strings = offsetof(struct iseries_flat_dt, strings);
+       dt->header.totalsize = sizeof(struct iseries_flat_dt);
+       dt->header.dt_strings_size = sizeof(struct blob);
+
+       /* There is no notion of hardware cpu id on iSeries */
+       dt->header.boot_cpuid_phys = smp_processor_id();
+
+       dt->dt.next = (unsigned long)&dt->dt.data;
+       dt->strings.next = (unsigned long)&dt->strings.data;
+
+       dt->header.magic = OF_DT_HEADER;
+       dt->header.version = 0x10;
+       dt->header.last_comp_version = 0x10;
+
+       dt->reserve_map[0] = 0;
+       dt->reserve_map[1] = 0;
+}
+
+void 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();
+       }
+}
+
+void dt_push_u32(struct iseries_flat_dt *dt, u32 value)
+{
+       *((u32*)dt->dt.next) = value;
+       dt->dt.next += sizeof(u32);
+
+       dt_check_blob(&dt->dt);
+}
+
+void dt_push_u64(struct iseries_flat_dt *dt, u64 value)
+{
+       *((u64*)dt->dt.next) = value;
+       dt->dt.next += sizeof(u64);
+
+       dt_check_blob(&dt->dt);
+}
+
+unsigned long dt_push_bytes(struct blob *blob, char *data, int len)
+{
+       unsigned long start = blob->next - (unsigned long)blob->data;
+
+       memcpy((char *)blob->next, data, len);
+       blob->next = _ALIGN(blob->next + len, 4);
+
+       dt_check_blob(blob);
+
+       return start;
+}
+
+void dt_start_node(struct iseries_flat_dt *dt, char *name)
+{
+       dt_push_u32(dt, OF_DT_BEGIN_NODE);
+       dt_push_bytes(&dt->dt, name, strlen(name) + 1);
+}
+
+#define dt_end_node(dt) dt_push_u32(dt, OF_DT_END_NODE)
+
+void dt_prop(struct iseries_flat_dt *dt, char *name, char *data, int len)
+{
+       unsigned long offset;
+
+       dt_push_u32(dt, OF_DT_PROP);
+
+       /* Length of the data */
+       dt_push_u32(dt, len);
+
+       /* Put the property name in the string blob. */
+       offset = dt_push_bytes(&dt->strings, name, strlen(name) + 1);
+
+       /* The offset of the properties name in the string blob. */
+       dt_push_u32(dt, (u32)offset);
+
+       /* The actual data. */
+       dt_push_bytes(&dt->dt, data, len);
+}
+
+void dt_prop_str(struct iseries_flat_dt *dt, char *name, char *data)
+{
+       dt_prop(dt, name, data, strlen(data) + 1); /* + 1 for NULL */
+}
+
+void dt_prop_u32(struct iseries_flat_dt *dt, char *name, u32 data)
+{
+       dt_prop(dt, name, (char *)&data, sizeof(u32));
+}
+
+void dt_prop_u64(struct iseries_flat_dt *dt, char *name, u64 data)
+{
+       dt_prop(dt, name, (char *)&data, sizeof(u64));
+}
+
+void dt_prop_u64_list(struct iseries_flat_dt *dt, char *name, u64 *data, int n)
+{
+       dt_prop(dt, name, (char *)data, sizeof(u64) * n);
+}
+
+void dt_prop_empty(struct iseries_flat_dt *dt, char *name)
+{
+       dt_prop(dt, name, NULL, 0);
+}
+
+void build_flat_dt(struct iseries_flat_dt *dt)
+{
+       dt_init(dt);
+
+       dt_start_node(dt, "");
+       dt_end_node(dt);
+
+       dt_push_u32(dt, OF_DT_END);
+}
+
 void __init iSeries_early_setup(void)
 {
        iSeries_fixup_klimit();
+
+       build_flat_dt(&iseries_dt);
 }