git.sur5r.net Git - u-boot/blob - board/freescale/common/ns_access.c

   1 /*
   2  * Copyright 2014 Freescale Semiconductor
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  */
   6
   7 #include <common.h>
   8 #include <asm/io.h>
   9 #include <fsl_csu.h>
  10 #include <asm/arch/ns_access.h>
  11
  12 static void enable_devices_ns_access(struct csu_ns_dev *ns_dev, uint32_t num)
  13 {
  14         u32 *base = (u32 *)CONFIG_SYS_FSL_CSU_ADDR;
  15         u32 *reg;
  16         uint32_t val;
  17         int i;
  18
  19         for (i = 0; i < num; i++) {
  20                 reg = base + ns_dev[i].ind / 2;
  21                 val = in_be32(reg);
  22                 if (ns_dev[i].ind % 2 == 0) {
  23                         val &= 0x0000ffff;
  24                         val |= ns_dev[i].val << 16;
  25                 } else {
  26                         val &= 0xffff0000;
  27                         val |= ns_dev[i].val;
  28                 }
  29                 out_be32(reg, val);
  30         }
  31 }
  32
  33 void enable_layerscape_ns_access(void)
  34 {
  35         enable_devices_ns_access(ns_dev, ARRAY_SIZE(ns_dev));
  36 }