Browse Source
* changes: intel: Add ncore ccu driver intel: Fix watchdog driver structure intel: Fix qspi driver write config intel: Pull out common drivers into platform commonpull/1931/head
Paul Beesley
5 years ago
committed by
TrustedFirmware Code Review
9 changed files with 265 additions and 29 deletions
@ -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; |
|||
} |
@ -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 |
Loading…
Reference in new issue