intel: Add ncore ccu driver

Signed-off-by: Hadi Asyrafi <muhammad.hadi.asyrafi.abdul.halim@intel.com>
Change-Id: I0544315986ee28b23157fdfec3fe5aebae6b860f

diff --git a/plat/intel/soc/common/drivers/ccu/ncore_ccu.c b/plat/intel/soc/common/drivers/ccu/ncore_ccu.c
new file mode 100644 (file)
index 0000000..ac8218e
--- /dev/null
+++ b/plat/intel/soc/common/drivers/ccu/ncore_ccu.c
@@ -0,0 +1,126 @@
+/*
+ * Copyright (c) 2019, Intel Corporation. All rights reserved.
+ *
+ * SPDX-License-Identifier: BSD-3-Clause
+ */
+
+#include <assert.h>
+#include <common/debug.h>
+#include <errno.h>
+#include <lib/mmio.h>
+
+#include "ncore_ccu.h"
+#include <platform_def.h>
+
+uint32_t poll_active_bit(uint32_t dir);
+
+static coh_ss_id_t subsystem_id;
+
+
+void get_subsystem_id(void)
+{
+       uint32_t snoop_filter, directory, coh_agent;
+
+       snoop_filter = CSIDR_NUM_SF(mmio_read_32(NCORE_CCU_CSR(NCORE_CSIDR)));
+       directory = CSUIDR_NUM_DIR(mmio_read_32(NCORE_CCU_CSR(NCORE_CSUIDR)));
+       coh_agent = CSUIDR_NUM_CAI(mmio_read_32(NCORE_CCU_CSR(NCORE_CSUIDR)));
+
+       subsystem_id.num_snoop_filter = snoop_filter + 1;
+       subsystem_id.num_directory = directory;
+       subsystem_id.num_coh_agent = coh_agent;
+}
+
+uint32_t directory_init(void)
+{
+       uint32_t dir_sf_mtn, dir_sf_en;
+       uint32_t dir, sf, ret;
+
+       for (dir = 0; dir < subsystem_id.num_directory; dir++) {
+
+               dir_sf_mtn = DIRECTORY_UNIT(dir, NCORE_DIRUSFMCR);
+               dir_sf_en = DIRECTORY_UNIT(dir, NCORE_DIRUSFER);
+
+               for (sf = 0; sf < subsystem_id.num_snoop_filter; sf++) {
+
+                       /* Initialize All Entries */
+                       mmio_write_32(dir_sf_mtn, SNOOP_FILTER_ID(sf));
+
+                       /* Poll Active Bit */
+                       ret = poll_active_bit(dir);
+                       if (ret != 0) {
+                               ERROR("Timeout during active bit polling");
+                               return -ETIMEDOUT;
+                       }
+
+                       /* Snoope Filter Enable */
+                       mmio_write_32(dir_sf_en, BIT(sf));
+               }
+       }
+
+       return 0;
+}
+
+uint32_t coherent_agent_intfc_init(void)
+{
+       uint32_t dir, ca, ca_id, ca_type, ca_snoop_en;
+
+       for (dir = 0; dir < subsystem_id.num_directory; dir++) {
+
+               ca_snoop_en = DIRECTORY_UNIT(dir, NCORE_DIRUCASER0);
+
+               for (ca = 0; ca < subsystem_id.num_coh_agent; ca++) {
+
+                       ca_id = mmio_read_32(COH_AGENT_UNIT(ca, NCORE_CAIUIDR));
+
+                       /* Coh Agent Snoop Enable */
+                       if (CACHING_AGENT_BIT(ca_id))
+                               mmio_write_32(ca_snoop_en, BIT(ca));
+
+                       /* Coh Agent Snoop DVM Enable */
+                       ca_type = CACHING_AGENT_TYPE(ca_id);
+                       if (ca_type == ACE_W_DVM || ca_type == ACE_L_W_DVM)
+                               mmio_write_32(NCORE_CCU_CSR(NCORE_CSADSER0),
+                               BIT(ca));
+               }
+       }
+
+       return 0;
+}
+
+uint32_t poll_active_bit(uint32_t dir)
+{
+       uint32_t timeout = 80000;
+       uint32_t poll_dir =  DIRECTORY_UNIT(dir, NCORE_DIRUSFMAR);
+
+       while (timeout > 0) {
+               if (mmio_read_32(poll_dir) == 0)
+                       return 0;
+               timeout--;
+       }
+
+       return -1;
+}
+
+void bypass_ocram_firewall(void)
+{
+       mmio_clrbits_32(COH_CPU0_BYPASS_REG(NCORE_FW_OCRAM_BLK_CGF1),
+                       OCRAM_PRIVILEGED_MASK | OCRAM_SECURE_MASK);
+       mmio_clrbits_32(COH_CPU0_BYPASS_REG(NCORE_FW_OCRAM_BLK_CGF2),
+                       OCRAM_PRIVILEGED_MASK | OCRAM_SECURE_MASK);
+       mmio_clrbits_32(COH_CPU0_BYPASS_REG(NCORE_FW_OCRAM_BLK_CGF3),
+                       OCRAM_PRIVILEGED_MASK | OCRAM_SECURE_MASK);
+       mmio_clrbits_32(COH_CPU0_BYPASS_REG(NCORE_FW_OCRAM_BLK_CGF4),
+                       OCRAM_PRIVILEGED_MASK | OCRAM_SECURE_MASK);
+}
+
+uint32_t init_ncore_ccu(void)
+{
+       uint32_t status;
+
+       get_subsystem_id();
+       status = directory_init();
+       status = coherent_agent_intfc_init();
+       bypass_ocram_firewall();
+
+       return status;
+}

diff --git a/plat/intel/soc/common/drivers/ccu/ncore_ccu.h b/plat/intel/soc/common/drivers/ccu/ncore_ccu.h
new file mode 100644 (file)
index 0000000..d25ecac
--- /dev/null
+++ b/plat/intel/soc/common/drivers/ccu/ncore_ccu.h
@@ -0,0 +1,108 @@
+/*
+ * Copyright (c) 2019, Intel Corporation. All rights reserved.
+ *
+ * SPDX-License-Identifier: BSD-3-Clause
+ */
+
+#ifndef NCORE_CCU_H
+#define NCORE_CCU_H
+
+
+#define NCORE_CCU_OFFSET               0xf7000000
+
+
+/* Coherent Sub-System Address Map */
+#define NCORE_CAIU_OFFSET              0x00000
+#define NCORE_CAIU_SIZE                        0x01000
+
+#define NCORE_NCBU_OFFSET              0x60000
+#define NCORE_NCBU_SIZE                        0x01000
+
+#define NCORE_DIRU_OFFSET              0x80000
+#define NCORE_DIRU_SIZE                        0x01000
+
+#define NCORE_CMIU_OFFSET              0xc0000
+#define NCORE_CMIU_SIZE                        0x01000
+
+#define NCORE_CSR_OFFSET               0xff000
+#define NCORE_CSADSERO                 0x00040
+#define NCORE_CSUIDR                   0x00ff8
+#define NCORE_CSIDR                    0x00ffc
+
+/* Directory Unit Register Map */
+#define NCORE_DIRUSFER                 0x00010
+#define NCORE_DIRUMRHER                        0x00070
+#define NCORE_DIRUSFMCR                        0x00080
+#define NCORE_DIRUSFMAR                        0x00084
+
+/* Coherent Agent Interface Unit Register Map */
+#define NCORE_CAIUIDR                  0x00ffc
+
+/* Snoop Enable Register */
+#define NCORE_DIRUCASER0               0x00040
+#define NCORE_DIRUCASER1               0x00044
+#define NCORE_DIRUCASER2               0x00048
+#define NCORE_DIRUCASER3               0x0004c
+
+#define NCORE_CSADSER0                 0x00040
+#define NCORE_CSADSER1                 0x00044
+#define NCORE_CSADSER2                 0x00048
+#define NCORE_CSADSER3                 0x0004c
+
+/* Protocols Definition */
+#define ACE_W_DVM                      0
+#define ACE_L_W_DVM                    1
+#define ACE_WO_DVM                     2
+#define ACE_L_WO_DVM                   3
+
+/* Bypass OC Ram Firewall */
+#define NCORE_FW_OCRAM_BLK_BASE                0x100200
+#define NCORE_FW_OCRAM_BLK_CGF1                0x04
+#define NCORE_FW_OCRAM_BLK_CGF2                0x08
+#define NCORE_FW_OCRAM_BLK_CGF3                0x0c
+#define NCORE_FW_OCRAM_BLK_CGF4                0x10
+
+#define OCRAM_PRIVILEGED_MASK          BIT(29)
+#define OCRAM_SECURE_MASK              BIT(30)
+
+/* Macros */
+#define NCORE_CCU_REG(base)            (NCORE_CCU_OFFSET + (base))
+#define NCORE_CCU_CSR(reg)             (NCORE_CCU_REG(NCORE_CSR_OFFSET)\
+                                               + (reg))
+#define NCORE_CCU_DIR(reg)             (NCORE_CCU_REG(NCORE_DIRU_OFFSET)\
+                                               + (reg))
+#define NCORE_CCU_CAI(reg)             (NCORE_CCU_REG(NCORE_CAIU_OFFSET)\
+                                               + (reg))
+
+#define DIRECTORY_UNIT(x, reg)         (NCORE_CCU_DIR(reg)\
+                                               + NCORE_DIRU_SIZE * (x))
+#define COH_AGENT_UNIT(x, reg)         (NCORE_CCU_CAI(reg)\
+                                               + NCORE_CAIU_SIZE * (x))
+
+#define COH_CPU0_BYPASS_REG(reg)       (NCORE_CCU_REG(NCORE_FW_OCRAM_BLK_BASE)\
+                                               + (reg))
+
+#define CSUIDR_NUM_CMI(x)              (((x) & 0x3f000000) >> 24)
+#define CSUIDR_NUM_DIR(x)              (((x) & 0x003f0000) >> 16)
+#define CSUIDR_NUM_NCB(x)              (((x) & 0x00003f00) >> 8)
+#define CSUIDR_NUM_CAI(x)              (((x) & 0x0000007f) >> 0)
+
+#define CSIDR_NUM_SF(x)                        (((x) & 0x007c0000) >> 18)
+
+#define SNOOP_FILTER_ID(x)             (((x) << 16))
+
+#define CACHING_AGENT_BIT(x)           (((x) & 0x08000) >> 15)
+#define CACHING_AGENT_TYPE(x)          (((x) & 0xf0000) >> 16)
+
+
+typedef struct coh_ss_id {
+       uint8_t num_coh_mem;
+       uint8_t num_directory;
+       uint8_t num_non_coh_bridge;
+       uint8_t num_coh_agent;
+       uint8_t num_snoop_filter;
+} coh_ss_id_t;
+
+uint32_t init_ncore_ccu(void);
+
+#endif