arch/x86/platform/olpc/olpc_dt.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * OLPC-specific OFW device tree support code.
   4  *
   5  * Paul Mackerras       August 1996.
   6  * Copyright (C) 1996-2005 Paul Mackerras.
   7  *
   8  *  Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
   9  *    {engebret|bergner}@us.ibm.com
  10  *
  11  *  Adapted for sparc by David S. Miller [email protected]
  12  *  Adapted for x86/OLPC by Andres Salomon <[email protected]>
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include <linux/memblock.h>
  17 #include <linux/of.h>
  18 #include <linux/of_pdt.h>
  19 #include <asm/olpc.h>
  20 #include <asm/olpc_ofw.h>
  21
  22 static phandle __init olpc_dt_getsibling(phandle node)
  23 {
  24         const void *args[] = { (void *)node };
  25         void *res[] = { &node };
  26
  27         if ((s32)node == -1)
  28                 return 0;
  29
  30         if (olpc_ofw("peer", args, res) || (s32)node == -1)
  31                 return 0;
  32
  33         return node;
  34 }
  35
  36 static phandle __init olpc_dt_getchild(phandle node)
  37 {
  38         const void *args[] = { (void *)node };
  39         void *res[] = { &node };
  40
  41         if ((s32)node == -1)
  42                 return 0;
  43
  44         if (olpc_ofw("child", args, res) || (s32)node == -1) {
  45                 pr_err("PROM: %s: fetching child failed!\n", __func__);
  46                 return 0;
  47         }
  48
  49         return node;
  50 }
  51
  52 static int __init olpc_dt_getproplen(phandle node, const char *prop)
  53 {
  54         const void *args[] = { (void *)node, prop };
  55         int len;
  56         void *res[] = { &len };
  57
  58         if ((s32)node == -1)
  59                 return -1;
  60
  61         if (olpc_ofw("getproplen", args, res)) {
  62                 pr_err("PROM: %s: getproplen failed!\n", __func__);
  63                 return -1;
  64         }
  65
  66         return len;
  67 }
  68
  69 static int __init olpc_dt_getproperty(phandle node, const char *prop,
  70                 char *buf, int bufsize)
  71 {
  72         int plen;
  73
  74         plen = olpc_dt_getproplen(node, prop);
  75         if (plen > bufsize || plen < 1) {
  76                 return -1;
  77         } else {
  78                 const void *args[] = { (void *)node, prop, buf, (void *)plen };
  79                 void *res[] = { &plen };
  80
  81                 if (olpc_ofw("getprop", args, res)) {
  82                         pr_err("PROM: %s: getprop failed!\n", __func__);
  83                         return -1;
  84                 }
  85         }
  86
  87         return plen;
  88 }
  89
  90 static int __init olpc_dt_nextprop(phandle node, char *prev, char *buf)
  91 {
  92         const void *args[] = { (void *)node, prev, buf };
  93         int success;
  94         void *res[] = { &success };
  95
  96         buf[0] = '\0';
  97
  98         if ((s32)node == -1)
  99                 return -1;
 100
 101         if (olpc_ofw("nextprop", args, res) || success != 1)
 102                 return -1;
 103
 104         return 0;
 105 }
 106
 107 static int __init olpc_dt_pkg2path(phandle node, char *buf,
 108                 const int buflen, int *len)
 109 {
 110         const void *args[] = { (void *)node, buf, (void *)buflen };
 111         void *res[] = { len };
 112
 113         if ((s32)node == -1)
 114                 return -1;
 115
 116         if (olpc_ofw("package-to-path", args, res) || *len < 1)
 117                 return -1;
 118
 119         return 0;
 120 }
 121
 122 static unsigned int prom_early_allocated __initdata;
 123
 124 void * __init prom_early_alloc(unsigned long size)
 125 {
 126         static u8 *mem;
 127         static size_t free_mem;
 128         void *res;
 129
 130         if (free_mem < size) {
 131                 const size_t chunk_size = max(PAGE_SIZE, size);
 132
 133                 /*
 134                  * To minimize the number of allocations, grab at least
 135                  * PAGE_SIZE of memory (that's an arbitrary choice that's
 136                  * fast enough on the platforms we care about while minimizing
 137                  * wasted bootmem) and hand off chunks of it to callers.
 138                  */
 139                 res = memblock_alloc(chunk_size, SMP_CACHE_BYTES);
 140                 if (!res)
 141                         panic("%s: Failed to allocate %zu bytes\n", __func__,
 142                               chunk_size);
 143                 BUG_ON(!res);
 144                 prom_early_allocated += chunk_size;
 145                 memset(res, 0, chunk_size);
 146                 free_mem = chunk_size;
 147                 mem = res;
 148         }
 149
 150         /* allocate from the local cache */
 151         free_mem -= size;
 152         res = mem;
 153         mem += size;
 154         return res;
 155 }
 156
 157 static struct of_pdt_ops prom_olpc_ops __initdata = {
 158         .nextprop = olpc_dt_nextprop,
 159         .getproplen = olpc_dt_getproplen,
 160         .getproperty = olpc_dt_getproperty,
 161         .getchild = olpc_dt_getchild,
 162         .getsibling = olpc_dt_getsibling,
 163         .pkg2path = olpc_dt_pkg2path,
 164 };
 165
 166 static phandle __init olpc_dt_finddevice(const char *path)
 167 {
 168         phandle node;
 169         const void *args[] = { path };
 170         void *res[] = { &node };
 171
 172         if (olpc_ofw("finddevice", args, res)) {
 173                 pr_err("olpc_dt: finddevice failed!\n");
 174                 return 0;
 175         }
 176
 177         if ((s32) node == -1)
 178                 return 0;
 179
 180         return node;
 181 }
 182
 183 static int __init olpc_dt_interpret(const char *words)
 184 {
 185         int result;
 186         const void *args[] = { words };
 187         void *res[] = { &result };
 188
 189         if (olpc_ofw("interpret", args, res)) {
 190                 pr_err("olpc_dt: interpret failed!\n");
 191                 return -1;
 192         }
 193
 194         return result;
 195 }
 196
 197 /*
 198  * Extract board revision directly from OFW device tree.
 199  * We can't use olpc_platform_info because that hasn't been set up yet.
 200  */
 201 static u32 __init olpc_dt_get_board_revision(void)
 202 {
 203         phandle node;
 204         __be32 rev;
 205         int r;
 206
 207         node = olpc_dt_finddevice("/");
 208         if (!node)
 209                 return 0;
 210
 211         r = olpc_dt_getproperty(node, "board-revision-int",
 212                                 (char *) &rev, sizeof(rev));
 213         if (r < 0)
 214                 return 0;
 215
 216         return be32_to_cpu(rev);
 217 }
 218
 219 static int __init olpc_dt_compatible_match(phandle node, const char *compat)
 220 {
 221         char buf[64], *p;
 222         int plen, len;
 223
 224         plen = olpc_dt_getproperty(node, "compatible", buf, sizeof(buf));
 225         if (plen <= 0)
 226                 return 0;
 227
 228         len = strlen(compat);
 229         for (p = buf; p < buf + plen; p += strlen(p) + 1) {
 230                 if (strcmp(p, compat) == 0)
 231                         return 1;
 232         }
 233
 234         return 0;
 235 }
 236
 237 void __init olpc_dt_fixup(void)
 238 {
 239         phandle node;
 240         u32 board_rev;
 241
 242         node = olpc_dt_finddevice("/battery@0");
 243         if (!node)
 244                 return;
 245
 246         board_rev = olpc_dt_get_board_revision();
 247         if (!board_rev)
 248                 return;
 249
 250         if (board_rev >= olpc_board_pre(0xd0)) {
 251                 /* XO-1.5 */
 252
 253                 if (olpc_dt_compatible_match(node, "olpc,xo1.5-battery"))
 254                         return;
 255
 256                 /* Add olpc,xo1.5-battery compatible marker to battery node */
 257                 olpc_dt_interpret("\" /battery@0\" find-device");
 258                 olpc_dt_interpret("  \" olpc,xo1.5-battery\" +compatible");
 259                 olpc_dt_interpret("device-end");
 260
 261                 if (olpc_dt_compatible_match(node, "olpc,xo1-battery")) {
 262                         /*
 263                          * If we have a olpc,xo1-battery compatible, then we're
 264                          * running a new enough firmware that already has
 265                          * the dcon node.
 266                          */
 267                         return;
 268                 }
 269
 270                 /* Add dcon device */
 271                 olpc_dt_interpret("\" /pci/display@1\" find-device");
 272                 olpc_dt_interpret("  new-device");
 273                 olpc_dt_interpret("    \" dcon\" device-name");
 274                 olpc_dt_interpret("    \" olpc,xo1-dcon\" +compatible");
 275                 olpc_dt_interpret("  finish-device");
 276                 olpc_dt_interpret("device-end");
 277         } else {
 278                 /* XO-1 */
 279
 280                 if (olpc_dt_compatible_match(node, "olpc,xo1-battery")) {
 281                         /*
 282                          * If we have a olpc,xo1-battery compatible, then we're
 283                          * running a new enough firmware that already has
 284                          * the dcon and RTC nodes.
 285                          */
 286                         return;
 287                 }
 288
 289                 /* Add dcon device, mark RTC as olpc,xo1-rtc */
 290                 olpc_dt_interpret("\" /pci/display@1,1\" find-device");
 291                 olpc_dt_interpret("  new-device");
 292                 olpc_dt_interpret("    \" dcon\" device-name");
 293                 olpc_dt_interpret("    \" olpc,xo1-dcon\" +compatible");
 294                 olpc_dt_interpret("  finish-device");
 295                 olpc_dt_interpret("device-end");
 296
 297                 olpc_dt_interpret("\" /rtc\" find-device");
 298                 olpc_dt_interpret(" \" olpc,xo1-rtc\" +compatible");
 299                 olpc_dt_interpret("device-end");
 300         }
 301
 302         /* Add olpc,xo1-battery compatible marker to battery node */
 303         olpc_dt_interpret("\" /battery@0\" find-device");
 304         olpc_dt_interpret("  \" olpc,xo1-battery\" +compatible");
 305         olpc_dt_interpret("device-end");
 306 }
 307
 308 void __init olpc_dt_build_devicetree(void)
 309 {
 310         phandle root;
 311
 312         if (!olpc_ofw_is_installed())
 313                 return;
 314
 315         olpc_dt_fixup();
 316
 317         root = olpc_dt_getsibling(0);
 318         if (!root) {
 319                 pr_err("PROM: unable to get root node from OFW!\n");
 320                 return;
 321         }
 322         of_pdt_build_devicetree(root, &prom_olpc_ops);
 323
 324         pr_info("PROM DT: Built device tree with %u bytes of memory.\n",
 325                         prom_early_allocated);
 326 }