stand/powerpc/kboot/kbootfdt.c

   1 /*-
   2  * Copyright (C) 2014 Nathan Whitehorn
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  17  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  18  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  19  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  20  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  21  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  22  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
  23  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  */
  25
  26 #include <sys/cdefs.h>
  27 __FBSDID("$FreeBSD$");
  28
  29 #include <sys/types.h>
  30 #include <fdt_platform.h>
  31 #include <libfdt.h>
  32 #include "bootstrap.h"
  33 #include "host_syscall.h"
  34
  35 static void
  36 add_node_to_fdt(void *buffer, const char *path, int fdt_offset)
  37 {
  38         int child_offset, fd, pfd, error, dentsize;
  39         char subpath[512];
  40         void *propbuf;
  41         ssize_t proplen;
  42
  43         struct host_dent {
  44                 unsigned long d_fileno;
  45                 unsigned long d_off;
  46                 unsigned short d_reclen;
  47                 char d_name[];
  48                 /* uint8_t      d_type; */
  49         };
  50         char dents[2048];
  51         struct host_dent *dent;
  52         int d_type;
  53
  54         fd = host_open(path, O_RDONLY, 0);
  55         while (1) {
  56             dentsize = host_getdents(fd, dents, sizeof(dents));
  57             if (dentsize <= 0)
  58               break;
  59             for (dent = (struct host_dent *)dents;
  60               (char *)dent < dents + dentsize;
  61               dent = (struct host_dent *)((void *)dent + dent->d_reclen)) {
  62                 sprintf(subpath, "%s/%s", path, dent->d_name);
  63                 if (strcmp(dent->d_name, ".") == 0 ||
  64                     strcmp(dent->d_name, "..") == 0)
  65                         continue;
  66                 d_type = *((char *)(dent) + dent->d_reclen - 1);
  67                 if (d_type == 4 /* DT_DIR */) {
  68                         child_offset = fdt_add_subnode(buffer, fdt_offset,
  69                             dent->d_name);
  70                         if (child_offset < 0) {
  71                                 printf("Error %d adding node %s/%s, skipping\n",
  72                                     child_offset, path, dent->d_name);
  73                                 continue;
  74                         }
  75
  76                         add_node_to_fdt(buffer, subpath, child_offset);
  77                 } else {
  78                         propbuf = malloc(1024);
  79                         proplen = 0;
  80                         pfd = host_open(subpath, O_RDONLY, 0);
  81                         if (pfd > 0) {
  82                                 proplen = host_read(pfd, propbuf, 1024);
  83                                 host_close(pfd);
  84                         }
  85                         error = fdt_setprop(buffer, fdt_offset, dent->d_name,
  86                             propbuf, proplen);
  87                         free(propbuf);
  88                         if (error)
  89                                 printf("Error %d adding property %s to "
  90                                     "node %d\n", error, dent->d_name,
  91                                     fdt_offset);
  92                 }
  93             }
  94         }
  95
  96         host_close(fd);
  97 }
  98
  99 /* Fix up wrong values added to the device tree by prom_init() in Linux */
 100
 101 static void
 102 fdt_linux_fixups(void *fdtp)
 103 {
 104         int offset, len;
 105         const void *prop;
 106
 107         /*
 108          * Remove /memory/available properties, which reflect long-gone OF
 109          * state
 110          */
 111
 112         offset = fdt_path_offset(fdtp, "/memory@0");
 113         if (offset > 0)
 114                 fdt_delprop(fdtp, offset, "available");
 115
 116         /*
 117          * Add reservations for OPAL and RTAS state if present
 118          */
 119
 120         offset = fdt_path_offset(fdtp, "/ibm,opal");
 121         if (offset > 0) {
 122                 uint64_t *base, *size;
 123                 base = fdt_getprop(fdtp, offset, "opal-base-address",
 124                     &len);
 125                 size = fdt_getprop(fdtp, offset, "opal-runtime-size",
 126                     &len);
 127                 if (base != NULL && size != NULL)
 128                         fdt_add_mem_rsv(fdtp, fdt64_to_cpu(*base),
 129                             fdt64_to_cpu(*size));
 130         }
 131         offset = fdt_path_offset(fdtp, "/rtas");
 132         if (offset > 0) {
 133                 uint32_t *base, *size;
 134                 base = fdt_getprop(fdtp, offset, "linux,rtas-base", &len);
 135                 size = fdt_getprop(fdtp, offset, "rtas-size", &len);
 136                 if (base != NULL && size != NULL)
 137                         fdt_add_mem_rsv(fdtp, fdt32_to_cpu(*base),
 138                             fdt32_to_cpu(*size));
 139         }
 140
 141         /*
 142          * Patch up /chosen nodes so that the stored handles mean something,
 143          * where possible.
 144          */
 145         offset = fdt_path_offset(fdtp, "/chosen");
 146         if (offset > 0) {
 147                 fdt_delprop(fdtp, offset, "cpu"); /* This node not meaningful */
 148
 149                 offset = fdt_path_offset(fdtp, "/chosen");
 150                 prop = fdt_getprop(fdtp, offset, "linux,stdout-package", &len);
 151                 if (prop != NULL) {
 152                         fdt_setprop(fdtp, offset, "stdout", prop, len);
 153                         offset = fdt_path_offset(fdtp, "/chosen");
 154                         fdt_setprop(fdtp, offset, "stdin", prop, len);
 155                 }
 156         }
 157 }
 158
 159 int
 160 fdt_platform_load_dtb(void)
 161 {
 162         void *buffer;
 163         size_t buflen = 409600;
 164
 165         buffer = malloc(buflen);
 166         fdt_create_empty_tree(buffer, buflen);
 167         add_node_to_fdt(buffer, "/proc/device-tree",
 168             fdt_path_offset(buffer, "/"));
 169         fdt_linux_fixups(buffer);
 170
 171         fdt_pack(buffer);
 172
 173         fdt_load_dtb_addr(buffer);
 174         free(buffer);
 175
 176         return (0);
 177 }
 178
 179 void
 180 fdt_platform_fixups(void)
 181 {
 182
 183 }
 184