drivers: add tzc380 support

Add tzc380 support.

Signed-off-by: Peng Fan <peng.fan@nxp.com>

2 files changed, 380 insertions, 0 deletions

diff --git a/drivers/arm/tzc/tzc380.c b/drivers/arm/tzc/tzc380.c
new file mode 100644
index 00000000..03cd3ed4
--- /dev/null
+++ b/drivers/arm/tzc/tzc380.c
@@ -0,0 +1,174 @@
+/*
+ * Copyright 2017 NXP
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * Redistributions of source code must retain the above copyright notice, this
+ * list of conditions and the following disclaimer.
+ *
+ * Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ *
+ * Neither the name of ARM nor the names of its contributors may be used
+ * to endorse or promote products derived from this software without specific
+ * prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <assert.h>
+#include <debug.h>
+#include <mmio.h>
+#include <stddef.h>
+#include <tzc380.h>
+
+struct tzc380_instance {
+	uintptr_t base;
+	uint8_t addr_width;
+	uint8_t num_regions;
+};
+
+struct tzc380_instance tzc380;
+
+static unsigned int tzc380_read_build_config(uintptr_t base)
+{
+	return mmio_read_32(base + BUILD_CONFIG_OFF);
+}
+
+static void tzc380_write_action(uintptr_t base, tzc_action_t action)
+{
+	mmio_write_32(base + ACTION_OFF, action);
+}
+
+static void tzc380_write_region_base_low(uintptr_t base, unsigned int region,
+				      unsigned int val)
+{
+	mmio_write_32(base + REGION_SETUP_LOW_OFF(region), val);
+}
+
+static void tzc380_write_region_base_high(uintptr_t base, unsigned int region,
+				       unsigned int val)
+{
+	mmio_write_32(base + REGION_SETUP_HIGH_OFF(region), val);
+}
+
+static void tzc380_write_region_attributes(uintptr_t base, unsigned int region,
+					unsigned int val)
+{
+	mmio_write_32(base + REGION_ATTRIBUTES_OFF(region), val);
+}
+
+void tzc380_init(uintptr_t base)
+{
+	unsigned int tzc_build;
+
+	assert(base);
+	tzc380.base = base;
+
+	/* Save values we will use later. */
+	tzc_build = tzc380_read_build_config(tzc380.base);
+	tzc380.addr_width  = ((tzc_build >> BUILD_CONFIG_AW_SHIFT) &
+			      BUILD_CONFIG_AW_MASK) + 1;
+	tzc380.num_regions = ((tzc_build >> BUILD_CONFIG_NR_SHIFT) &
+			       BUILD_CONFIG_NR_MASK) + 1;
+}
+
+static unsigned int addr_low(uintptr_t addr)
+{
+	return (unsigned int)addr;
+}
+
+static unsigned int addr_high(uintptr_t addr __unused)
+{
+#if (UINTPTR_MAX == UINT64_MAX)
+	return addr >> 32;
+#else
+	return 0;
+#endif
+}
+
+
+/*
+ * `tzc380_configure_region` is used to program regions into the TrustZone
+ * controller.
+ */
+void tzc380_configure_region(uint8_t region, uintptr_t region_base, unsigned int attr)
+{
+	assert(tzc380.base);
+
+	assert(region < tzc380.num_regions);
+
+	tzc380_write_region_base_low(tzc380.base, region, addr_low(region_base));
+	tzc380_write_region_base_high(tzc380.base, region, addr_high(region_base));
+	tzc380_write_region_attributes(tzc380.base, region, attr);
+}
+
+void tzc380_set_action(tzc_action_t action)
+{
+	assert(tzc380.base);
+
+	/*
+	 * - Currently no handler is provided to trap an error via interrupt
+	 *   or exception.
+	 * - The interrupt action has not been tested.
+	 */
+	tzc380_write_action(tzc380.base, action);
+}
+
+#if LOG_LEVEL >= LOG_LEVEL_INFO
+
+static unsigned int tzc380_read_region_attributes(uintptr_t base, unsigned int region)
+{
+	return mmio_read_32(base + REGION_ATTRIBUTES_OFF(region));
+}
+
+static unsigned int tzc380_read_region_base_low(uintptr_t base, unsigned int region)
+{
+	return mmio_read_32(base + REGION_SETUP_LOW_OFF(region));
+}
+
+static unsigned int tzc380_read_region_base_high(uintptr_t base, unsigned int region)
+{
+	return mmio_read_32(base + REGION_SETUP_HIGH_OFF(region));
+}
+
+#define	REGION_MAX	16
+void tzc380_dump_state(void)
+{
+	unsigned int n;
+	unsigned int temp_32reg, temp_32reg_h;
+
+	INFO("enter\n");
+	INFO("security_inversion_en %x\n",
+	     mmio_read_32(tzc380.base + SECURITY_INV_EN_OFF));
+	for (n = 0; n <= REGION_MAX; n++) {
+		temp_32reg = tzc380_read_region_attributes(tzc380.base, n);
+		if (!(temp_32reg & TZC_ATTR_REGION_EN_MASK))
+			continue;
+
+		INFO("\n");
+		INFO("region %d\n", n);
+		temp_32reg = tzc380_read_region_base_low(tzc380.base, n);
+		temp_32reg_h = tzc380_read_region_base_high(tzc380.base, n);
+		INFO("region_base: 0x%08x%08x\n", temp_32reg_h, temp_32reg);
+		temp_32reg = tzc380_read_region_attributes(tzc380.base, n);
+		INFO("region sp: %x\n", temp_32reg >> TZC_ATTR_SP_SHIFT);
+		INFO("region size: %x\n", (temp_32reg & TZC_REGION_SIZE_MASK) >>
+				TZC_REGION_SIZE_SHIFT);
+	}
+	INFO("exit\n");
+}
+
+#endif
diff --git a/include/drivers/arm/tzc380.h b/include/drivers/arm/tzc380.h
new file mode 100644
index 00000000..9a3a9c30
--- /dev/null
+++ b/include/drivers/arm/tzc380.h
@@ -0,0 +1,206 @@
+/*
+ * Copyright 2017 NXP
+ *
+ * Peng Fan <peng.fan@nxp.com>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * Redistributions of source code must retain the above copyright notice, this
+ * list of conditions and the following disclaimer.
+ *
+ * Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ *
+ * Neither the name of ARM nor the names of its contributors may be used
+ * to endorse or promote products derived from this software without specific
+ * prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#ifndef __TZC400_H__
+#define __TZC400_H__
+
+#include <tzc_common.h>
+
+#define TZC400_REG_SIZE		0x1000
+
+#define BUILD_CONFIG_OFF	0x000
+#define ACTION_OFF		0x004
+#define LOCKDOWN_RANGE_OFF	0x008
+#define LOCKDOWN_SELECT_OFF	0x00C
+#define INT_STATUS		0x010
+#define INT_CLEAR		0x014
+
+#define FAIL_ADDRESS_LOW_OFF	0x020
+#define FAIL_ADDRESS_HIGH_OFF	0x024
+#define FAIL_CONTROL_OFF	0x028
+#define FAIL_ID			0x02c
+
+#define SPECULATION_CTRL_OFF	0x030
+#define SECURITY_INV_EN_OFF	0x034
+
+#define REGION_SETUP_LOW_OFF(n)	(0x100 + n * 0x10)
+#define REGION_SETUP_HIGH_OFF(n) (0x104 + n * 0x10)
+#define REGION_ATTRIBUTES_OFF(n) (0x108 + n * 0x10)
+
+/* ID Registers */
+#define PID0_OFF		0xfe0
+#define PID1_OFF		0xfe4
+#define PID2_OFF		0xfe8
+#define PID3_OFF		0xfec
+#define PID4_OFF		0xfd0
+#define CID0_OFF		0xff0
+#define CID1_OFF		0xff4
+#define CID2_OFF		0xff8
+#define CID3_OFF		0xffc
+
+#define BUILD_CONFIG_AW_SHIFT	8
+#define BUILD_CONFIG_AW_MASK	0x3f
+#define BUILD_CONFIG_NR_SHIFT	0
+#define BUILD_CONFIG_NR_MASK	0xf
+
+#define ACTION_RV_SHIFT		0
+#define ACTION_RV_MASK		0x3
+#define  ACTION_RV_LOWOK	0x0
+#define  ACTION_RV_LOWERR	0x1
+#define  ACTION_RV_HIGHOK	0x2
+#define  ACTION_RV_HIGHERR	0x3
+
+#ifndef BIT
+#define BIT(nr)			(1 << (nr))
+#endif
+
+/* Speculation is enabled by default. */
+#define SPECULATION_CTRL_WRITE_DISABLE	BIT(1)
+#define SPECULATION_CTRL_READ_DISABLE	BIT(0)
+
+#define INT_STATUS_OVERRUN_SHIFT	1
+#define INT_STATUS_OVERRUN_MASK		0x1
+#define INT_STATUS_STATUS_SHIFT		0
+#define INT_STATUS_STATUS_MASK		0x1
+
+#define INT_CLEAR_CLEAR_SHIFT		0
+#define INT_CLEAR_CLEAR_MASK		0x1
+
+#define TZC380_COMPONENT_ID	0xb105f00d
+#define TZC380_PERIPH_ID_LOW	0x001bb380
+#define TZC380_PERIPH_ID_HIGH	0x00000004
+
+#define TZC_SP_NS_W		BIT(0)
+#define TZC_SP_NS_R		BIT(1)
+#define TZC_SP_S_W		BIT(2)
+#define TZC_SP_S_R		BIT(3)
+
+#define TZC_ATTR_SP_SHIFT	28
+#define TZC_ATTR_SP_ALL		((TZC_SP_S_W | TZC_SP_S_R | TZC_SP_NS_W | \
+				TZC_SP_NS_R) << TZC_ATTR_SP_SHIFT)
+#define TZC_ATTR_SP_S_RW	((TZC_SP_S_W | TZC_SP_S_R) << \
+				 TZC_ATTR_SP_SHIFT)
+#define TZC_ATTR_SP_NS_RW	((TZC_SP_NS_W | TZC_SP_NS_R) << \
+				TZC_ATTR_SP_SHIFT)
+
+#define TZC_REGION_SIZE_32K	0xe
+#define TZC_REGION_SIZE_64K	0xf
+#define TZC_REGION_SIZE_128K	0x10
+#define TZC_REGION_SIZE_256K	0x11
+#define TZC_REGION_SIZE_512K	0x12
+#define TZC_REGION_SIZE_1M	0x13
+#define TZC_REGION_SIZE_2M	0x14
+#define TZC_REGION_SIZE_4M	0x15
+#define TZC_REGION_SIZE_8M	0x16
+#define TZC_REGION_SIZE_16M	0x17
+#define TZC_REGION_SIZE_32M	0x18
+#define TZC_REGION_SIZE_64M	0x19
+#define TZC_REGION_SIZE_128M	0x1a
+#define TZC_REGION_SIZE_256M	0x1b
+#define TZC_REGION_SIZE_512M	0x1c
+#define TZC_REGION_SIZE_1G	0x1d
+#define TZC_REGION_SIZE_2G	0x1e
+#define TZC_REGION_SIZE_4G	0x1f
+#define TZC_REGION_SIZE_8G	0x20
+#define TZC_REGION_SIZE_16G	0x21
+#define TZC_REGION_SIZE_32G	0x22
+#define TZC_REGION_SIZE_64G	0x23
+#define TZC_REGION_SIZE_128G	0x24
+#define TZC_REGION_SIZE_256G	0x25
+#define TZC_REGION_SIZE_512G	0x26
+#define TZC_REGION_SIZE_1T	0x27
+#define TZC_REGION_SIZE_2T	0x28
+#define TZC_REGION_SIZE_4T	0x29
+#define TZC_REGION_SIZE_8T	0x2a
+#define TZC_REGION_SIZE_16T	0x2b
+#define TZC_REGION_SIZE_32T	0x2c
+#define TZC_REGION_SIZE_64T	0x2d
+#define TZC_REGION_SIZE_128T	0x2e
+#define TZC_REGION_SIZE_256T	0x2f
+#define TZC_REGION_SIZE_512T	0x30
+#define TZC_REGION_SIZE_1P	0x31
+#define TZC_REGION_SIZE_2P	0x32
+#define TZC_REGION_SIZE_4P	0x33
+#define TZC_REGION_SIZE_8P	0x34
+#define TZC_REGION_SIZE_16P	0x35
+#define TZC_REGION_SIZE_32P	0x36
+#define TZC_REGION_SIZE_64P	0x37
+#define TZC_REGION_SIZE_128P	0x38
+#define TZC_REGION_SIZE_256P	0x39
+#define TZC_REGION_SIZE_512P	0x3a
+#define TZC_REGION_SIZE_1E	0x3b
+#define TZC_REGION_SIZE_2E	0x3c
+#define TZC_REGION_SIZE_4E	0x3d
+#define TZC_REGION_SIZE_8E	0x3e
+#define TZC_REGION_SIZE_16E	0x3f
+
+#define TZC_REGION_SIZE_SHIFT	0x1
+#define TZC_REGION_SIZE_MASK	(0x3f << 1)
+#define TZC_ATTR_REGION_SIZE(s)	((s) << TZC_REGION_SIZE_SHIFT)
+
+#define TZC_ATTR_REGION_EN_SHIFT	0x0
+#define TZC_ATTR_REGION_EN_MASK		0x1
+
+#define TZC_ATTR_REGION_EN
+#define TZC_ATTR_REGION_ENABLE	0x1
+#define TZC_ATTR_REGION_DISABLE	0x0
+
+void tzc380_init(uintptr_t base);
+void tzc380_configure_region(uint8_t region,
+			     uintptr_t region_base,
+			     unsigned int attr);
+void tzc380_set_action(tzc_action_t action);
+static inline void tzc_init(uintptr_t base)
+{
+	tzc380_init(base);
+}
+static inline void tzc_configure_region(uint8_t region,
+					uintptr_t region_base,
+					unsigned int attr)
+{
+	tzc380_configure_region(region, region_base, attr);
+}
+
+static inline void tzc_set_action(tzc_action_t action)
+{
+	tzc380_set_action(action);
+}
+
+#if LOG_LEVEL >= LOG_LEVEL_INFO
+void tzc380_dump_state(void);
+#else
+static inline void tzc380_dump_state(void)
+{
+}
+#endif
+
+#endif /* __DRIVERS_TZC400_H */