git.sur5r.net Git - u-boot/blob - arch/powerpc/cpu/mpc85xx/portals.c

   1 /*
   2  * Copyright 2008-2011 Freescale Semiconductor, Inc.
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  */
   6
   7 #include <common.h>
   8 #include <libfdt.h>
   9 #include <fdt_support.h>
  10
  11 #include <asm/processor.h>
  12 #include <asm/io.h>
  13
  14 #include <asm/fsl_portals.h>
  15 #include <asm/fsl_liodn.h>
  16
  17 /* Update portal containter to match LAW setup of portal in phy map */
  18 void fdt_portal(void *blob, const char *compat, const char *container,
  19                         u64 addr, u32 size)
  20 {
  21         int off;
  22
  23         off = fdt_node_offset_by_compatible(blob, -1, compat);
  24         if (off < 0)
  25                 return ;
  26
  27         off = fdt_parent_offset(blob, off);
  28         /* if non-zero assume we have a container */
  29         if (off > 0) {
  30                 char buf[60];
  31                 const char *p, *name;
  32                 u32 *range;
  33                 int len;
  34
  35                 /* fixup ranges */
  36                 range = fdt_getprop_w(blob, off, "ranges", &len);
  37                 if (range == NULL) {
  38                         printf("ERROR: container for %s has no ranges", compat);
  39                         return ;
  40                 }
  41
  42                 range[0] = 0;
  43                 if (len == 16) {
  44                         range[1] = addr >> 32;
  45                         range[2] = addr & 0xffffffff;
  46                         range[3] = size;
  47                 } else {
  48                         range[1] = addr & 0xffffffff;
  49                         range[2] = size;
  50                 }
  51                 fdt_setprop_inplace(blob, off, "ranges", range, len);
  52
  53                 /* fixup the name */
  54                 name = fdt_get_name(blob, off, &len);
  55                 p = memchr(name, '@', len);
  56
  57                 if (p)
  58                         len = p - name;
  59
  60                 /* if we are given a container name check it
  61                  * against what we found, if it doesnt match exit out */
  62                 if (container && (memcmp(container, name, len))) {
  63                         printf("WARNING: container names didn't match %s %s\n",
  64                                 container, name);
  65                         return ;
  66                 }
  67
  68                 memcpy(&buf, name, len);
  69                 len += sprintf(&buf[len], "@%llx", addr);
  70                 fdt_set_name(blob, off, buf);
  71                 return ;
  72         }
  73
  74         printf("ERROR: %s isn't in a container.  Not supported\n", compat);
  75 }