arch/x86/platform/olpc/olpc_dt.c

   1 /*
   2  * OLPC-specific OFW device tree support code.
   3  *
   4  * Paul Mackerras       August 1996.
   5  * Copyright (C) 1996-2005 Paul Mackerras.
   6  *
   7  *  Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
   8  *    {engebret|bergner}@us.ibm.com
   9  *
  10  *  Adapted for sparc by David S. Miller davem@davemloft.net
  11  *  Adapted for x86/OLPC by Andres Salomon <dilinger@queued.net>
  12  *
  13  *      This program is free software; you can redistribute it and/or
  14  *      modify it under the terms of the GNU General Public License
  15  *      as published by the Free Software Foundation; either version
  16  *      2 of the License, or (at your option) any later version.
  17  */
  18
  19 #include <linux/kernel.h>
  20 #include <linux/bootmem.h>
  21 #include <linux/of.h>
  22 #include <linux/of_pdt.h>
  23 #include <asm/olpc_ofw.h>
  24
  25 static phandle __init olpc_dt_getsibling(phandle node)
  26 {
  27         const void *args[] = { (void *)node };
  28         void *res[] = { &node };
  29
  30         if ((s32)node == -1)
  31                 return 0;
  32
  33         if (olpc_ofw("peer", args, res) || (s32)node == -1)
  34                 return 0;
  35
  36         return node;
  37 }
  38
  39 static phandle __init olpc_dt_getchild(phandle node)
  40 {
  41         const void *args[] = { (void *)node };
  42         void *res[] = { &node };
  43
  44         if ((s32)node == -1)
  45                 return 0;
  46
  47         if (olpc_ofw("child", args, res) || (s32)node == -1) {
  48                 pr_err("PROM: %s: fetching child failed!\n", __func__);
  49                 return 0;
  50         }
  51
  52         return node;
  53 }
  54
  55 static int __init olpc_dt_getproplen(phandle node, const char *prop)
  56 {
  57         const void *args[] = { (void *)node, prop };
  58         int len;
  59         void *res[] = { &len };
  60
  61         if ((s32)node == -1)
  62                 return -1;
  63
  64         if (olpc_ofw("getproplen", args, res)) {
  65                 pr_err("PROM: %s: getproplen failed!\n", __func__);
  66                 return -1;
  67         }
  68
  69         return len;
  70 }
  71
  72 static int __init olpc_dt_getproperty(phandle node, const char *prop,
  73                 char *buf, int bufsize)
  74 {
  75         int plen;
  76
  77         plen = olpc_dt_getproplen(node, prop);
  78         if (plen > bufsize || plen < 1) {
  79                 return -1;
  80         } else {
  81                 const void *args[] = { (void *)node, prop, buf, (void *)plen };
  82                 void *res[] = { &plen };
  83
  84                 if (olpc_ofw("getprop", args, res)) {
  85                         pr_err("PROM: %s: getprop failed!\n", __func__);
  86                         return -1;
  87                 }
  88         }
  89
  90         return plen;
  91 }
  92
  93 static int __init olpc_dt_nextprop(phandle node, char *prev, char *buf)
  94 {
  95         const void *args[] = { (void *)node, prev, buf };
  96         int success;
  97         void *res[] = { &success };
  98
  99         buf[0] = '\0';
 100
 101         if ((s32)node == -1)
 102                 return -1;
 103
 104         if (olpc_ofw("nextprop", args, res) || success != 1)
 105                 return -1;
 106
 107         return 0;
 108 }
 109
 110 static int __init olpc_dt_pkg2path(phandle node, char *buf,
 111                 const int buflen, int *len)
 112 {
 113         const void *args[] = { (void *)node, buf, (void *)buflen };
 114         void *res[] = { len };
 115
 116         if ((s32)node == -1)
 117                 return -1;
 118
 119         if (olpc_ofw("package-to-path", args, res) || *len < 1)
 120                 return -1;
 121
 122         return 0;
 123 }
 124
 125 static unsigned int prom_early_allocated __initdata;
 126
 127 void * __init prom_early_alloc(unsigned long size)
 128 {
 129         static u8 *mem;
 130         static size_t free_mem;
 131         void *res;
 132
 133         if (free_mem < size) {
 134                 const size_t chunk_size = max(PAGE_SIZE, size);
 135
 136                 /*
 137                  * To mimimize the number of allocations, grab at least
 138                  * PAGE_SIZE of memory (that's an arbitrary choice that's
 139                  * fast enough on the platforms we care about while minimizing
 140                  * wasted bootmem) and hand off chunks of it to callers.
 141                  */
 142                 res = alloc_bootmem(chunk_size);
 143                 if (!res)
 144                         return NULL;
 145                 prom_early_allocated += chunk_size;
 146                 memset(res, 0, chunk_size);
 147                 free_mem = chunk_size;
 148                 mem = res;
 149         }
 150
 151         /* allocate from the local cache */
 152         free_mem -= size;
 153         res = mem;
 154         mem += size;
 155         return res;
 156 }
 157
 158 static struct of_pdt_ops prom_olpc_ops __initdata = {
 159         .nextprop = olpc_dt_nextprop,
 160         .getproplen = olpc_dt_getproplen,
 161         .getproperty = olpc_dt_getproperty,
 162         .getchild = olpc_dt_getchild,
 163         .getsibling = olpc_dt_getsibling,
 164         .pkg2path = olpc_dt_pkg2path,
 165 };
 166
 167 void __init olpc_dt_build_devicetree(void)
 168 {
 169         phandle root;
 170
 171         if (!olpc_ofw_is_installed())
 172                 return;
 173
 174         root = olpc_dt_getsibling(0);
 175         if (!root) {
 176                 pr_err("PROM: unable to get root node from OFW!\n");
 177                 return;
 178         }
 179         of_pdt_build_devicetree(root, &prom_olpc_ops);
 180
 181         pr_info("PROM DT: Built device tree with %u bytes of memory.\n",
 182                         prom_early_allocated);
 183 }