1 files changed, 99 insertions, 0 deletions
diff --git a/drivers/marvell/cache_llc.c b/drivers/marvell/cache_llc.c
new file mode 100644
index 00000000..cb5eed3c
--- /dev/null
+++ b/drivers/marvell/cache_llc.c
@@ -0,0 +1,99 @@
+/*
+ * ***************************************************************************
+ * Copyright (C) 2015 Marvell International Ltd.
+ * ***************************************************************************
+ * This program is free software: you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the Free
+ * Software Foundation, either version 2 of the License, or any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ * ***************************************************************************
+ */
+
+#include <assert.h>
+#include <mmio.h>
+#include <plat_def.h>
+
+#define LLC_CTRL                       0x100
+#define LLC_CACHE_SYNC                 0x700
+#define L2X0_INV_WAY                    0x77C
+#define L2X0_CLEAN_WAY                 0x7BC
+#define L2X0_CLEAN_INV_WAY             0x7FC
+
+#define LLC_CTRL_EN	                1
+#define LLC_EXCLUSIVE_EN		0x100
+#define LLC_WAY_MASK			0xFFFFFFFF
+
+void llc_cache_sync(void)
+{
+	mmio_write_32(MVEBU_LLC_BASE + LLC_CACHE_SYNC, 0);
+	/* Atumic write no need to wait */
+}
+
+void llc_flush_all(void)
+{
+	mmio_write_32(MVEBU_LLC_BASE + L2X0_CLEAN_INV_WAY, LLC_WAY_MASK);
+	llc_cache_sync();
+}
+
+void llc_clean_all(void)
+{
+	mmio_write_32(MVEBU_LLC_BASE + L2X0_CLEAN_WAY, LLC_WAY_MASK);
+	llc_cache_sync();
+}
+
+void llc_inv_all(void)
+{
+	mmio_write_32(MVEBU_LLC_BASE + L2X0_INV_WAY, LLC_WAY_MASK);
+	llc_cache_sync();
+}
+
+void llc_disable(void)
+{
+	llc_flush_all();
+	mmio_write_32(MVEBU_LLC_BASE + LLC_CTRL, 0);
+	__asm__ volatile("dsb st");
+}
+
+void llc_enable(int excl_mode)
+{
+	uint32_t val;
+
+	__asm__ volatile("dsb sy");
+	llc_inv_all();
+	__asm__ volatile("dsb sy");
+
+	val = LLC_CTRL_EN;
+	if (excl_mode)
+		val |= LLC_EXCLUSIVE_EN;
+
+	mmio_write_32(MVEBU_LLC_BASE + LLC_CTRL, val);
+	__asm__ volatile("dsb sy");
+}
+
+int llc_is_exclusive(void)
+{
+	uint32_t reg;
+
+	reg = mmio_read_32(MVEBU_LLC_BASE + LLC_CTRL);
+
+	if ((reg & (LLC_CTRL_EN | LLC_EXCLUSIVE_EN)) == (LLC_CTRL_EN | LLC_EXCLUSIVE_EN))
+		return 1;
+	return 0;
+}
+
+void llc_save(void)
+{
+	/* TBD */
+}
+
+void llc_resume(void)
+{
+	/* TBD */
+}