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 void set_devices_ns_access(struct csu_ns_dev *ns_dev, u16 val) 13 { 14 u32 *base = (u32 *)CONFIG_SYS_FSL_CSU_ADDR; 15 u32 *reg; 16 uint32_t tmp; 17 18 reg = base + ns_dev->ind / 2; 19 tmp = in_be32(reg); 20 if (ns_dev->ind % 2 == 0) { 21 tmp &= 0x0000ffff; 22 tmp |= val << 16; 23 } else { 24 tmp &= 0xffff0000; 25 tmp |= val; 26 } 27 28 out_be32(reg, tmp); 29 } 30 31 static void enable_devices_ns_access(struct csu_ns_dev *ns_dev, uint32_t num) 32 { 33 int i; 34 35 for (i = 0; i < num; i++) 36 set_devices_ns_access(ns_dev + i, ns_dev[i].val); 37 } 38 39 void enable_layerscape_ns_access(void) 40 { 41 enable_devices_ns_access(ns_dev, ARRAY_SIZE(ns_dev)); 42 } 43